Fork ESP-IDF's bluetooth component

i want better sbc encoding, and no cla will stop me

3 files changed, 739 insertions, 0 deletions

diff --git a/lib/bt/host/bluedroid/stack/a2dp/a2d_api.c b/lib/bt/host/bluedroid/stack/a2dp/a2d_api.c
new file mode 100644
index 00000000..87ff14c3
--- /dev/null
+++ b/lib/bt/host/bluedroid/stack/a2dp/a2d_api.c
@@ -0,0 +1,434 @@
+/******************************************************************************
+ *
+ *  Copyright (C) 2002-2012 Broadcom Corporation
+ *
+ *  Licensed 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.
+ *
+ ******************************************************************************/
+
+/******************************************************************************
+ *
+ *  ommon API for the Advanced Audio Distribution Profile (A2DP)
+ *
+ ******************************************************************************/
+#include <string.h>
+#include "common/bt_target.h"
+#include "stack/sdpdefs.h"
+#include "stack/a2d_api.h"
+#include "a2d_int.h"
+#include "stack/avdt_api.h"
+#include "osi/allocator.h"
+
+#if (defined(A2D_INCLUDED) && A2D_INCLUDED == TRUE)
+
+/*****************************************************************************
+**  Global data
+*****************************************************************************/
+#if A2D_DYNAMIC_MEMORY == FALSE
+tA2D_CB a2d_cb;
+#else
+tA2D_CB *a2d_cb_ptr;
+#endif
+
+
+/******************************************************************************
+**
+** Function         a2d_sdp_cback
+**
+** Description      This is the SDP callback function used by A2D_FindService.
+**                  This function will be executed by SDP when the service
+**                  search is completed.  If the search is successful, it
+**                  finds the first record in the database that matches the
+**                  UUID of the search.  Then retrieves various parameters
+**                  from the record.  When it is finished it calls the
+**                  application callback function.
+**
+** Returns          Nothing.
+**
+******************************************************************************/
+static void a2d_sdp_cback(UINT16 status)
+{
+    tSDP_DISC_REC       *p_rec = NULL;
+    tSDP_DISC_ATTR      *p_attr;
+    BOOLEAN             found = FALSE;
+    tA2D_Service        a2d_svc;
+    tSDP_PROTOCOL_ELEM  elem;
+
+    A2D_TRACE_API("a2d_sdp_cback status: %d", status);
+
+    if (status == SDP_SUCCESS) {
+        /* loop through all records we found */
+        do {
+            /* get next record; if none found, we're done */
+            if ((p_rec = SDP_FindServiceInDb(a2d_cb.find.p_db,
+                                             a2d_cb.find.service_uuid, p_rec)) == NULL) {
+                break;
+            }
+            memset(&a2d_svc, 0, sizeof(tA2D_Service));
+
+            /* get service name */
+            if ((p_attr = SDP_FindAttributeInRec(p_rec,
+                                                 ATTR_ID_SERVICE_NAME)) != NULL) {
+                a2d_svc.p_service_name = (char *) p_attr->attr_value.v.array;
+                a2d_svc.service_len    = SDP_DISC_ATTR_LEN(p_attr->attr_len_type);
+            }
+
+            /* get provider name */
+            if ((p_attr = SDP_FindAttributeInRec(p_rec,
+                                                 ATTR_ID_PROVIDER_NAME)) != NULL) {
+                a2d_svc.p_provider_name = (char *) p_attr->attr_value.v.array;
+                a2d_svc.provider_len    = SDP_DISC_ATTR_LEN(p_attr->attr_len_type);
+            }
+
+            /* get supported features */
+            if ((p_attr = SDP_FindAttributeInRec(p_rec,
+                                                 ATTR_ID_SUPPORTED_FEATURES)) != NULL) {
+                a2d_svc.features = p_attr->attr_value.v.u16;
+            }
+
+            /* get AVDTP version */
+            if (SDP_FindProtocolListElemInRec(p_rec, UUID_PROTOCOL_AVDTP, &elem)) {
+                a2d_svc.avdt_version = elem.params[0];
+                A2D_TRACE_DEBUG("avdt_version: 0x%x", a2d_svc.avdt_version);
+            }
+
+            /* we've got everything, we're done */
+            found = TRUE;
+            break;
+
+        } while (TRUE);
+    }
+
+    a2d_cb.find.service_uuid = 0;
+    /* return info from sdp record in app callback function */
+    if (a2d_cb.find.p_cback != NULL) {
+        (*a2d_cb.find.p_cback)(found, &a2d_svc);
+    }
+
+    return;
+}
+
+/*******************************************************************************
+**
+** Function         a2d_set_avdt_sdp_ver
+**
+** Description      This function allows the script wrapper to change the
+**                  avdt version of a2dp.
+**
+** Returns          None
+**
+*******************************************************************************/
+void a2d_set_avdt_sdp_ver(UINT16 avdt_sdp_ver)
+{
+    a2d_cb.avdt_sdp_ver = avdt_sdp_ver;
+}
+
+/*******************************************************************************
+ *
+ * Function         a2d_set_a2dp_sdp_ver
+ *
+ * Description      This function allows the script wrapper to change the
+ *                  a2dp version
+ *
+ * Returns          None
+ *
+ ******************************************************************************/
+void a2d_set_a2dp_sdp_ver(UINT16 a2dp_sdp_ver)
+{
+    a2d_cb.a2dp_sdp_ver = a2dp_sdp_ver;
+}
+
+/******************************************************************************
+**
+** Function         A2D_AddRecord
+**
+** Description      This function is called by a server application to add
+**                  SRC or SNK information to an SDP record.  Prior to
+**                  calling this function the application must call
+**                  SDP_CreateRecord() to create an SDP record.
+**
+**                  Input Parameters:
+**                      service_uuid:  Indicates SRC or SNK.
+**
+**                      p_service_name:  Pointer to a null-terminated character
+**                      string containing the service name.
+**
+**                      p_provider_name:  Pointer to a null-terminated character
+**                      string containing the provider name.
+**
+**                      features:  Profile supported features.
+**
+**                      sdp_handle:  SDP handle returned by SDP_CreateRecord().
+**
+**                  Output Parameters:
+**                      None.
+**
+** Returns          A2D_SUCCESS if function execution succeeded,
+**                  A2D_INVALID_PARAMS if bad parameters are given.
+**                  A2D_FAIL if function execution failed.
+**
+******************************************************************************/
+tA2D_STATUS A2D_AddRecord(UINT16 service_uuid, char *p_service_name, char *p_provider_name,
+                          UINT16 features, UINT32 sdp_handle)
+{
+    UINT16      browse_list[1];
+    BOOLEAN     result = TRUE;
+    UINT8       temp[8];
+    UINT8       *p;
+    tSDP_PROTOCOL_ELEM  proto_list [A2D_NUM_PROTO_ELEMS];
+
+    A2D_TRACE_API("A2D_AddRecord uuid: %x", service_uuid);
+
+    if ( (sdp_handle == 0) ||
+            (service_uuid != UUID_SERVCLASS_AUDIO_SOURCE && service_uuid != UUID_SERVCLASS_AUDIO_SINK) ) {
+        return A2D_INVALID_PARAMS;
+    }
+
+    /* add service class id list */
+    result &= SDP_AddServiceClassIdList(sdp_handle, 1, &service_uuid);
+
+    memset((void *) proto_list, 0 , A2D_NUM_PROTO_ELEMS * sizeof(tSDP_PROTOCOL_ELEM));
+
+    /* add protocol descriptor list   */
+    proto_list[0].protocol_uuid = UUID_PROTOCOL_L2CAP;
+    proto_list[0].num_params = 1;
+    proto_list[0].params[0] = AVDT_PSM;
+    proto_list[1].protocol_uuid = UUID_PROTOCOL_AVDTP;
+    proto_list[1].num_params = 1;
+    proto_list[1].params[0] = a2d_cb.avdt_sdp_ver;
+
+    result &= SDP_AddProtocolList(sdp_handle, A2D_NUM_PROTO_ELEMS, proto_list);
+
+    /* add profile descriptor list   */
+    result &= SDP_AddProfileDescriptorList(sdp_handle, UUID_SERVCLASS_ADV_AUDIO_DISTRIBUTION, a2d_cb.a2dp_sdp_ver);
+
+    /* add supported feature */
+    if (features != 0) {
+        p = temp;
+        UINT16_TO_BE_STREAM(p, features);
+        result &= SDP_AddAttribute(sdp_handle, ATTR_ID_SUPPORTED_FEATURES, UINT_DESC_TYPE,
+                                   (UINT32)2, (UINT8 *)temp);
+    }
+
+    /* add provider name */
+    if (p_provider_name != NULL) {
+        result &= SDP_AddAttribute(sdp_handle, ATTR_ID_PROVIDER_NAME, TEXT_STR_DESC_TYPE,
+                                   (UINT32)(strlen(p_provider_name) + 1), (UINT8 *) p_provider_name);
+    }
+
+    /* add service name */
+    if (p_service_name != NULL) {
+        result &= SDP_AddAttribute(sdp_handle, ATTR_ID_SERVICE_NAME, TEXT_STR_DESC_TYPE,
+                                   (UINT32)(strlen(p_service_name) + 1), (UINT8 *) p_service_name);
+    }
+
+    /* add browse group list */
+    browse_list[0] = UUID_SERVCLASS_PUBLIC_BROWSE_GROUP;
+    result &= SDP_AddUuidSequence(sdp_handle, ATTR_ID_BROWSE_GROUP_LIST, 1, browse_list);
+
+
+    return (result ? A2D_SUCCESS : A2D_FAIL);
+}
+
+/******************************************************************************
+**
+** Function         A2D_FindService
+**
+** Description      This function is called by a client application to
+**                  perform service discovery and retrieve SRC or SNK SDP
+**                  record information from a server.  Information is
+**                  returned for the first service record found on the
+**                  server that matches the service UUID.  The callback
+**                  function will be executed when service discovery is
+**                  complete.  There can only be one outstanding call to
+**                  A2D_FindService() at a time; the application must wait
+**                  for the callback before it makes another call to
+**                  the function.
+**
+**                  Input Parameters:
+**                      service_uuid:  Indicates SRC or SNK.
+**
+**                      bd_addr:  BD address of the peer device.
+**
+**                      p_db:  Pointer to the information to initialize
+**                             the discovery database.
+**
+**                      p_cback:  Pointer to the A2D_FindService()
+**                      callback function.
+**
+**                  Output Parameters:
+**                      None.
+**
+** Returns          A2D_SUCCESS if function execution succeeded,
+**                  A2D_INVALID_PARAMS if bad parameters are given.
+**                  A2D_BUSY if discovery is already in progress.
+**                  A2D_FAIL if function execution failed.
+**
+******************************************************************************/
+tA2D_STATUS A2D_FindService(UINT16 service_uuid, BD_ADDR bd_addr,
+                            tA2D_SDP_DB_PARAMS *p_db, tA2D_FIND_CBACK *p_cback)
+{
+    tSDP_UUID   uuid_list;
+    BOOLEAN     result = TRUE;
+    UINT16      a2d_attr_list[] = {ATTR_ID_SERVICE_CLASS_ID_LIST, /* update A2D_NUM_ATTR, if changed */
+                                   ATTR_ID_BT_PROFILE_DESC_LIST,
+                                   ATTR_ID_SUPPORTED_FEATURES,
+                                   ATTR_ID_SERVICE_NAME,
+                                   ATTR_ID_PROTOCOL_DESC_LIST,
+                                   ATTR_ID_PROVIDER_NAME
+                                  };
+
+    A2D_TRACE_API("A2D_FindService uuid: %x", service_uuid);
+    if ( (service_uuid != UUID_SERVCLASS_AUDIO_SOURCE && service_uuid != UUID_SERVCLASS_AUDIO_SINK) ||
+            p_db == NULL || p_db->p_db == NULL || p_cback == NULL) {
+        return A2D_INVALID_PARAMS;
+    }
+
+    if ( a2d_cb.find.service_uuid == UUID_SERVCLASS_AUDIO_SOURCE ||
+            a2d_cb.find.service_uuid == UUID_SERVCLASS_AUDIO_SINK) {
+        return A2D_BUSY;
+    }
+
+    /* set up discovery database */
+    uuid_list.len = LEN_UUID_16;
+    uuid_list.uu.uuid16 = service_uuid;
+
+    if (p_db->p_attrs == NULL || p_db->num_attr == 0) {
+        p_db->p_attrs  = a2d_attr_list;
+        p_db->num_attr = A2D_NUM_ATTR;
+    }
+
+    result = SDP_InitDiscoveryDb(p_db->p_db, p_db->db_len, 1, &uuid_list, p_db->num_attr,
+                                 p_db->p_attrs);
+
+    if (result == TRUE) {
+        /* store service_uuid and discovery db pointer */
+        a2d_cb.find.p_db = p_db->p_db;
+        a2d_cb.find.service_uuid = service_uuid;
+        a2d_cb.find.p_cback = p_cback;
+
+        /* perform service search */
+        result = SDP_ServiceSearchAttributeRequest(bd_addr, p_db->p_db, a2d_sdp_cback);
+        if (FALSE == result) {
+            a2d_cb.find.service_uuid = 0;
+        }
+    }
+
+    return (result ? A2D_SUCCESS : A2D_FAIL);
+}
+
+/******************************************************************************
+**
+** Function         A2D_SetTraceLevel
+**
+** Description      Sets the trace level for A2D. If 0xff is passed, the
+**                  current trace level is returned.
+**
+**                  Input Parameters:
+**                      new_level:  The level to set the A2D tracing to:
+**                      0xff-returns the current setting.
+**                      0-turns off tracing.
+**                      >= 1-Errors.
+**                      >= 2-Warnings.
+**                      >= 3-APIs.
+**                      >= 4-Events.
+**                      >= 5-Debug.
+**
+** Returns          The new trace level or current trace level if
+**                  the input parameter is 0xff.
+**
+******************************************************************************/
+UINT8 A2D_SetTraceLevel (UINT8 new_level)
+{
+    if (new_level != 0xFF) {
+        a2d_cb.trace_level = new_level;
+    }
+
+    return (a2d_cb.trace_level);
+}
+
+/******************************************************************************
+** Function         A2D_BitsSet
+**
+** Description      Check the given num for the number of bits set
+** Returns          A2D_SET_ONE_BIT, if one and only one bit is set
+**                  A2D_SET_ZERO_BIT, if all bits clear
+**                  A2D_SET_MULTL_BIT, if multiple bits are set
+******************************************************************************/
+UINT8 A2D_BitsSet(UINT8 num)
+{
+    UINT8 count;
+    UINT8 res;
+    if (num == 0) {
+        res = A2D_SET_ZERO_BIT;
+    } else {
+        count = (num & (num - 1));
+        res = ((count == 0) ? A2D_SET_ONE_BIT : A2D_SET_MULTL_BIT);
+    }
+    return res;
+}
+
+/*******************************************************************************
+**
+** Function         A2D_Init
+**
+** Description      This function is called to initialize the control block
+**                  for this layer.  It must be called before accessing any
+**                  other API functions for this layer.  It is typically called
+**                  once during the start up of the stack.
+**
+** Returns          status
+**
+*******************************************************************************/
+bt_status_t A2D_Init(void)
+{
+#if (A2D_DYNAMIC_MEMORY)
+    a2d_cb_ptr = (tA2D_CB *)osi_malloc(sizeof(tA2D_CB));
+    if (!a2d_cb_ptr) {
+        return BT_STATUS_NOMEM;
+    }
+#endif /* #if (A2D_DYNAMIC_MEMORY) */
+    memset(&a2d_cb, 0, sizeof(tA2D_CB));
+
+    a2d_cb.avdt_sdp_ver = AVDT_VERSION;
+    a2d_cb.a2dp_sdp_ver = A2D_VERSION;
+
+#if defined(A2D_INITIAL_TRACE_LEVEL)
+    a2d_cb.trace_level  = A2D_INITIAL_TRACE_LEVEL;
+#else
+    a2d_cb.trace_level  = BT_TRACE_LEVEL_NONE;
+#endif
+    return BT_STATUS_SUCCESS;
+}
+
+/*******************************************************************************
+**
+** Function         A2D_Deinit
+**
+** Description      This function is called to deinitialize the control block
+**                  for this layer.
+**
+** Returns          void
+**
+*******************************************************************************/
+void A2D_Deinit(void)
+{
+#if (A2D_DYNAMIC_MEMORY)
+    if (a2d_cb_ptr) {
+        osi_free(a2d_cb_ptr);
+        a2d_cb_ptr = NULL;
+    }
+#endif /* #if (A2D_DYNAMIC_MEMORY) */
+}
+
+#endif /* #if (defined(A2D_INCLUDED) && A2D_INCLUDED == TRUE) */
diff --git a/lib/bt/host/bluedroid/stack/a2dp/a2d_sbc.c b/lib/bt/host/bluedroid/stack/a2dp/a2d_sbc.c
new file mode 100644
index 00000000..d02dd384
--- /dev/null
+++ b/lib/bt/host/bluedroid/stack/a2dp/a2d_sbc.c
@@ -0,0 +1,228 @@
+/******************************************************************************
+ *
+ *  Copyright (C) 2002-2012 Broadcom Corporation
+ *
+ *  Licensed 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.
+ *
+ ******************************************************************************/
+
+/******************************************************************************
+ *
+ *  Utility functions to help build and parse SBC Codec Information Element
+ *  and Media Payload.
+ *
+ ******************************************************************************/
+
+#include "common/bt_target.h"
+
+#include <string.h>
+#include "stack/a2d_api.h"
+#include "a2d_int.h"
+#include "stack/a2d_sbc.h"
+#include "common/bt_defs.h"
+
+#if (defined(A2D_INCLUDED) && A2D_INCLUDED == TRUE)
+
+/******************************************************************************
+**
+** Function         A2D_BldSbcInfo
+**
+** Description      This function is called by an application to build
+**                  the SBC Media Codec Capabilities byte sequence
+**                  beginning from the LOSC octet.
+**                  Input Parameters:
+**                      media_type:  Indicates Audio, or Multimedia.
+**
+**                      p_ie:  The SBC Codec Information Element information.
+**
+**                  Output Parameters:
+**                      p_result:  the resulting codec info byte sequence.
+**
+** Returns          A2D_SUCCESS if function execution succeeded.
+**                  Error status code, otherwise.
+******************************************************************************/
+tA2D_STATUS A2D_BldSbcInfo(UINT8 media_type, tA2D_SBC_CIE *p_ie, UINT8 *p_result)
+{
+    tA2D_STATUS status;
+
+    if ( p_ie == NULL || p_result == NULL ||
+            (p_ie->samp_freq & ~A2D_SBC_IE_SAMP_FREQ_MSK) ||
+            (p_ie->ch_mode & ~A2D_SBC_IE_CH_MD_MSK) ||
+            (p_ie->block_len & ~A2D_SBC_IE_BLOCKS_MSK) ||
+            (p_ie->num_subbands & ~A2D_SBC_IE_SUBBAND_MSK) ||
+            (p_ie->alloc_mthd & ~A2D_SBC_IE_ALLOC_MD_MSK) ||
+            (p_ie->max_bitpool < p_ie->min_bitpool) ||
+            (p_ie->max_bitpool < A2D_SBC_IE_MIN_BITPOOL) ||
+            (p_ie->max_bitpool > A2D_SBC_IE_MAX_BITPOOL) ||
+            (p_ie->min_bitpool < A2D_SBC_IE_MIN_BITPOOL) ||
+            (p_ie->min_bitpool > A2D_SBC_IE_MAX_BITPOOL) ) {
+        /* if any unused bit is set */
+        status = A2D_INVALID_PARAMS;
+    } else {
+        status = A2D_SUCCESS;
+        *p_result++ = A2D_SBC_INFO_LEN;
+        *p_result++ = media_type;
+        *p_result++ = A2D_MEDIA_CT_SBC;
+
+        /* Media Codec Specific Information Element */
+        *p_result++ = p_ie->samp_freq | p_ie->ch_mode;
+
+        *p_result++ = p_ie->block_len | p_ie->num_subbands | p_ie->alloc_mthd;
+
+        *p_result++ = p_ie->min_bitpool;
+        *p_result   = p_ie->max_bitpool;
+    }
+    return status;
+}
+
+/******************************************************************************
+**
+** Function         A2D_ParsSbcInfo
+**
+** Description      This function is called by an application to parse
+**                  the SBC Media Codec Capabilities byte sequence
+**                  beginning from the LOSC octet.
+**                  Input Parameters:
+**                      p_info:  the byte sequence to parse.
+**
+**                      for_caps:  TRUE, if the byte sequence is for get capabilities response.
+**
+**                  Output Parameters:
+**                      p_ie:  The SBC Codec Information Element information.
+**
+** Returns          A2D_SUCCESS if function execution succeeded.
+**                  Error status code, otherwise.
+******************************************************************************/
+tA2D_STATUS A2D_ParsSbcInfo(tA2D_SBC_CIE *p_ie, UINT8 *p_info, BOOLEAN for_caps)
+{
+    tA2D_STATUS status = A2D_SUCCESS;
+    UINT8   losc;
+
+    if ( p_ie == NULL || p_info == NULL) {
+        status = A2D_INVALID_PARAMS;
+    } else {
+        losc    = *p_info++;
+        p_info++;
+        /* If the function is called for the wrong Media Type or Media Codec Type */
+        if (losc != A2D_SBC_INFO_LEN || *p_info != A2D_MEDIA_CT_SBC) {
+            status = A2D_WRONG_CODEC;
+        } else {
+            p_info++;
+            p_ie->samp_freq = *p_info & A2D_SBC_IE_SAMP_FREQ_MSK;
+            p_ie->ch_mode   = *p_info & A2D_SBC_IE_CH_MD_MSK;
+            p_info++;
+            p_ie->block_len     = *p_info & A2D_SBC_IE_BLOCKS_MSK;
+            p_ie->num_subbands  = *p_info & A2D_SBC_IE_SUBBAND_MSK;
+            p_ie->alloc_mthd    = *p_info & A2D_SBC_IE_ALLOC_MD_MSK;
+            p_info++;
+            p_ie->min_bitpool = *p_info++;
+            p_ie->max_bitpool = *p_info;
+            if (p_ie->min_bitpool < A2D_SBC_IE_MIN_BITPOOL || p_ie->min_bitpool > A2D_SBC_IE_MAX_BITPOOL ) {
+                status = A2D_BAD_MIN_BITPOOL;
+            }
+
+            if (p_ie->max_bitpool < A2D_SBC_IE_MIN_BITPOOL || p_ie->max_bitpool > A2D_SBC_IE_MAX_BITPOOL ||
+                    p_ie->max_bitpool < p_ie->min_bitpool) {
+                status = A2D_BAD_MAX_BITPOOL;
+            }
+
+            if (for_caps == FALSE) {
+                if (A2D_BitsSet(p_ie->samp_freq) != A2D_SET_ONE_BIT) {
+                    status = A2D_BAD_SAMP_FREQ;
+                } else if (A2D_BitsSet(p_ie->ch_mode) != A2D_SET_ONE_BIT) {
+                    status = A2D_BAD_CH_MODE;
+                } else if (A2D_BitsSet(p_ie->block_len) != A2D_SET_ONE_BIT) {
+                    status = A2D_BAD_BLOCK_LEN;
+                } else if (A2D_BitsSet(p_ie->num_subbands) != A2D_SET_ONE_BIT) {
+                    status = A2D_BAD_SUBBANDS;
+                } else if (A2D_BitsSet(p_ie->alloc_mthd) != A2D_SET_ONE_BIT) {
+                    status = A2D_BAD_ALLOC_MTHD;
+                }
+            }
+        }
+    }
+    return status;
+}
+
+/******************************************************************************
+**
+** Function         A2D_BldSbcMplHdr
+**
+** Description      This function is called by an application to parse
+**                  the SBC Media Payload header.
+**                  Input Parameters:
+**                      frag:  1, if fragmented. 0, otherwise.
+**
+**                      start:  1, if the starting packet of a fragmented frame.
+**
+**                      last:  1, if the last packet of a fragmented frame.
+**
+**                      num:  If frag is 1, this is the number of remaining fragments
+**                            (including this fragment) of this frame.
+**                            If frag is 0, this is the number of frames in this packet.
+**
+**                  Output Parameters:
+**                      p_dst:  the resulting media payload header byte sequence.
+**
+** Returns          void.
+******************************************************************************/
+void A2D_BldSbcMplHdr(UINT8 *p_dst, BOOLEAN frag, BOOLEAN start, BOOLEAN last, UINT8 num)
+{
+    if (p_dst) {
+        *p_dst  = 0;
+        if (frag) {
+            *p_dst  |= A2D_SBC_HDR_F_MSK;
+        }
+        if (start) {
+            *p_dst  |= A2D_SBC_HDR_S_MSK;
+        }
+        if (last) {
+            *p_dst  |= A2D_SBC_HDR_L_MSK;
+        }
+        *p_dst  |= (A2D_SBC_HDR_NUM_MSK & num);
+    }
+}
+
+/******************************************************************************
+**
+** Function         A2D_ParsSbcMplHdr
+**
+** Description      This function is called by an application to parse
+**                  the SBC Media Payload header.
+**                  Input Parameters:
+**                      p_src:  the byte sequence to parse..
+**
+**                  Output Parameters:
+**                      frag:  1, if fragmented. 0, otherwise.
+**
+**                      start:  1, if the starting packet of a fragmented frame.
+**
+**                      last:  1, if the last packet of a fragmented frame.
+**
+**                      num:  If frag is 1, this is the number of remaining fragments
+**                            (including this fragment) of this frame.
+**                            If frag is 0, this is the number of frames in this packet.
+**
+** Returns          void.
+******************************************************************************/
+void A2D_ParsSbcMplHdr(UINT8 *p_src, BOOLEAN *p_frag, BOOLEAN *p_start, BOOLEAN *p_last, UINT8 *p_num)
+{
+    if (p_src && p_frag && p_start && p_last && p_num) {
+        *p_frag = (*p_src & A2D_SBC_HDR_F_MSK) ? TRUE : FALSE;
+        *p_start = (*p_src & A2D_SBC_HDR_S_MSK) ? TRUE : FALSE;
+        *p_last = (*p_src & A2D_SBC_HDR_L_MSK) ? TRUE : FALSE;
+        *p_num  = (*p_src & A2D_SBC_HDR_NUM_MSK);
+    }
+}
+
+#endif /* #if (defined(A2D_INCLUDED) && A2D_INCLUDED == TRUE) */
diff --git a/lib/bt/host/bluedroid/stack/a2dp/include/a2d_int.h b/lib/bt/host/bluedroid/stack/a2dp/include/a2d_int.h
new file mode 100644
index 00000000..e1ec7b44
--- /dev/null
+++ b/lib/bt/host/bluedroid/stack/a2dp/include/a2d_int.h
@@ -0,0 +1,77 @@
+/******************************************************************************
+ *
+ *  Copyright (C) 2002-2012 Broadcom Corporation
+ *
+ *  Licensed 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.
+ *
+ ******************************************************************************/
+
+/******************************************************************************
+ *
+ *  2DP internal header file
+ *
+ ******************************************************************************/
+#ifndef A2D_INT_H
+#define A2D_INT_H
+
+#include "stack/a2d_api.h"
+#if (A2D_INCLUDED == TRUE)
+/*****************************************************************************
+**  Constants
+*****************************************************************************/
+
+/* Number of attributes in A2D SDP record. */
+#define A2D_NUM_ATTR            6
+
+/* Number of protocol elements in protocol element list. */
+#define A2D_NUM_PROTO_ELEMS     2
+
+/*****************************************************************************
+**  Type definitions
+*****************************************************************************/
+
+/* Control block used by A2D_FindService(). */
+typedef struct {
+    tA2D_FIND_CBACK     *p_cback;       /* pointer to application callback */
+    tSDP_DISCOVERY_DB   *p_db;          /* pointer to discovery database */
+    UINT16              service_uuid;   /* service UUID of search */
+} tA2D_FIND_CB;
+
+typedef struct {
+    tA2D_FIND_CB    find;   /* find service control block */
+    UINT8           trace_level;
+    UINT16          avdt_sdp_ver;   /* AVDTP version */
+    UINT16          a2dp_sdp_ver;   /* A2DP version */
+} tA2D_CB;
+
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+/******************************************************************************
+** Main Control Block
+*******************************************************************************/
+#if A2D_DYNAMIC_MEMORY == FALSE
+extern tA2D_CB  a2d_cb;
+#else
+extern tA2D_CB *a2d_cb_ptr;
+#define a2d_cb (*a2d_cb_ptr)
+#endif
+
+#ifdef __cplusplus
+}
+#endif
+#endif  ///A2D_INCLUDED == TRUE
+#endif /* A2D_INT_H */