Fork ESP-IDF's bluetooth component
i want better sbc encoding, and no cla will stop me
This commit is contained in:
jacqueline
@@ -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) */
|
||||
@@ -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) */
|
||||
@@ -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 */
|
||||
Reference in New Issue
Block a user