Skip to content
Open
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
66 changes: 43 additions & 23 deletions nimble/host/src/ble_iso.c
Original file line number Diff line number Diff line change
Expand Up @@ -34,28 +34,6 @@
#define min(a, b) ((a) < (b) ? (a) : (b))
#endif

#define ble_iso_big_conn_handles_init(_big, _handles, _num_handles) \
do { \
struct ble_iso_conn *conn = SLIST_FIRST(&ble_iso_conns); \
\
for (uint8_t i = 0; i < (_num_handles); i++) { \
while (conn != NULL) { \
if (conn->type == BLE_ISO_CONN_BIS) { \
struct ble_iso_bis *bis; \
\
bis = CONTAINER_OF(conn, struct ble_iso_bis, conn); \
if (bis->big == (_big)) { \
conn->handle = le16toh((_handles)[i]); \
conn = SLIST_NEXT(conn, next); \
break; \
} \
} \
\
conn = SLIST_NEXT(conn, next); \
} \
} \
} while (0);

enum ble_iso_conn_type {
BLE_ISO_CONN_BIS,
};
Expand All @@ -73,7 +51,7 @@ struct ble_iso_big {
struct ble_iso_conn {
SLIST_ENTRY(ble_iso_conn) next;
enum ble_iso_conn_type type;
uint8_t handle;
uint16_t handle;

struct ble_iso_rx_data_info rx_info;
struct os_mbuf *rx_buf;
Expand All @@ -96,6 +74,47 @@ static struct os_mempool ble_iso_bis_pool;
static os_membuf_t ble_iso_bis_mem[
OS_MEMPOOL_SIZE(MYNEWT_VAL(BLE_ISO_MAX_BISES), sizeof (struct ble_iso_bis))];

static int
ble_iso_big_conn_handles_init(struct ble_iso_big *big, const void *data, uint8_t num_handles)
{
const uint8_t *handles = data;
struct ble_iso_conn *conn;
struct ble_iso_bis *bis;
uint8_t num_bis;

BLE_HS_DBG_ASSERT(big != NULL);
BLE_HS_DBG_ASSERT(handles != NULL);
BLE_HS_DBG_ASSERT(num_handles > 0);

num_bis = 0;

SLIST_FOREACH(conn, &ble_iso_conns, next) {
if (conn->type != BLE_ISO_CONN_BIS) {
continue;
}

bis = CONTAINER_OF(conn, struct ble_iso_bis, conn);
if (bis->big != big) {
continue;
}

BLE_HS_DBG_ASSERT(conn->handle == BLE_HS_CONN_HANDLE_NONE);

conn->handle = get_le16(&handles[num_bis * sizeof(uint16_t)]);

if (++num_bis == num_handles) {
break;
}
}

if (num_bis != num_handles) {
BLE_HS_LOG_ERROR("Not enough handles for BIG\n");
return BLE_HS_EINVAL;
}

return 0;
}

static void
ble_iso_conn_append(struct ble_iso_conn *conn)
{
Expand Down Expand Up @@ -184,6 +203,7 @@ ble_iso_bis_alloc(struct ble_iso_big *big)

memset(new_bis, 0, sizeof *new_bis);
new_bis->conn.type = BLE_ISO_CONN_BIS;
new_bis->conn.handle = BLE_HS_CONN_HANDLE_NONE;
new_bis->big = big;

ble_iso_conn_append(&new_bis->conn);
Expand Down
Loading