summaryrefslogtreecommitdiffstats
path: root/test/bluedroidtest/bluedroidtest.c
diff options
context:
space:
mode:
Diffstat (limited to 'test/bluedroidtest/bluedroidtest.c')
-rw-r--r--test/bluedroidtest/bluedroidtest.c714
1 files changed, 714 insertions, 0 deletions
diff --git a/test/bluedroidtest/bluedroidtest.c b/test/bluedroidtest/bluedroidtest.c
new file mode 100644
index 0000000..130bc60
--- /dev/null
+++ b/test/bluedroidtest/bluedroidtest.c
@@ -0,0 +1,714 @@
+/******************************************************************************
+ *
+ * Copyright (C) 2009-2012 Broadcom Corporation
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at:
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ ******************************************************************************/
+
+/************************************************************************************
+ *
+ * Filename: bluedroidtest.c
+ *
+ * Description: Bluedroid Test application
+ *
+ ***********************************************************************************/
+
+#include <stdio.h>
+#include <dlfcn.h>
+#include <stdlib.h>
+#include <errno.h>
+#include <string.h>
+#include <pthread.h>
+#include <unistd.h>
+#include <ctype.h>
+#include <fcntl.h>
+#include <sys/prctl.h>
+#include <linux/capability.h>
+
+#include <arpa/inet.h>
+#include <netinet/in.h>
+#include <netdb.h>
+
+#include <private/android_filesystem_config.h>
+#include <android/log.h>
+
+#include <hardware/hardware.h>
+#include <hardware/bluetooth.h>
+
+/************************************************************************************
+** Constants & Macros
+************************************************************************************/
+
+#define PID_FILE "/data/.bdt_pid"
+
+#ifndef MAX
+#define MAX(x, y) ((x) > (y) ? (x) : (y))
+#endif
+
+#define CASE_RETURN_STR(const) case const: return #const;
+
+/************************************************************************************
+** Local type definitions
+************************************************************************************/
+
+/************************************************************************************
+** Static variables
+************************************************************************************/
+
+static unsigned char main_done = 0;
+static bt_status_t status;
+
+/* Main API */
+static bluetooth_device_t* bt_device;
+
+const bt_interface_t* sBtInterface = NULL;
+
+static gid_t groups[] = { AID_NET_BT, AID_INET, AID_NET_BT_ADMIN,
+ AID_SYSTEM, AID_MISC, AID_SDCARD_RW,
+ AID_NET_ADMIN, AID_VPN};
+
+/* Set to 1 when the Bluedroid stack is enabled */
+static unsigned char bt_enabled = 0;
+
+/************************************************************************************
+** Static functions
+************************************************************************************/
+
+static void process_cmd(char *p, unsigned char is_job);
+static void job_handler(void *param);
+static void bdt_log(const char *fmt_str, ...);
+
+
+/************************************************************************************
+** Externs
+************************************************************************************/
+
+/************************************************************************************
+** Functions
+************************************************************************************/
+
+
+/************************************************************************************
+** Shutdown helper functions
+************************************************************************************/
+
+static void bdt_shutdown(void)
+{
+ bdt_log("shutdown bdroid test app\n");
+ main_done = 1;
+}
+
+
+/*****************************************************************************
+** Android's init.rc does not yet support applying linux capabilities
+*****************************************************************************/
+
+static void config_permissions(void)
+{
+ struct __user_cap_header_struct header;
+ struct __user_cap_data_struct cap;
+
+ bdt_log("set_aid_and_cap : pid %d, uid %d gid %d", getpid(), getuid(), getgid());
+
+ header.pid = 0;
+
+ prctl(PR_SET_KEEPCAPS, 1, 0, 0, 0);
+
+ setuid(AID_BLUETOOTH);
+ setgid(AID_BLUETOOTH);
+
+ header.version = _LINUX_CAPABILITY_VERSION;
+
+ cap.effective = cap.permitted = cap.inheritable =
+ 1 << CAP_NET_RAW |
+ 1 << CAP_NET_ADMIN |
+ 1 << CAP_NET_BIND_SERVICE |
+ 1 << CAP_SYS_RAWIO |
+ 1 << CAP_SYS_NICE |
+ 1 << CAP_SETGID;
+
+ capset(&header, &cap);
+ setgroups(sizeof(groups)/sizeof(groups[0]), groups);
+}
+
+
+
+/*****************************************************************************
+** Logger API
+*****************************************************************************/
+
+void bdt_log(const char *fmt_str, ...)
+{
+ static char buffer[1024];
+ va_list ap;
+
+ va_start(ap, fmt_str);
+ vsnprintf(buffer, 1024, fmt_str, ap);
+ va_end(ap);
+
+ fprintf(stdout, "%s\n", buffer);
+}
+
+/*******************************************************************************
+ ** Misc helper functions
+ *******************************************************************************/
+static const char* dump_bt_status(bt_status_t status)
+{
+ switch(status)
+ {
+ CASE_RETURN_STR(BT_STATUS_SUCCESS)
+ CASE_RETURN_STR(BT_STATUS_FAIL)
+ CASE_RETURN_STR(BT_STATUS_NOT_READY)
+ CASE_RETURN_STR(BT_STATUS_NOMEM)
+ CASE_RETURN_STR(BT_STATUS_BUSY)
+ CASE_RETURN_STR(BT_STATUS_UNSUPPORTED)
+
+ default:
+ return "unknown status code";
+ }
+}
+
+static void hex_dump(char *msg, void *data, int size, int trunc)
+{
+ unsigned char *p = data;
+ unsigned char c;
+ int n;
+ char bytestr[4] = {0};
+ char addrstr[10] = {0};
+ char hexstr[ 16*3 + 5] = {0};
+ char charstr[16*1 + 5] = {0};
+
+ bdt_log("%s \n", msg);
+
+ /* truncate */
+ if(trunc && (size>32))
+ size = 32;
+
+ for(n=1;n<=size;n++) {
+ if (n%16 == 1) {
+ /* store address for this line */
+ snprintf(addrstr, sizeof(addrstr), "%.4x",
+ ((unsigned int)p-(unsigned int)data) );
+ }
+
+ c = *p;
+ if (isalnum(c) == 0) {
+ c = '.';
+ }
+
+ /* store hex str (for left side) */
+ snprintf(bytestr, sizeof(bytestr), "%02X ", *p);
+ strncat(hexstr, bytestr, sizeof(hexstr)-strlen(hexstr)-1);
+
+ /* store char str (for right side) */
+ snprintf(bytestr, sizeof(bytestr), "%c", c);
+ strncat(charstr, bytestr, sizeof(charstr)-strlen(charstr)-1);
+
+ if(n%16 == 0) {
+ /* line completed */
+ bdt_log("[%4.4s] %-50.50s %s\n", addrstr, hexstr, charstr);
+ hexstr[0] = 0;
+ charstr[0] = 0;
+ } else if(n%8 == 0) {
+ /* half line: add whitespaces */
+ strncat(hexstr, " ", sizeof(hexstr)-strlen(hexstr)-1);
+ strncat(charstr, " ", sizeof(charstr)-strlen(charstr)-1);
+ }
+ p++; /* next byte */
+ }
+
+ if (strlen(hexstr) > 0) {
+ /* print rest of buffer if not empty */
+ bdt_log("[%4.4s] %-50.50s %s\n", addrstr, hexstr, charstr);
+ }
+}
+
+/*******************************************************************************
+ ** Console helper functions
+ *******************************************************************************/
+
+void skip_blanks(char **p)
+{
+ while (**p == ' ')
+ (*p)++;
+}
+
+uint32_t get_int(char **p, int DefaultValue)
+{
+ uint32_t Value = 0;
+ unsigned char UseDefault;
+
+ UseDefault = 1;
+ skip_blanks(p);
+
+ while ( ((**p)<= '9' && (**p)>= '0') )
+ {
+ Value = Value * 10 + (**p) - '0';
+ UseDefault = 0;
+ (*p)++;
+ }
+
+ if (UseDefault)
+ return DefaultValue;
+ else
+ return Value;
+}
+
+int get_signed_int(char **p, int DefaultValue)
+{
+ int Value = 0;
+ unsigned char UseDefault;
+ unsigned char NegativeNum = 0;
+
+ UseDefault = 1;
+ skip_blanks(p);
+
+ if ( (**p) == '-')
+ {
+ NegativeNum = 1;
+ (*p)++;
+ }
+ while ( ((**p)<= '9' && (**p)>= '0') )
+ {
+ Value = Value * 10 + (**p) - '0';
+ UseDefault = 0;
+ (*p)++;
+ }
+
+ if (UseDefault)
+ return DefaultValue;
+ else
+ return ((NegativeNum == 0)? Value : -Value);
+}
+
+void get_str(char **p, char *Buffer)
+{
+ skip_blanks(p);
+
+ while (**p != 0 && **p != ' ')
+ {
+ *Buffer = **p;
+ (*p)++;
+ Buffer++;
+ }
+
+ *Buffer = 0;
+}
+
+uint32_t get_hex(char **p, int DefaultValue)
+{
+ uint32_t Value = 0;
+ unsigned char UseDefault;
+
+ UseDefault = 1;
+ skip_blanks(p);
+
+ while ( ((**p)<= '9' && (**p)>= '0') ||
+ ((**p)<= 'f' && (**p)>= 'a') ||
+ ((**p)<= 'F' && (**p)>= 'A') )
+ {
+ if (**p >= 'a')
+ Value = Value * 16 + (**p) - 'a' + 10;
+ else if (**p >= 'A')
+ Value = Value * 16 + (**p) - 'A' + 10;
+ else
+ Value = Value * 16 + (**p) - '0';
+ UseDefault = 0;
+ (*p)++;
+ }
+
+ if (UseDefault)
+ return DefaultValue;
+ else
+ return Value;
+}
+
+void get_bdaddr(const char *str, bt_bdaddr_t *bd) {
+ char *d = ((char *)bd), *endp;
+ int i;
+ for(i = 0; i < 6; i++) {
+ *d++ = strtol(str, &endp, 16);
+ if (*endp != ':' && i != 5) {
+ memset(bd, 0, sizeof(bt_bdaddr_t));
+ return;
+ }
+ str = endp + 1;
+ }
+}
+
+#define is_cmd(str) ((strlen(str) == strlen(cmd)) && strncmp((const char *)&cmd, str, strlen(str)) == 0)
+#define if_cmd(str) if (is_cmd(str))
+
+typedef void (t_console_cmd_handler) (char *p);
+
+typedef struct {
+ const char *name;
+ t_console_cmd_handler *handler;
+ const char *help;
+ unsigned char is_job;
+} t_cmd;
+
+
+const t_cmd console_cmd_list[];
+static int console_cmd_maxlen = 0;
+
+static void cmdjob_handler(void *param)
+{
+ char *job_cmd = (char*)param;
+
+ bdt_log("cmdjob starting (%s)", job_cmd);
+
+ process_cmd(job_cmd, 1);
+
+ bdt_log("cmdjob terminating");
+
+ free(job_cmd);
+}
+
+static int create_cmdjob(char *cmd)
+{
+ pthread_t thread_id;
+ char *job_cmd;
+
+ job_cmd = malloc(strlen(cmd)+1); /* freed in job handler */
+ strcpy(job_cmd, cmd);
+
+ if (pthread_create(&thread_id, NULL,
+ (void*)cmdjob_handler, (void*)job_cmd)!=0)
+ perror("pthread_create");
+
+ return 0;
+}
+
+/*******************************************************************************
+ ** Load stack lib
+ *******************************************************************************/
+
+int HAL_load(void)
+{
+ int err = 0;
+
+ hw_module_t* module;
+ hw_device_t* device;
+
+ bdt_log("Loading HAL lib + extensions");
+
+ err = hw_get_module(BT_HARDWARE_MODULE_ID, (hw_module_t const**)&module);
+ if (err == 0)
+ {
+ err = module->methods->open(module, BT_HARDWARE_MODULE_ID, &device);
+ if (err == 0) {
+ bt_device = (bluetooth_device_t *)device;
+ sBtInterface = bt_device->get_bluetooth_interface();
+ }
+ }
+
+ bdt_log("HAL library loaded (%s)", strerror(err));
+
+ return err;
+}
+
+int HAL_unload(void)
+{
+ int err = 0;
+
+ bdt_log("Unloading HAL lib");
+
+ sBtInterface = NULL;
+
+ bdt_log("HAL library unloaded (%s)", strerror(err));
+
+ return err;
+}
+
+/*******************************************************************************
+ ** HAL test functions & callbacks
+ *******************************************************************************/
+
+void setup_test_env(void)
+{
+ int i = 0;
+
+ while (console_cmd_list[i].name != NULL)
+ {
+ console_cmd_maxlen = MAX(console_cmd_maxlen, (int)strlen(console_cmd_list[i].name));
+ i++;
+ }
+}
+
+void check_return_status(bt_status_t status)
+{
+ if (status != BT_STATUS_SUCCESS)
+ {
+ bdt_log("HAL REQUEST FAILED status : %d (%s)", status, dump_bt_status(status));
+ }
+ else
+ {
+ bdt_log("HAL REQUEST SUCCESS");
+ }
+}
+
+static void adapter_state_changed(bt_state_t state)
+{
+ bdt_log("ADAPTER STATE UPDATED : %s", (state == BT_STATE_OFF)?"OFF":"ON");
+ if (state == BT_STATE_ON) {
+ bt_enabled = 1;
+ } else {
+ bt_enabled = 0;
+ }
+}
+
+static void dut_mode_recv(uint16_t opcode, uint8_t *buf, uint8_t len)
+{
+ bdt_log("DUT MODE RECV : NOT IMPLEMENTED");
+}
+
+static bt_callbacks_t bt_callbacks = {
+ sizeof(bt_callbacks_t),
+ adapter_state_changed,
+ NULL, /*adapter_properties_cb */
+ NULL, /* remote_device_properties_cb */
+ NULL, /* device_found_cb */
+ NULL, /* discovery_state_changed_cb */
+ NULL, /* pin_request_cb */
+ NULL, /* ssp_request_cb */
+ NULL, /*bond_state_changed_cb */
+ NULL, /* acl_state_changed_cb */
+ NULL, /* thread_evt_cb */
+ dut_mode_recv, /*dut_mode_recv_cb */
+};
+
+void bdt_init(void)
+{
+ bdt_log("INIT BT ");
+ status = sBtInterface->init(&bt_callbacks);
+ check_return_status(status);
+}
+
+void bdt_enable(void)
+{
+ bdt_log("ENABLE BT");
+ if (bt_enabled) {
+ bdt_log("Bluetooth is already enabled");
+ return;
+ }
+ status = sBtInterface->enable();
+
+ check_return_status(status);
+}
+
+void bdt_disable(void)
+{
+ bdt_log("DISABLE BT");
+ if (!bt_enabled) {
+ bdt_log("Bluetooth is already disabled");
+ return;
+ }
+ status = sBtInterface->disable();
+
+ check_return_status(status);
+}
+void bdt_dut_mode_configure(char *p)
+{
+ int32_t mode = -1;
+
+ bdt_log("BT DUT MODE CONFIGURE");
+ if (!bt_enabled) {
+ bdt_log("Bluetooth must be enabled for test_mode to work.");
+ return;
+ }
+ mode = get_signed_int(&p, mode);
+ if ((mode != 0) && (mode != 1)) {
+ bdt_log("Please specify mode: 1 to enter, 0 to exit");
+ return;
+ }
+ status = sBtInterface->dut_mode_configure(mode);
+
+ check_return_status(status);
+}
+
+void bdt_cleanup(void)
+{
+ bdt_log("CLEANUP");
+ sBtInterface->cleanup();
+}
+
+/*******************************************************************************
+ ** Console commands
+ *******************************************************************************/
+
+void do_help(char *p)
+{
+ int i = 0;
+ int max = 0;
+ char line[128];
+ int pos = 0;
+
+ while (console_cmd_list[i].name != NULL)
+ {
+ pos = sprintf(line, "%s", (char*)console_cmd_list[i].name);
+ bdt_log("%s %s\n", (char*)line, (char*)console_cmd_list[i].help);
+ i++;
+ }
+}
+
+void do_quit(char *p)
+{
+ bdt_shutdown();
+}
+
+/*******************************************************************
+ *
+ * BT TEST CONSOLE COMMANDS
+ *
+ * Parses argument lists and passes to API test function
+ *
+*/
+
+void do_init(char *p)
+{
+ bdt_init();
+}
+
+void do_enable(char *p)
+{
+ bdt_enable();
+}
+
+void do_disable(char *p)
+{
+ bdt_disable();
+}
+void do_dut_mode_configure(char *p)
+{
+ bdt_dut_mode_configure(p);
+}
+
+void do_cleanup(char *p)
+{
+ bdt_cleanup();
+}
+
+/*******************************************************************
+ *
+ * CONSOLE COMMAND TABLE
+ *
+*/
+
+const t_cmd console_cmd_list[] =
+{
+ /*
+ * INTERNAL
+ */
+
+ { "help", do_help, "lists all available console commands", 0 },
+ { "quit", do_quit, "", 0},
+
+ /*
+ * API CONSOLE COMMANDS
+ */
+
+ /* Init and Cleanup shall be called automatically */
+ { "enable", do_enable, ":: enables bluetooth", 0 },
+ { "disable", do_disable, ":: disables bluetooth", 0 },
+ { "dut_mode_configure", do_dut_mode_configure, ":: DUT mode - 1 to enter,0 to exit", 0 },
+
+ /* add here */
+
+ /* last entry */
+ {NULL, NULL, "", 0},
+};
+
+/*
+ * Main console command handler
+*/
+
+static void process_cmd(char *p, unsigned char is_job)
+{
+ char cmd[64];
+ int i = 0;
+ char *p_saved = p;
+
+ get_str(&p, cmd);
+
+ /* table commands */
+ while (console_cmd_list[i].name != NULL)
+ {
+ if (is_cmd(console_cmd_list[i].name))
+ {
+ if (!is_job && console_cmd_list[i].is_job)
+ create_cmdjob(p_saved);
+ else
+ {
+ console_cmd_list[i].handler(p);
+ }
+ return;
+ }
+ i++;
+ }
+ bdt_log("%s : unknown command\n", p_saved);
+ do_help(NULL);
+}
+
+int main (int argc, char * argv[])
+{
+ int opt;
+ char cmd[128];
+ int args_processed = 0;
+ int pid = -1;
+
+ config_permissions();
+ bdt_log("\n:::::::::::::::::::::::::::::::::::::::::::::::::::");
+ bdt_log(":: Bluedroid test app starting");
+
+ if ( HAL_load() < 0 ) {
+ perror("HAL failed to initialize, exit\n");
+ unlink(PID_FILE);
+ exit(0);
+ }
+
+ setup_test_env();
+
+ /* Automatically perform the init */
+ bdt_init();
+
+ while(!main_done)
+ {
+ char line[128];
+
+ /* command prompt */
+ printf( ">" );
+ fflush(stdout);
+
+ fgets (line, 128, stdin);
+
+ if (line[0]!= '\0')
+ {
+ /* remove linefeed */
+ line[strlen(line)-1] = 0;
+
+ process_cmd(line, 0);
+ memset(line, '\0', 128);
+ }
+ }
+
+ /* FIXME: Commenting this out as for some reason, the application does not exit otherwise*/
+ //bdt_cleanup();
+
+ HAL_unload();
+
+ bdt_log(":: Bluedroid test app terminating");
+
+ return 0;
+}
generated by cgit v1.1 at 2024-05-02 06:39:36 +0000