michaelh/zephyr
1
0
Fork 0
Code Releases Activity

drivers: bluetooth: hci: Support ISO packets in ST HCI SPI BT driver

Browse source 
Add support for ISO packets in ST HCI SPI BT driver.

Signed-off-by: Ali Hozhabri <ali.hozhabri@st.com>
This commit is contained in:
Ali Hozhabri 2024-03-01 17:35:06 +01:00 • committed by Carles Cufí
commit 7392bf284c
1 changed files with 26 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

26
drivers/bluetooth/hci/hci_spi_st.c
View file

@ -33,6 +33,7 @@ LOG_MODULE_REGISTER(bt_driver);
#define HCI_ACL 0x02 #define HCI_ACL 0x02
#define HCI_SCO 0x03 #define HCI_SCO 0x03
#define HCI_EVT 0x04 #define HCI_EVT 0x04
#define HCI_ISO 0x05
/* ST Proprietary extended event */ /* ST Proprietary extended event */
#define HCI_EXT_EVT 0x82 #define HCI_EXT_EVT 0x82
@ -406,6 +407,26 @@ static struct net_buf *bt_spi_rx_buf_construct(uint8_t *msg)
} }
net_buf_add_mem(buf, &msg[1], len); net_buf_add_mem(buf, &msg[1], len);
break; break;
#if defined(CONFIG_BT_ISO)
case HCI_ISO:
struct bt_hci_iso_hdr iso_hdr;
buf = bt_buf_get_rx(BT_BUF_ISO_IN, timeout);
if (buf) {
memcpy(&iso_hdr, &msg[1], sizeof(iso_hdr));
len = sizeof(iso_hdr) + bt_iso_hdr_len(sys_le16_to_cpu(iso_hdr.len));
} else {
LOG_ERR("No available ISO buffers!");
return NULL;
}
if (len > net_buf_tailroom(buf)) {
LOG_ERR("ISO too long: %d", len);
net_buf_unref(buf);
return NULL;
}
net_buf_add_mem(buf, &msg[1], len);
break;
#endif /* CONFIG_BT_ISO */
default: default:
LOG_ERR("Unknown BT buf type %d", msg[0]); LOG_ERR("Unknown BT buf type %d", msg[0]);
return NULL; return NULL;
@ -488,6 +509,11 @@ static int bt_spi_send(struct net_buf *buf)
case BT_BUF_CMD: case BT_BUF_CMD:
net_buf_push_u8(buf, HCI_CMD); net_buf_push_u8(buf, HCI_CMD);
break; break;
#if defined(CONFIG_BT_ISO)
case BT_BUF_ISO_OUT:
net_buf_push_u8(buf, HCI_ISO);
break;
#endif /* CONFIG_BT_ISO */
default: default:
LOG_ERR("Unsupported type"); LOG_ERR("Unsupported type");
return -EINVAL; return -EINVAL;