/******************************************************************************* ** ** Function userial_open ** ** Description Open Bluetooth device with the port ID ** ** Returns TRUE/FALSE ** *******************************************************************************/ uint8_t userial_open(uint8_t port) { struct sched_param param; int policy, result; pthread_attr_t thread_attr; int fd_array[CH_MAX]; USERIALDBG("userial_open(port:%d)", port); if (userial_running) { /* Userial is open; close it first */ userial_close(); utils_delay(50); } if (port >= MAX_SERIAL_PORT) { ALOGE("Port > MAX_SERIAL_PORT"); return FALSE; } /* Calling vendor-specific part */ if (bt_vnd_if) { result = bt_vnd_if->op(BT_VND_OP_USERIAL_OPEN, &fd_array); if (result != 1) { ALOGE("userial_open: wrong numbers of open fd in vendor lib [%d]!", result); ALOGE("userial_open: HCI UART expects only one open fd"); bt_vnd_if->op(BT_VND_OP_USERIAL_CLOSE, NULL); return FALSE; } userial_cb.fd = fd_array[0]; } else { ALOGE("userial_open: missing vendor lib interface !!!"); ALOGE("userial_open: unable to open UART port"); return FALSE; } if (userial_cb.fd == -1) { ALOGE("userial_open: failed to open UART port"); return FALSE; } USERIALDBG( "fd = %d", userial_cb.fd); userial_cb.port = port; pthread_attr_init(&thread_attr); if (pthread_create(&(userial_cb.read_thread), &thread_attr, \ userial_read_thread, NULL) != 0 ) { ALOGE("pthread_create failed!"); return FALSE; } if(pthread_getschedparam(userial_cb.read_thread, &policy, ¶m)==0) { policy = BTHC_LINUX_BASE_POLICY; #if (BTHC_LINUX_BASE_POLICY!=SCHED_NORMAL) param.sched_priority = BTHC_USERIAL_READ_THREAD_PRIORITY; #endif result = pthread_setschedparam(userial_cb.read_thread, policy, ¶m); if (result != 0) { ALOGW("userial_open: pthread_setschedparam failed (%s)", \ strerror(result)); } } return TRUE; }
/******************************************************************************* ** ** Function userial_open ** ** Description Open Bluetooth device with the port ID ** ** Returns TRUE/FALSE ** *******************************************************************************/ uint8_t userial_open(uint8_t port) { struct sched_param param; int policy, result; pthread_attr_t thread_attr; USERIALDBG("userial_open(port:%d)", port); if (userial_running) { /* Userial is open; close it first */ userial_close(); utils_delay(50); } if (port >= MAX_SERIAL_PORT) { ALOGE("Port > MAX_SERIAL_PORT"); return FALSE; } /* Calling vendor-specific part */ if (bt_vnd_if) { result = bt_vnd_if->op(BT_VND_OP_USERIAL_OPEN, &userial_cb.fd); if ((result != 2) && (result != 4)) { ALOGE("userial_open: wrong numbers of open fd in vendor lib [%d]!", result); ALOGE("userial_open: HCI MCT expects 2 or 4 open file descriptors"); bt_vnd_if->op(BT_VND_OP_USERIAL_CLOSE, NULL); return FALSE; } } else { ALOGE("userial_open: missing vendor lib interface !!!"); ALOGE("userial_open: unable to open BT transport"); return FALSE; } ALOGI("CMD=%d, EVT=%d, ACL_Out=%d, ACL_In=%d", \ userial_cb.fd[CH_CMD], userial_cb.fd[CH_EVT], \ userial_cb.fd[CH_ACL_OUT], userial_cb.fd[CH_ACL_IN]); if ((userial_cb.fd[CH_CMD] == -1) || (userial_cb.fd[CH_EVT] == -1) || (userial_cb.fd[CH_ACL_OUT] == -1) || (userial_cb.fd[CH_ACL_IN] == -1)) { ALOGE("userial_open: failed to open BT transport"); bt_vnd_if->op(BT_VND_OP_USERIAL_CLOSE, NULL); return FALSE; } userial_cb.port = port; /* Start listening thread */ pthread_attr_init(&thread_attr); if (pthread_create(&(userial_cb.read_thread), &thread_attr, \ userial_read_thread, NULL) != 0 ) { ALOGE("pthread_create failed!"); bt_vnd_if->op(BT_VND_OP_USERIAL_CLOSE, NULL); return FALSE; } if(pthread_getschedparam(userial_cb.read_thread, &policy, ¶m)==0) { policy = BTHC_LINUX_BASE_POLICY; #if (BTHC_LINUX_BASE_POLICY != SCHED_NORMAL) param.sched_priority = BTHC_USERIAL_READ_THREAD_PRIORITY; #else param.sched_priority = 0; #endif result = pthread_setschedparam(userial_cb.read_thread, policy, ¶m); if (result != 0) { ALOGW("userial_open: pthread_setschedparam failed (%s)", \ strerror(result)); } } return TRUE; }
/******************************************************************************* ** ** Function userial_read_thread ** ** Description ** ** Returns void * ** *******************************************************************************/ static void *userial_read_thread(void *arg) { int rx_length = 0; HC_BT_HDR *p_buf = NULL; uint8_t *p; USERIALDBG("Entering userial_read_thread()"); prctl(PR_SET_NAME, (unsigned long)"userial_read", 0, 0, 0); rx_flow_on = TRUE; userial_running = 1; raise_priority_a2dp(TASK_HIGH_USERIAL_READ); while (userial_running) { if (bt_hc_cbacks) { p_buf = (HC_BT_HDR *) bt_hc_cbacks->alloc( \ BTHC_USERIAL_READ_MEM_SIZE); } else p_buf = NULL; if (p_buf != NULL) { p_buf->offset = 0; p_buf->layer_specific = 0; p = (uint8_t *) (p_buf + 1); rx_length = select_read(userial_cb.fd, p, READ_LIMIT); } else { rx_length = 0; utils_delay(100); ALOGW("userial_read_thread() failed to gain buffers"); continue; } if (rx_length > 0) { p_buf->len = (uint16_t)rx_length; utils_enqueue(&(userial_cb.rx_q), p_buf); bthc_signal_event(HC_EVENT_RX); } else /* either 0 or < 0 */ { ALOGW("select_read return size <=0:%d, exiting userial_read_thread",\ rx_length); /* if we get here, we should have a buffer */ bt_hc_cbacks->dealloc((TRANSAC) p_buf, (char *) (p_buf + 1)); /* negative value means exit thread */ break; } } /* for */ userial_running = 0; USERIALDBG("Leaving userial_read_thread()"); pthread_exit(NULL); return NULL; // Compiler friendly }