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 ******************************************************************************/
A2D_BldSbcInfo(UINT8 media_type,tA2D_SBC_CIE * p_ie,UINT8 * p_result)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 ******************************************************************************/
A2D_ParsSbcInfo(tA2D_SBC_CIE * p_ie,const UINT8 * p_info,BOOLEAN for_caps)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 ******************************************************************************/
A2D_BldSbcMplHdr(UINT8 * p_dst,BOOLEAN frag,BOOLEAN start,BOOLEAN last,UINT8 num)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 ******************************************************************************/
A2D_ParsSbcMplHdr(UINT8 * p_src,BOOLEAN * p_frag,BOOLEAN * p_start,BOOLEAN * p_last,UINT8 * p_num)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