int
ble_hs_test_util_l2cap_rx_payload_flat(struct ble_hs_conn *conn,
struct ble_l2cap_chan *chan,
const void *data, int len)
{
struct hci_data_hdr hci_hdr;
struct os_mbuf *om;
int rc;
om = ble_hs_misc_pkthdr();
TEST_ASSERT_FATAL(om != NULL);
om->om_data += BLE_L2CAP_HDR_SZ;
rc = os_mbuf_append(om, data, len);
TEST_ASSERT_FATAL(rc == 0);
om = ble_l2cap_prepend_hdr(om, chan->blc_cid, OS_MBUF_PKTLEN(om));
TEST_ASSERT_FATAL(om != NULL);
hci_hdr.hdh_handle_pb_bc =
host_hci_handle_pb_bc_join(conn->bhc_handle,
BLE_HCI_PB_FIRST_FLUSH, 0);
hci_hdr.hdh_len = OS_MBUF_PKTHDR(om)->omp_len;
rc = ble_hs_test_util_l2cap_rx(conn, &hci_hdr, om);
return rc;
}
int
ble_l2cap_sig_init_cmd(uint8_t op, uint8_t id, uint8_t payload_len,
struct os_mbuf **out_om, void **out_payload_buf)
{
struct ble_l2cap_sig_hdr hdr;
struct os_mbuf *txom;
void *v;
*out_om = NULL;
*out_payload_buf = NULL;
txom = ble_hs_misc_pkthdr();
if (txom == NULL) {
return BLE_HS_ENOMEM;
}
v = os_mbuf_extend(txom, BLE_L2CAP_SIG_HDR_SZ + payload_len);
if (v == NULL) {
return BLE_HS_ENOMEM;
}
hdr.op = op;
hdr.identifier = id;
hdr.length = TOFROMLE16(payload_len);
ble_l2cap_sig_hdr_write(v, BLE_L2CAP_SIG_HDR_SZ, &hdr);
*out_om = txom;
*out_payload_buf = (uint8_t *)v + BLE_L2CAP_SIG_HDR_SZ;
return 0;
}
static int
ble_att_clt_init_req(uint16_t initial_sz, struct os_mbuf **out_txom)
{
void *buf;
int rc;
*out_txom = ble_hs_misc_pkthdr();
if (*out_txom == NULL) {
rc = BLE_HS_ENOMEM;
goto err;
}
buf = os_mbuf_extend(*out_txom, initial_sz);
if (buf == NULL) {
rc = BLE_HS_ENOMEM;
goto err;
}
/* The caller expects the initial buffer to be at the start of the mbuf. */
BLE_HS_DBG_ASSERT(buf == (*out_txom)->om_data);
return 0;
err:
os_mbuf_free_chain(*out_txom);
*out_txom = NULL;
return rc;
}
