/*
|
* Licensed to the Apache Software Foundation (ASF) under one
|
* or more contributor license agreements. See the NOTICE file
|
* distributed with this work for additional information
|
* regarding copyright ownership. The ASF licenses this file
|
* to you under the Apache License, Version 2.0 (the
|
* "License"); you may not use this file except in compliance
|
* with the License. You may obtain a copy of the License at
|
*
|
* http://www.apache.org/licenses/LICENSE-2.0
|
*
|
* Unless required by applicable law or agreed to in writing,
|
* software distributed under the License is distributed on an
|
* "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
|
* KIND, either express or implied. See the License for the
|
* specific language governing permissions and limitations
|
* under the License.
|
*/
|
|
#include "host/ble_hs.h"
|
#include "host/ble_hs_mbuf.h"
|
#include "ble_hs_priv.h"
|
|
/**
|
* Allocates an mbuf for use by the nimble host.
|
*/
|
static struct os_mbuf *
|
ble_hs_mbuf_gen_pkt(uint16_t leading_space)
|
{
|
struct os_mbuf *om;
|
int rc;
|
|
#if MYNEWT_VAL(BLE_CONTROLLER)
|
om = os_msys_get_pkthdr(0, sizeof(struct ble_mbuf_hdr));
|
#else
|
om = os_msys_get_pkthdr(0, 0);
|
#endif
|
if (om == NULL) {
|
return NULL;
|
}
|
|
if (om->om_omp->omp_databuf_len < leading_space) {
|
rc = os_mbuf_free_chain(om);
|
BLE_HS_DBG_ASSERT_EVAL(rc == 0);
|
return NULL;
|
}
|
|
om->om_data += leading_space;
|
|
return om;
|
}
|
|
/**
|
* Allocates an mbuf with no leading space.
|
*
|
* @return An empty mbuf on success; null on memory
|
* exhaustion.
|
*/
|
struct os_mbuf *
|
ble_hs_mbuf_bare_pkt(void)
|
{
|
return ble_hs_mbuf_gen_pkt(0);
|
}
|
|
/**
|
* Allocates an mbuf suitable for an HCI ACL data packet.
|
*
|
* @return An empty mbuf on success; null on memory
|
* exhaustion.
|
*/
|
struct os_mbuf *
|
ble_hs_mbuf_acl_pkt(void)
|
{
|
return ble_hs_mbuf_gen_pkt(BLE_HCI_DATA_HDR_SZ);
|
}
|
|
/**
|
* Allocates an mbuf suitable for an L2CAP data packet. The resulting packet
|
* has sufficient leading space for:
|
* o ACL data header
|
* o L2CAP B-frame header
|
*
|
* @return An empty mbuf on success; null on memory
|
* exhaustion.
|
*/
|
struct os_mbuf *
|
ble_hs_mbuf_l2cap_pkt(void)
|
{
|
return ble_hs_mbuf_gen_pkt(BLE_HCI_DATA_HDR_SZ + BLE_L2CAP_HDR_SZ);
|
}
|
|
struct os_mbuf *
|
ble_hs_mbuf_att_pkt(void)
|
{
|
/* Prepare write request and response are the larget ATT commands which
|
* contain attribute data.
|
*/
|
return ble_hs_mbuf_gen_pkt(BLE_HCI_DATA_HDR_SZ +
|
BLE_L2CAP_HDR_SZ +
|
BLE_ATT_PREP_WRITE_CMD_BASE_SZ);
|
}
|
|
struct os_mbuf *
|
ble_hs_mbuf_from_flat(const void *buf, uint16_t len)
|
{
|
struct os_mbuf *om;
|
int rc;
|
|
om = ble_hs_mbuf_att_pkt();
|
if (om == NULL) {
|
return NULL;
|
}
|
|
rc = os_mbuf_copyinto(om, 0, buf, len);
|
if (rc != 0) {
|
os_mbuf_free_chain(om);
|
return NULL;
|
}
|
|
return om;
|
}
|
|
int
|
ble_hs_mbuf_to_flat(const struct os_mbuf *om, void *flat, uint16_t max_len,
|
uint16_t *out_copy_len)
|
{
|
uint16_t copy_len;
|
int rc;
|
|
if (OS_MBUF_PKTLEN(om) <= max_len) {
|
copy_len = OS_MBUF_PKTLEN(om);
|
} else {
|
copy_len = max_len;
|
}
|
|
rc = os_mbuf_copydata(om, 0, copy_len, flat);
|
if (rc != 0) {
|
return BLE_HS_EUNKNOWN;
|
}
|
|
if (copy_len > max_len) {
|
rc = BLE_HS_EMSGSIZE;
|
} else {
|
rc = 0;
|
}
|
|
if (out_copy_len != NULL) {
|
*out_copy_len = copy_len;
|
}
|
return rc;
|
}
|
|
int
|
ble_hs_mbuf_pullup_base(struct os_mbuf **om, int base_len)
|
{
|
if (OS_MBUF_PKTLEN(*om) < base_len) {
|
return BLE_HS_EBADDATA;
|
}
|
|
*om = os_mbuf_pullup(*om, base_len);
|
if (*om == NULL) {
|
return BLE_HS_ENOMEM;
|
}
|
|
return 0;
|
}
|
