1 /****************************************************************************** 2 * 3 * Copyright (C) 2002-2012 Broadcom Corporation 4 * 5 * Licensed under the Apache License, Version 2.0 (the "License"); 6 * you may not use this file except in compliance with the License. 7 * You may obtain a copy of the License at: 8 * 9 * http://www.apache.org/licenses/LICENSE-2.0 10 * 11 * Unless required by applicable law or agreed to in writing, software 12 * distributed under the License is distributed on an "AS IS" BASIS, 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14 * See the License for the specific language governing permissions and 15 * limitations under the License. 16 * 17 ******************************************************************************/ 18 19 /****************************************************************************** 20 * 21 * Utility functions to help build and parse SBC Codec Information Element 22 * and Media Payload. 23 * 24 ******************************************************************************/ 25 26 #include "bt_target.h" 27 28 #include <string.h> 29 #include "a2d_api.h" 30 #include "a2d_int.h" 31 #include "a2d_sbc.h" 32 #include "bt_utils.h" 33 34 /****************************************************************************** 35 ** 36 ** Function A2D_BldSbcInfo 37 ** 38 ** Description This function is called by an application to build 39 ** the SBC Media Codec Capabilities byte sequence 40 ** beginning from the LOSC octet. 41 ** Input Parameters: 42 ** media_type: Indicates Audio, or Multimedia. 43 ** 44 ** p_ie: The SBC Codec Information Element information. 45 ** 46 ** Output Parameters: 47 ** p_result: the resulting codec info byte sequence. 48 ** 49 ** Returns A2D_SUCCESS if function execution succeeded. 50 ** Error status code, otherwise. 51 ******************************************************************************/ 52 tA2D_STATUS A2D_BldSbcInfo(UINT8 media_type, tA2D_SBC_CIE *p_ie, UINT8 *p_result) 53 { 54 tA2D_STATUS status; 55 56 if( p_ie == NULL || p_result == NULL || 57 (p_ie->samp_freq & ~A2D_SBC_IE_SAMP_FREQ_MSK) || 58 (p_ie->ch_mode & ~A2D_SBC_IE_CH_MD_MSK) || 59 (p_ie->block_len & ~A2D_SBC_IE_BLOCKS_MSK) || 60 (p_ie->num_subbands & ~A2D_SBC_IE_SUBBAND_MSK) || 61 (p_ie->alloc_mthd & ~A2D_SBC_IE_ALLOC_MD_MSK) || 62 (p_ie->max_bitpool < p_ie->min_bitpool) || 63 (p_ie->max_bitpool < A2D_SBC_IE_MIN_BITPOOL) || 64 (p_ie->max_bitpool > A2D_SBC_IE_MAX_BITPOOL) || 65 (p_ie->min_bitpool < A2D_SBC_IE_MIN_BITPOOL) || 66 (p_ie->min_bitpool > A2D_SBC_IE_MAX_BITPOOL) ) 67 { 68 /* if any unused bit is set */ 69 status = A2D_INVALID_PARAMS; 70 } 71 else 72 { 73 status = A2D_SUCCESS; 74 *p_result++ = A2D_SBC_INFO_LEN; 75 *p_result++ = media_type; 76 *p_result++ = A2D_MEDIA_CT_SBC; 77 78 /* Media Codec Specific Information Element */ 79 *p_result++ = p_ie->samp_freq | p_ie->ch_mode; 80 81 *p_result++ = p_ie->block_len | p_ie->num_subbands | p_ie->alloc_mthd; 82 83 *p_result++ = p_ie->min_bitpool; 84 *p_result = p_ie->max_bitpool; 85 } 86 return status; 87 } 88 89 /****************************************************************************** 90 ** 91 ** Function A2D_ParsSbcInfo 92 ** 93 ** Description This function is called by an application to parse 94 ** the SBC Media Codec Capabilities byte sequence 95 ** beginning from the LOSC octet. 96 ** Input Parameters: 97 ** p_info: the byte sequence to parse. 98 ** 99 ** for_caps: TRUE, if the byte sequence is for get capabilities response. 100 ** 101 ** Output Parameters: 102 ** p_ie: The SBC Codec Information Element information. 103 ** 104 ** Returns A2D_SUCCESS if function execution succeeded. 105 ** Error status code, otherwise. 106 ******************************************************************************/ 107 tA2D_STATUS A2D_ParsSbcInfo(tA2D_SBC_CIE *p_ie, const UINT8 *p_info, 108 BOOLEAN for_caps) 109 { 110 tA2D_STATUS status = A2D_SUCCESS; 111 UINT8 losc; 112 113 if (p_ie == NULL || p_info == NULL) 114 return A2D_INVALID_PARAMS; 115 116 losc = *p_info; 117 p_info += 2; 118 119 /* If the function is called for the wrong Media Type or Media Codec Type */ 120 if (losc != A2D_SBC_INFO_LEN || *p_info != A2D_MEDIA_CT_SBC) 121 return A2D_WRONG_CODEC; 122 123 p_info++; 124 p_ie->samp_freq = *p_info & A2D_SBC_IE_SAMP_FREQ_MSK; 125 p_ie->ch_mode = *p_info & A2D_SBC_IE_CH_MD_MSK; 126 p_info++; 127 p_ie->block_len = *p_info & A2D_SBC_IE_BLOCKS_MSK; 128 p_ie->num_subbands = *p_info & A2D_SBC_IE_SUBBAND_MSK; 129 p_ie->alloc_mthd = *p_info & A2D_SBC_IE_ALLOC_MD_MSK; 130 p_info++; 131 p_ie->min_bitpool = *p_info++; 132 p_ie->max_bitpool = *p_info; 133 if (p_ie->min_bitpool < A2D_SBC_IE_MIN_BITPOOL || p_ie->min_bitpool > A2D_SBC_IE_MAX_BITPOOL ) 134 status = A2D_BAD_MIN_BITPOOL; 135 136 if (p_ie->max_bitpool < A2D_SBC_IE_MIN_BITPOOL || p_ie->max_bitpool > A2D_SBC_IE_MAX_BITPOOL || 137 p_ie->max_bitpool < p_ie->min_bitpool) 138 status = A2D_BAD_MAX_BITPOOL; 139 140 if (for_caps != FALSE) 141 return status; 142 143 if (A2D_BitsSet(p_ie->samp_freq) != A2D_SET_ONE_BIT) 144 status = A2D_BAD_SAMP_FREQ; 145 if (A2D_BitsSet(p_ie->ch_mode) != A2D_SET_ONE_BIT) 146 status = A2D_BAD_CH_MODE; 147 if (A2D_BitsSet(p_ie->block_len) != A2D_SET_ONE_BIT) 148 status = A2D_BAD_BLOCK_LEN; 149 if (A2D_BitsSet(p_ie->num_subbands) != A2D_SET_ONE_BIT) 150 status = A2D_BAD_SUBBANDS; 151 if (A2D_BitsSet(p_ie->alloc_mthd) != A2D_SET_ONE_BIT) 152 status = A2D_BAD_ALLOC_MTHD; 153 154 return status; 155 } 156 157 /****************************************************************************** 158 ** 159 ** Function A2D_BldSbcMplHdr 160 ** 161 ** Description This function is called by an application to parse 162 ** the SBC Media Payload header. 163 ** Input Parameters: 164 ** frag: 1, if fragmented. 0, otherwise. 165 ** 166 ** start: 1, if the starting packet of a fragmented frame. 167 ** 168 ** last: 1, if the last packet of a fragmented frame. 169 ** 170 ** num: If frag is 1, this is the number of remaining fragments 171 ** (including this fragment) of this frame. 172 ** If frag is 0, this is the number of frames in this packet. 173 ** 174 ** Output Parameters: 175 ** p_dst: the resulting media payload header byte sequence. 176 ** 177 ** Returns void. 178 ******************************************************************************/ 179 void A2D_BldSbcMplHdr(UINT8 *p_dst, BOOLEAN frag, BOOLEAN start, BOOLEAN last, UINT8 num) 180 { 181 if(p_dst) 182 { 183 *p_dst = 0; 184 if(frag) 185 *p_dst |= A2D_SBC_HDR_F_MSK; 186 if(start) 187 *p_dst |= A2D_SBC_HDR_S_MSK; 188 if(last) 189 *p_dst |= A2D_SBC_HDR_L_MSK; 190 *p_dst |= (A2D_SBC_HDR_NUM_MSK & num); 191 } 192 } 193 194 /****************************************************************************** 195 ** 196 ** Function A2D_ParsSbcMplHdr 197 ** 198 ** Description This function is called by an application to parse 199 ** the SBC Media Payload header. 200 ** Input Parameters: 201 ** p_src: the byte sequence to parse.. 202 ** 203 ** Output Parameters: 204 ** frag: 1, if fragmented. 0, otherwise. 205 ** 206 ** start: 1, if the starting packet of a fragmented frame. 207 ** 208 ** last: 1, if the last packet of a fragmented frame. 209 ** 210 ** num: If frag is 1, this is the number of remaining fragments 211 ** (including this fragment) of this frame. 212 ** If frag is 0, this is the number of frames in this packet. 213 ** 214 ** Returns void. 215 ******************************************************************************/ 216 void A2D_ParsSbcMplHdr(UINT8 *p_src, BOOLEAN *p_frag, BOOLEAN *p_start, BOOLEAN *p_last, UINT8 *p_num) 217 { 218 if(p_src && p_frag && p_start && p_last && p_num) 219 { 220 *p_frag = (*p_src & A2D_SBC_HDR_F_MSK) ? TRUE: FALSE; 221 *p_start= (*p_src & A2D_SBC_HDR_S_MSK) ? TRUE: FALSE; 222 *p_last = (*p_src & A2D_SBC_HDR_L_MSK) ? TRUE: FALSE; 223 *p_num = (*p_src & A2D_SBC_HDR_NUM_MSK); 224 } 225 } 226 227
