/****************************************************************************** * * 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 #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /************************************************************************************ ** 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; }