/*========================================================================== FTM Main Task Source File Description Unit test component file for regsitering the routines to Diag library for BT and FTM commands # Copyright (c) 2010-2017 by Qualcomm Technologies, Inc. All Rights Reserved. # Qualcomm Technologies Proprietary and Confidential. ===========================================================================*/ /*=========================================================================== Edit History when who what, where, why -------- --- ---------------------------------------------------------- 06/18/10 rakeshk Created a source file to implement routines for registering the callback routines for FM and BT FTM packets 07/06/10 rakeshk changed the name of FM common header file in inclusion 07/07/10 rakeshk Removed the sleep and wake in the main thread loop ===========================================================================*/ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifndef WIN_AP_HOST #include #endif #include #include #ifndef WIN_AP_HOST #include #endif #ifndef ANDROID #include #include #include #endif #ifndef WIN_AP_HOST #include "hidl_client.h" #endif /* Diag related header files */ #include "event.h" #include "msg.h" #include "log.h" #include "diag_lsm.h" #include "diagpkt.h" #include "diagcmd.h" #include "diag.h" #include "ftm_dbg.h" #include "ftm_wlan.h" #include "ftm_common.h" #include "ftm_ant_common.h" #ifndef WIN_AP_HOST #ifdef CONFIG_FTM_BT #include "ftm_bt_hci_pfal.h" #endif #ifdef CONFIG_FTM_FM #include "ftm_fm_pfal.h" #endif #include "ftm_nfc.h" #endif #ifdef USE_GLIB #include #define strlcat g_strlcat #define strlcpy g_strlcpy #endif int boardtype = 8660; int first_ant_command; int fm_passthrough = 0; int sibs_enabled = 0; static char *progname = NULL; bool block_bt = false; unsigned int g_dbg_level = FTM_DBG_DEFAULT; #define SHOW_PRIO 1 #define SHOW_TIME 2 #define SHOW_POLICY 4 #define SHOW_CPU 8 #define SHOW_MACLABEL 16 #define ARRAY_SIZE(a) (sizeof(a) / sizeof(*a)) #ifndef ANDROID #define SOCKETNAME "/data/misc/bluetooth/btprop" static int sk; #endif #ifdef CONFIG_FTM_BT /* Semaphore to monitor the completion of * the queued command before sending down the * next HCI cmd */ sem_t semaphore_cmd_complete; /* Semaphore to monitor whether a command * is queued before proceeding to dequeue * the HCI packet */ sem_t semaphore_cmd_queued; int soc_type; /* Diag pkt table for BT */ static const diagpkt_user_table_entry_type bt_ftm_diag_func_table[] = { {FTM_BT_CMD_CODE, FTM_BT_CMD_CODE, bt_ftm_diag_dispatch}, }; #endif /* CONFIG_FTM_BT */ #ifdef CONFIG_FTM_FM /* Callback declaration for BT FTM packet processing */ void *fm_ftm_diag_dispatch (void *req_pkt, uint16 pkt_len); /* Diag pkt table for FM */ static const diagpkt_user_table_entry_type fm_ftm_diag_func_table[] = { {FTM_FM_CMD_CODE, FTM_FM_CMD_CODE, fm_ftm_diag_dispatch}, }; #endif /* CONFIG_FTM_FM */ #ifdef CONFIG_FTM_ANT /* Callback declaration for ANT FTM packet processing */ void *ant_ftm_diag_dispatch(void *req_pkt, uint16 pkt_len); /*Diag pkt table for ANT */ static const diagpkt_user_table_entry_type ant_ftm_diag_func_table[] = { {FTM_ANT_CMD_CODE, FTM_ANT_CMD_CODE, ant_ftm_diag_dispatch} }; #endif /* CONFIG_FTM_ANT */ #ifdef CONFIG_FTM_WLAN /* Callback declaration for WLAN FTM packet processing */ void * wlan_ftm_diag_dispatch (void *req_pkt, uint16 pkt_len); /* Diag pkt table for WLAN */ static const diagpkt_user_table_entry_type wlan_ftm_diag_func_table[] = { {FTM_WLAN_CMD_CODE, FTM_WLAN_CMD_CODE, wlan_ftm_diag_dispatch} }; #endif #ifdef CONFIG_FTM_NFC /* Callback declaration for NFC FTM packet processing */ void *nfc_ftm_diag_dispatch (void *req_pkt, uint16 pkt_len); /*Diag pkt table for NFC */ static const diagpkt_user_table_entry_type nfc_ftm_diag_func_table[] = { {FTM_NFC_CMD_CODE, FTM_NFC_CMD_CODE, nfc_ftm_diag_dispatch} }; #endif /* CONFIG_FTM_NFC */ #ifdef CONFIG_FTM_BT #ifndef WIN_AP_HOST #ifndef ANDROID /* set up Socket connection to btproperty */ int prop_get(const char *key, char *value, const char *default_value) { char prop_string[200]; int ret, bytes_read = 0, i = 0; sprintf(prop_string, "get_property %s,", key); ret = send(sk, prop_string, strlen(prop_string), 0); memset(value, 0, sizeof(value)); do { bytes_read = recv(sk, &value[i], 1, 0); if (bytes_read == 1) { if (value[i] == ',') { value[i] = '\0'; break; } i++; } } while(1); ALOGI("property_get_bt: key(%s) has value: %s", key, value); if (bytes_read) { return 0; } else { strncpy(value, default_value, strlen(default_value)); return 1; } } int prop_set(const char *key, const char *value) { char prop_string[200]; int ret; sprintf(prop_string, "set_property %s %s,", key, value); ALOGI("property_set_bt: setting key(%s) to value: %s\n", key, value); ret = send(sk, prop_string, strlen(prop_string), 0); return 0; } #endif /* Get Bluetooth SoC type from system setting */ static int get_bt_soc_type(void) { int ret = 0; char bt_soc_type[PROPERTY_VALUE_MAX]; ALOGI("bt-hci: get_bt_soc_type"); #ifndef ANDROID #if (BT_SOC_TYPE_CHEROKEE) property_set("vendor.qcom.bluetooth.soc", "cherokee"); #else #if (BT_SOC_TYPE_ROME) property_set("vendor.qcom.bluetooth.soc", "rome"); #else property_set("vendor.qcom.bluetooth.soc", "pronto"); #endif #endif #endif ret = property_get("persist.vendor.qcom.bluetooth.soc", bt_soc_type, NULL); if (ret != 0) { ALOGI("soc_type set to %s\n", bt_soc_type); if (!strncasecmp(bt_soc_type, "rome", sizeof("rome"))) { return BT_SOC_ROME; } else if (!strncasecmp(bt_soc_type, "cherokee", sizeof("cherokee"))) { return BT_SOC_CHEROKEE; } else if (!strncasecmp(bt_soc_type, "pronto", sizeof("pronto"))) { return BT_SOC_DEFAULT; } else if (!strncasecmp(bt_soc_type, "ath3k", sizeof("ath3k"))) { return BT_SOC_AR3K; } else if (!strncasecmp(bt_soc_type, "hastings", sizeof("hastings"))) { return BT_SOC_HASTINGS; } else if (!strncasecmp(bt_soc_type, "genoa", sizeof("genoa"))) { return BT_SOC_GENOA; } else if (!strncasecmp(bt_soc_type, "moselle", sizeof("moselle"))) { return BT_SOC_MOSELLE; } else { ALOGI("vendor.qcom.bluetooth.soc not set, so using default.\n"); return BT_SOC_DEFAULT; } } else { ALOGE("%s: Failed to get soc type", __FUNCTION__); ret = BT_SOC_DEFAULT; } return ret; } #endif //ifndef WIN_AP_HOST #endif //ifdef CONFIG_FTM_BT /*=========================================================================== FUNCTION ioctl_write DESCRIPTION Helper function to package the ioctl messages and send it to the I2C driver DEPENDENCIES NIL RETURN VALUE -1 in failure,positive or zero in success SIDE EFFECTS None ===========================================================================*/ static int ioctl_readwrite(int fd, struct i2c_msg *msgs, int nmsgs) { struct i2c_rdwr_ioctl_data msgset = { .msgs = msgs, .nmsgs = nmsgs, }; if ((fd < 0) || (NULL == msgs) || (nmsgs <= 0)) { return -1; } if (ioctl(fd, I2C_RDWR, &msgset) < 0) { return -1; } return 0; } /*=========================================================================== FUNCTION i2c_write DESCRIPTION Helper function to construct the I@C request to be sent to the FM I2C driver DEPENDENCIES NIL RETURN VALUE -1 in failure,positive or zero in success SIDE EFFECTS None ===========================================================================*/ int i2c_write ( int fd, unsigned char offset, const unsigned char* buf, unsigned char len, unsigned int slave_addr ) { unsigned char offset_data[((1 + len) * sizeof(unsigned char))]; struct i2c_msg msgs[] = { [0] = { .addr = slave_addr, .flags = 0, .buf = (void *)offset_data, .len = (1 + len) * sizeof(*offset_data), }, }; offset_data[0] = offset; memcpy(offset_data + 1, buf, len); return ioctl_readwrite(fd, msgs, ARRAY_SIZE(msgs)); } /*=========================================================================== FUNCTION i2c_read DESCRIPTION Helper function to construct the I2C request to read data from the FM I2C driver DEPENDENCIES NIL RETURN VALUE -1 in failure,positive or zero in success SIDE EFFECTS None ===========================================================================*/ int i2c_read ( int fd, unsigned char offset, const unsigned char* buf, unsigned char len, unsigned int slave_addr ) { unsigned char offset_data[] = {offset}; struct i2c_msg msgs[] = { [0] = { .addr = slave_addr, .flags = 0, .buf = (void *)offset_data, .len = sizeof(*offset_data), }, [1] = { .addr = slave_addr, .flags = I2C_M_RD, .buf = (void *)buf, .len = len, }, }; return ioctl_readwrite(fd, msgs, ARRAY_SIZE(msgs)); } #ifdef CONFIG_FTM_FM /*========================================================================= FUNCTION fm_ftm_diag_dispatch DESCRIPTION Processes the request packet and sends it to the FTM FM layer for further processing DEPENDENCIES NIL RETURN VALUE pointer to FTM FM Response packet SIDE EFFECTS None ===========================================================================*/ void *fm_ftm_diag_dispatch ( void *req_pkt, uint16 pkt_len ) { void *rsp = NULL; DPRINTF(FTM_DBG_TRACE, "FM I2C Send Response = %d\n",pkt_len); // Allocate the same length as the request. rsp = ftm_fm_dispatch(req_pkt,pkt_len); return rsp; } #endif /* CONFIG_FTM_FM */ #ifdef CONFIG_FTM_ANT /*=========================================================================== FUNCTION ant_ftm_diag_dispatch DESCRIPTION Processes the request packet and sends it to the FTM ANT layer for further processing DEPENDENCIES NIL RETURN VALUE pointer to FTM ANT Response packet SIDE EFFECTS None ===========================================================================*/ void *ant_ftm_diag_dispatch ( void *req_pkt, uint16 pkt_len ) { void *rsp = NULL; DPRINTF(FTM_DBG_TRACE, "ANT diag dispatch send response = %d\n", pkt_len); // Allocate the same length as the request. rsp = ftm_ant_dispatch(req_pkt,pkt_len); return rsp; } #endif /* CONFIG_FTM_ANT */ #ifdef CONFIG_FTM_BT /*=========================================================================== FUNCTION bt_ftm_diag_dispatch DESCRIPTION Processes the request packet and sends it to the FTM BT layer for further processing DEPENDENCIES NIL RETURN VALUE pointer to FTM BT Response packet SIDE EFFECTS None ===========================================================================*/ void *bt_ftm_diag_dispatch ( void *req_pkt, uint16 pkt_len ) { void *rsp = NULL; boolean status = TRUE; DPRINTF(FTM_DBG_TRACE, "Send Response = %d\n",pkt_len); // Allocate the same length as the request. rsp = diagpkt_subsys_alloc (DIAG_SUBSYS_FTM, FTM_BT_CMD_CODE, pkt_len); if (rsp != NULL) { memcpy ((void *) rsp, (void *) req_pkt, pkt_len); } /* Spurious incoming request packets are occasionally received * by DIAG_SUBSYS_FTM which needs to be ignored and accordingly responded. * TODO: Reason for these spurious incoming request packets is yet to be * found, though its always found to be corresponding to this majic * length of 65532. */ if (pkt_len == 65532) { printf("\nIgnore spurious DIAG packet processing & respond immediately"); } else { DPRINTF(FTM_DBG_TRACE, "Insert BT packet = %d\n", pkt_len); /* add the BT packet into the Cmd Queue * and notify the main thread its queued */ status = qinsert_cmd((ftm_bt_pkt_type *)req_pkt); if(status == TRUE) sem_post(&semaphore_cmd_queued); DPRINTF(FTM_DBG_TRACE, "Insert BT packet done\n"); } return (rsp); } #endif /* CONFIG_FTM_BT */ #ifdef CONFIG_FTM_WLAN /*=========================================================================== FUNCTION wlan_ftm_diag_dispatch DESCRIPTION Processes the request packet and sends it to the FTM WLAN layer for further processing DEPENDENCIES NIL RETURN VALUE pointer to FTM WLAN Response packet SIDE EFFECTS None ===========================================================================*/ void * wlan_ftm_diag_dispatch ( void *req_pkt, uint16 pkt_len ) { void *rsp = NULL; DPRINTF(FTM_DBG_TRACE, "WLAN Send Response = %d\n", pkt_len); rsp = ftm_wlan_dispatch(req_pkt, pkt_len); return rsp; } #endif /* CONFIG_FTM_WLAN */ #ifdef CONFIG_FTM_NFC /*=========================================================================== FUNCTION nfcs_ftm_diag_dispatch DESCRIPTION Processes the request packet and sends it to the FTM NFC layer for further processing DEPENDENCIES NIL RETURN VALUE SIDE EFFECTS ===========================================================================*/ void *nfc_ftm_diag_dispatch ( void *req_pkt, uint16 pkt_len ) { void *rsp = NULL; boolean status = TRUE; DPRINTF(FTM_DBG_TRACE, " NFC Send Response = %d\n",pkt_len); /*now send the incoming nfc diag command packet to the nfc ftm layer to get it processed*/ rsp = ftm_nfc_dispatch(req_pkt, pkt_len); /* send same response as recieved back*/ return rsp; } #endif /* CONFIG_FTM_NFC */ static void usage(void) { fprintf(stderr, "\nusage: %s [options] \n" " -n, --nodaemon do not run as a daemon\n" " -p, --passthrough FM passthrough mode \n" " -d show more debug messages (-dd for even more)\n" " -n -t Tag read test\n" " -n -t -d eSE DWP test\n" " -s do not intialize BT handlers to block BT command\n" #ifdef CONFIG_FTM_BT " -b, --board-type Board Type\n" #endif #ifdef CONFIG_FTM_WLAN " -i \n" " --interface=\n" " wlan adapter name (wlan, eth, etc.) default wlan\n" #endif #ifdef CONFIG_FTM_NFC " -f nfc firmware download\n" " -t nfc test\n" #endif " --help display this help and exit\n" , progname); exit(EXIT_FAILURE); } /*=========================================================================== FUNCTION main DESCRIPTION Initialises the Diag library and registers the PKT table for FM and BT and daemonises DEPENDENCIES NIL RETURN VALUE NIL, Error in the event buffer will mean a NULL App version and Zero HW version SIDE EFFECTS None ===========================================================================*/ int main(int argc, char *argv[]) { int c; static struct option options[] = { {"help", no_argument, NULL, 'h'}, #ifdef CONFIG_FTM_WLAN {"interface", required_argument, NULL, 'i'}, #endif #ifdef CONFIG_FTM_BT {"board-type", required_argument, NULL, 'b'}, #endif #ifdef CONFIG_FTM_NFC {"firmware-download", no_argument, NULL, 'f'}, {"nfc-test", no_argument, NULL, 't'}, #endif {"nodaemon", no_argument, NULL, 'n'}, {"block-bt", no_argument, NULL, 's'}, {"passthrough", no_argument, NULL, 'p'}, {"uart-baudrate", no_argument, NULL, 'u'}, {"sibs", no_argument, NULL, 's'}, {0, 0, 0, 0} }; int daemonize = 1; block_bt = false; progname = argv[0]; while (1) { #ifdef ANDROID c = getopt_long(argc, argv, "hdi:npb:fts", options, NULL); #else c = getopt_long(argc, argv, "hdi:nb:f", options, NULL); #endif if (c < 0) break; switch (c) { #ifdef CONFIG_FTM_WLAN case 'i': strlcpy(g_ifname, optarg, IFNAMSIZ); break; #endif case 'n': daemonize = 0; break; case 's': block_bt = true; break; case 'p': fm_passthrough = 1; daemonize = 0; #ifndef WIN_AP_HOST property_set("wc_transport.skip_patch_dload" , "true"); #endif break; case 'd': #ifdef DEBUG g_dbg_level = g_dbg_level << 1 | 0x1; #else printf("Debugging disabled, please build with -DDEBUG option\n"); exit(EXIT_FAILURE); #endif break; #ifdef CONFIG_FTM_BT case 'b': boardtype = atoi(optarg); break; #endif #ifdef CONFIG_FTM_NFC case 'f': ftm_nfc_dispatch_nq_fwdl(); break; case 't': ftm_nfc_dispatch_nq_test( argc, argv); break; #endif case 'h': default: usage(); break; } } if (optind < argc) usage(); if (daemonize && daemon(0, 0)) { perror("daemon"); exit(EXIT_FAILURE); } DPRINTF(FTM_DBG_TRACE, "FTM Daemon calling LSM init\n"); if (!Diag_LSM_Init(NULL)) { DPRINTF(FTM_DBG_ERROR, "FTM Daemon: Diag_LSM_Init() failed\n"); exit(EXIT_FAILURE); } DPRINTF(FTM_DBG_TRACE, "FTMDaemon: Diag_LSM_Init succesful\n"); #ifdef CONFIG_FTM_BT #ifndef WIN_AP_HOST soc_type = get_bt_soc_type(); #endif #endif #ifdef CONFIG_FTM_FM DIAGPKT_DISPATCH_TABLE_REGISTER( DIAG_SUBSYS_FTM, fm_ftm_diag_func_table); #endif #ifdef CONFIG_FTM_WLAN DIAGPKT_DISPATCH_TABLE_REGISTER( DIAG_SUBSYS_FTM, wlan_ftm_diag_func_table); #endif #ifdef CONFIG_FTM_ANT DIAGPKT_DISPATCH_TABLE_REGISTER( DIAG_SUBSYS_FTM, ant_ftm_diag_func_table); #endif #ifdef CONFIG_FTM_NFC DIAGPKT_DISPATCH_TABLE_REGISTER( DIAG_SUBSYS_FTM, nfc_ftm_diag_func_table); #endif #ifdef CONFIG_FTM_BT if (!block_bt) { DIAGPKT_DISPATCH_TABLE_REGISTER( DIAG_SUBSYS_FTM, bt_ftm_diag_func_table); } else { ALOGI("BT is blocked to send any command with option 's'"); } sem_init(&semaphore_cmd_complete,0, 1); sem_init(&semaphore_cmd_queued,0,0); first_ant_command = 0; DPRINTF(FTM_DBG_TRACE, "Initialised the BT FTM cmd queue handlers \n"); do { struct timespec ts; int sem_status; /* We have the freedom to send the first request without wating * for a command complete */ DPRINTF(FTM_DBG_TRACE, "Wait on cmd complete from the previous command\n"); if (clock_gettime(CLOCK_REALTIME, &ts) == -1) printf("get clock_gettime error"); ts.tv_sec += 5; /*we wait for 5 secs for a command already queued for * transmision */ sem_status = sem_timedwait(&semaphore_cmd_complete,&ts); if(sem_status == -1) { printf("Command complete timed out\n"); ftm_bt_err_timedout(); } DPRINTF(FTM_DBG_TRACE, "Waiting on next Cmd to be queued\n"); sem_wait(&semaphore_cmd_queued); dequeue_send(); } while(1); #else /* CONFIG_FTM_BT */ #ifdef CONFIG_FTM_FM pthread_cond_init(&fm_event_cond, NULL); pthread_mutex_init(&fm_event_lock, NULL); #endif while (1); #endif DPRINTF(FTM_DBG_TRACE, "\nFTMDaemon Deinit the LSM\n"); #ifdef CONFIG_FTM_FM pthread_cond_destroy(&fm_event_cond); pthread_mutex_destroy(&fm_event_lock); #endif hidl_client_close(); /* Clean up before exiting */ Diag_LSM_DeInit(); exit(EXIT_SUCCESS); }