michaelh/zephyr
1
0
Fork 0
Code Releases Activity

drivers/bluetooth: ipm_stm32: Implement a RX thread

Browse source 
Fasten events handling by unloading callback treatment.
A RX thread is created. IPM RX events are dumped in a FIFO
which is processed in the thread context.

Signed-off-by: Erwan Gouriou <erwan.gouriou@linaro.org>
This commit is contained in:
Erwan Gouriou 2020-03-16 10:58:10 +01:00 • committed by Carles Cufí
commit 57a74653df
2 changed files with 74 additions and 43 deletions
Download patch file Download diff file Expand all files Collapse all files

5
drivers/bluetooth/hci/Kconfig
View file

@ -99,6 +99,11 @@ config BT_SPI_BLUENRG
endif # BT_SPI endif # BT_SPI
config BT_STM32_IPM_RX_STACK_SIZE
int "STM32 IPM stack size for RX thread"
depends on BT_STM32_IPM
default 256
config BT_RPMSG_NRF53 config BT_RPMSG_NRF53
bool "nRF53 configuration of RPMsg" bool "nRF53 configuration of RPMsg"
default y if (BOARD_NRF5340PDK_NRF5340_CPUAPP || BOARD_NRF5340PDK_NRF5340_CPUAPPNS) default y if (BOARD_NRF5340PDK_NRF5340_CPUAPP || BOARD_NRF5340PDK_NRF5340_CPUAPPNS)

46
drivers/bluetooth/hci/ipm_stm32wb.c
View file

@ -68,6 +68,11 @@ struct aci_set_ble_addr {
static bt_addr_t bd_addr_udn; static bt_addr_t bd_addr_udn;
/* Rx thread definitions */
K_FIFO_DEFINE(ipm_rx_events_fifo);
static K_THREAD_STACK_DEFINE(ipm_rx_stack, CONFIG_BT_STM32_IPM_RX_STACK_SIZE);
static struct k_thread ipm_rx_thread_data;
static void stm32wb_start_ble(void) static void stm32wb_start_ble(void)
{ {
SHCI_C2_Ble_Init_Cmd_Packet_t ble_init_cmd_packet = { SHCI_C2_Ble_Init_Cmd_Packet_t ble_init_cmd_packet = {
@ -139,10 +144,19 @@ static void tryfix_event(TL_Evt_t *tev)
void TM_EvtReceivedCb(TL_EvtPacket_t *hcievt) void TM_EvtReceivedCb(TL_EvtPacket_t *hcievt)
{ {
struct net_buf *buf; k_fifo_put(&ipm_rx_events_fifo, hcievt);
}
static void bt_ipm_rx_thread(void)
{
while (true) {
static TL_EvtPacket_t *hcievt;
struct net_buf *buf = NULL;
struct bt_hci_acl_hdr acl_hdr; struct bt_hci_acl_hdr acl_hdr;
TL_AclDataSerial_t *acl; TL_AclDataSerial_t *acl;
hcievt = k_fifo_get(&ipm_rx_events_fifo, K_FOREVER);
k_sem_take(&ipm_busy, K_NO_WAIT); k_sem_take(&ipm_busy, K_NO_WAIT);
switch (hcievt->evtserial.type) { switch (hcievt->evtserial.type) {
@ -154,11 +168,12 @@ void TM_EvtReceivedCb(TL_EvtPacket_t *hcievt)
/* Vendor events are currently unsupported */ /* Vendor events are currently unsupported */
BT_ERR("Unknown evtcode type 0x%02x", BT_ERR("Unknown evtcode type 0x%02x",
hcievt->evtserial.evt.evtcode); hcievt->evtserial.evt.evtcode);
goto out; k_sem_give(&ipm_busy);
default:
buf = bt_buf_get_evt(hcievt->evtserial.evt.evtcode, false,
K_FOREVER);
break; break;
default:
buf = bt_buf_get_evt(
hcievt->evtserial.evt.evtcode,
false, K_FOREVER);
} }
tryfix_event(&hcievt->evtserial.evt); tryfix_event(&hcievt->evtserial.evt);
net_buf_add_mem(buf, &hcievt->evtserial.evt, net_buf_add_mem(buf, &hcievt->evtserial.evt,
@ -169,14 +184,17 @@ void TM_EvtReceivedCb(TL_EvtPacket_t *hcievt)
buf = bt_buf_get_rx(BT_BUF_ACL_IN, K_FOREVER); buf = bt_buf_get_rx(BT_BUF_ACL_IN, K_FOREVER);
acl_hdr.handle = acl->handle; acl_hdr.handle = acl->handle;
acl_hdr.len = acl->length; acl_hdr.len = acl->length;
BT_DBG("ACL: handle %x, len %x", acl_hdr.handle, acl_hdr.len); BT_DBG("ACL: handle %x, len %x",
acl_hdr.handle, acl_hdr.len);
net_buf_add_mem(buf, &acl_hdr, sizeof(acl_hdr)); net_buf_add_mem(buf, &acl_hdr, sizeof(acl_hdr));
net_buf_add_mem(buf, (u8_t *)&acl->acl_data, acl_hdr.len); net_buf_add_mem(buf, (u8_t *)&acl->acl_data,
acl_hdr.len);
break; break;
default: default:
BT_ERR("Unknown BT buf type %d", hcievt->evtserial.type); BT_ERR("Unknown BT buf type %d",
hcievt->evtserial.type);
TL_MM_EvtDone(hcievt); TL_MM_EvtDone(hcievt);
goto out; k_sem_give(&ipm_busy);
} }
TL_MM_EvtDone(hcievt); TL_MM_EvtDone(hcievt);
@ -188,8 +206,9 @@ void TM_EvtReceivedCb(TL_EvtPacket_t *hcievt)
bt_recv(buf); bt_recv(buf);
} }
out:
k_sem_give(&ipm_busy); k_sem_give(&ipm_busy);
}
} }
static void TM_AclDataAck(void) static void TM_AclDataAck(void)
@ -476,6 +495,13 @@ static int bt_ipm_open(void)
{ {
int err; int err;
/* Start RX thread */
k_thread_create(&ipm_rx_thread_data, ipm_rx_stack,
K_THREAD_STACK_SIZEOF(ipm_rx_stack),
(k_thread_entry_t)bt_ipm_rx_thread, NULL, NULL, NULL,
K_PRIO_COOP(CONFIG_BT_RX_PRIO - 1),
0, K_NO_WAIT);
/* Take BLE out of reset */ /* Take BLE out of reset */
ipcc_reset(); ipcc_reset();