15821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)/****************************************************************************** 25821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * 35821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Copyright (C) 2002-2012 Broadcom Corporation 45821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * 55821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Licensed under the Apache License, Version 2.0 (the "License"); 65821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * you may not use this file except in compliance with the License. 75821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * You may obtain a copy of the License at: 85821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * 95821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * http://www.apache.org/licenses/LICENSE-2.0 105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * 117dbb3d5cf0c15f500944d211057644d6a2f37371Ben Murdoch * Unless required by applicable law or agreed to in writing, software 125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * distributed under the License is distributed on an "AS IS" BASIS, 135821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * See the License for the specific language governing permissions and 151320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci * limitations under the License. 161320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci * 17cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles) ******************************************************************************/ 18cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles) 19c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch/****************************************************************************** 20c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * 21c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles) * Utility functions to help build and parse SBC Codec Information Element 22c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * and Media Payload. 23c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * 24c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch ******************************************************************************/ 25c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 26c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#include "bt_target.h" 27c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#include <string.h> 28c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#include "a2d_api.h" 29c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#include "a2d_int.h" 30c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles)#include "a2d_sbc.h" 31c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#include "bt_utils.h" 32c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 33c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles)#if (A2D_SBC_INCLUDED == TRUE) 34c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 35c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch/************************************************************************************************* 36c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles) * SBC descramble code 37c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * Purpose: to tie the SBC code with BTE/mobile stack code, 38c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * especially for the case when the SBC is ported into a third-party Multimedia chip 39c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles) * 40c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * Algorithm: 41c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * init process: all counters reset to 0, 42c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles) * calculate base_index: (6 + s16NumOfChannels*s16NumOfSubBands/2) 43c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * scramble side: the init process happens every time SBC_Encoder_Init() is called. 44c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * descramble side: it would be nice to know if he "init" process has happened. 455821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * alter the SBC SYNC word 0x9C (1001 1100) to 0x8C (1000 1100). 46c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * 47c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * scramble process: 485821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * The CRC byte: 49c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * Every SBC frame has a frame header. 50c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * The 1st byte is the sync word and the following 2 bytes are about the stream format. 515821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * They are supposed to be "constant" within a "song" 52c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * The 4th byte is the CRC byte. The CRC byte is bound to be random. 53c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * Derive 2 items from the CRC byte; one is the "use" bit, the other is the "index". 545d1f7b1de12d16ceb2c938c56701a3e8bfa558f7Torne (Richard Coles) * 55c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * SBC keeps 2 sets of "use" & "index"; derived the current and the previous frame. 56c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * 57a3f6a49ab37290eeeb8db0f41ec0f1cb74a68be7Torne (Richard Coles) * The "use" bit is any bit in SBC_PRTC_USE_MASK is set. 58c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * If set, SBC uses the "index" from the current frame. 59c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * If not set, SBC uses the "index" from the previous frame or 0. 602a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) * 61c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * index = (CRC & 0x3) + ((CRC & 0x30) >> 2) // 8 is the max index 62c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * 632a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) * if(index > 0) 64c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * { 65c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * p = &u8frame[base_index]; 662a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) * if((index&1)&&(u16PacketLength > (base_index+index*2))) 67c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * { 68c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * // odd index: swap 2 bytes 69c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles) * tmp = p[index]; 70c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * p[index] = p[index*2]; 71c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * p[index*2] = tmp; 722a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) * } 73c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * else 74c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * { 755821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * // even index: shift by 3 761320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci * tmp = (p[index] >> 3) + (p[index] << 5); 771320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci * p[index] = tmp; 781320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci * } 79c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * } 80c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch * //else index is 0. The frame stays unaltered 812a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) * 821320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci */ 831320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci#define A2D_SBC_SYNC_WORD 0x9C 841320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci#define A2D_SBC_CRC_IDX 3 85c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#define A2D_SBC_USE_MASK 0x64 86c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#define A2D_SBC_SYNC_MASK 0x10 8790dce4d38c5ff5333bea97d859d4e484e27edf0cTorne (Richard Coles)#define A2D_SBC_CIDX 0 88c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#define A2D_SBC_LIDX 1 89c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#define A2D_SBC_CH_M_BITS 0xC /* channel mode bits: 0: mono; 1 ch */ 9090dce4d38c5ff5333bea97d859d4e484e27edf0cTorne (Richard Coles)#define A2D_SBC_SUBBAND_BIT 0x1 /* num of subband bit: 0:4; 1: 8 */ 91c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 92c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch#define A2D_SBC_GET_IDX(sc) (((sc) & 0x3) + (((sc) & 0x30) >> 2)) 935821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 94c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdochtypedef struct 95c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch{ 965821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UINT8 use; 97c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT8 idx; 98c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch} tA2D_SBC_FR_CB; 992a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) 100c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdochtypedef struct 101c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch{ 1025821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) tA2D_SBC_FR_CB fr[2]; 103c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT8 index; 104c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT8 base; 1055821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} tA2D_SBC_DS_CB; 106c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 107c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdochstatic tA2D_SBC_DS_CB a2d_sbc_ds_cb; 1085821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)/*int a2d_count = 0;*/ 109c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch/****************************************************************************** 110c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 1115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)** Function A2D_SbcChkFrInit 112c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 113c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Description check if need to init the descramble control block. 1145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)** 115c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Returns nothing. 116c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch******************************************************************************/ 117c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdochvoid A2D_SbcChkFrInit(UINT8 *p_pkt) 118c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch{ 1195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UINT8 fmt; 120c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT8 num_chnl = 1; 121c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT8 num_subband = 4; 1225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 123c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch if((p_pkt[0] & A2D_SBC_SYNC_MASK) == 0) 124c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 1255821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) a2d_cb.use_desc = TRUE; 126c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch fmt = p_pkt[1]; 127c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_pkt[0] |= A2D_SBC_SYNC_MASK; 1285821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) memset(&a2d_sbc_ds_cb, 0, sizeof(tA2D_SBC_DS_CB)); 129c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch if(fmt & A2D_SBC_CH_M_BITS) 130c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch num_chnl = 2; 1315821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if(fmt & A2D_SBC_SUBBAND_BIT) 132c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch num_subband = 8; 133c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch a2d_sbc_ds_cb.base = 6 + num_chnl*num_subband/2; 1345821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /*printf("base: %d\n", a2d_sbc_ds_cb.base); 135c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch a2d_count = 0;*/ 136c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch } 1375821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 138c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 139c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch/****************************************************************************** 1405821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)** 141c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Function A2D_SbcDescramble 142c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 1435821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)** Description descramble the packet. 144c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 145c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Returns nothing. 1465821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)******************************************************************************/ 147c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdochvoid A2D_SbcDescramble(UINT8 *p_pkt, UINT16 len) 148c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch{ 1495821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) tA2D_SBC_FR_CB *p_cur, *p_last; 150c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT32 idx, tmp, tmp2; 151c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 1525821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if(a2d_cb.use_desc) 153c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 154c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* c2l */ 1555821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) p_last = &a2d_sbc_ds_cb.fr[A2D_SBC_LIDX]; 156c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_cur = &a2d_sbc_ds_cb.fr[A2D_SBC_CIDX]; 157c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_last->idx = p_cur->idx; 158c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_last->use = p_cur->use; 1595821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* getc */ 160c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_cur->use = p_pkt[A2D_SBC_CRC_IDX] & A2D_SBC_USE_MASK; 161c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_cur->idx = A2D_SBC_GET_IDX(p_pkt[A2D_SBC_CRC_IDX]); 1622a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) a2d_sbc_ds_cb.index = (p_cur->use)?A2D_SBC_CIDX:A2D_SBC_LIDX; 163c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* 164c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch printf("%05d: ar[%02d]: x%02x, msk: x%02x, use: %s, idx: %02d, ", 1652a99a7e74a7f215066514fe81d2bfa6639d9edddTorne (Richard Coles) a2d_count++, 166c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch A2D_SBC_CRC_IDX, p_pkt[A2D_SBC_CRC_IDX], A2D_SBC_USE_MASK, 167c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_cur->use)?"cur":"lst", p_cur->idx); 16890dce4d38c5ff5333bea97d859d4e484e27edf0cTorne (Richard Coles) */ 169c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* descramble */ 170c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch idx = a2d_sbc_ds_cb.fr[a2d_sbc_ds_cb.index].idx; 171c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch if(idx > 0) 172c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 17390dce4d38c5ff5333bea97d859d4e484e27edf0cTorne (Richard Coles) p_pkt = &p_pkt[a2d_sbc_ds_cb.base]; 174c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch if((idx&1) && (len > (a2d_sbc_ds_cb.base+(idx<<1)))) 175c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 17690dce4d38c5ff5333bea97d859d4e484e27edf0cTorne (Richard Coles) tmp2 = (idx<<1); 177c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch tmp = p_pkt[idx]; 178c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_pkt[idx] = p_pkt[tmp2]; 17990dce4d38c5ff5333bea97d859d4e484e27edf0cTorne (Richard Coles) p_pkt[tmp2] = tmp; 180c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* 181c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch printf("tmp2: %02d, len: %d, idx: %d\n", 1825821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) tmp2, len, a2d_sbc_ds_cb.fr[a2d_sbc_ds_cb.index].idx); 183c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch */ 184c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch } 185c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch else 186c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 187c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch tmp2 = p_pkt[idx]; 188c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch tmp = (tmp2>>3)+(tmp2<<5); 189c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch p_pkt[idx] = (UINT8)tmp; 190c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* 191c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch printf("tmp: x%02x, len: %d, idx: %d(cmp:%d)\n", 192c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (UINT8)tmp2, len, a2d_sbc_ds_cb.fr[a2d_sbc_ds_cb.index].idx, 193c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (a2d_sbc_ds_cb.base+(idx<<1))); 194c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch */ 195c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch } 196c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch } 197c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* 198c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch else 199c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 200c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch printf("!!!!\n"); 201c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch } 202c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch */ 20358537e28ecd584eab876aee8be7156509866d23aTorne (Richard Coles) } 2045821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 205c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 206c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch/****************************************************************************** 207c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 208cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles)** Function A2D_BldSbcInfo 209cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles)** 210cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles)** Description This function is called by an application to build 211cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles)** the SBC Media Codec Capabilities byte sequence 2121320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci** beginning from the LOSC octet. 2131320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci** Input Parameters: 2141320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci** media_type: Indicates Audio, or Multimedia. 2151320f92c476a1ad9d19dba2a48c72b75566198e9Primiano Tucci** 216010d83a9304c5a91596085d917d248abff47903aTorne (Richard Coles)** p_ie: The SBC Codec Information Element information. 217010d83a9304c5a91596085d917d248abff47903aTorne (Richard Coles)** 218010d83a9304c5a91596085d917d248abff47903aTorne (Richard Coles)** Output Parameters: 219010d83a9304c5a91596085d917d248abff47903aTorne (Richard Coles)** p_result: the resulting codec info byte sequence. 220010d83a9304c5a91596085d917d248abff47903aTorne (Richard Coles)** 221c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Returns A2D_SUCCESS if function execution succeeded. 222c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Error status code, otherwise. 223010d83a9304c5a91596085d917d248abff47903aTorne (Richard Coles)******************************************************************************/ 224c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen MurdochtA2D_STATUS A2D_BldSbcInfo(UINT8 media_type, tA2D_SBC_CIE *p_ie, UINT8 *p_result) 225c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch{ 226c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch tA2D_STATUS status; 227c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 228c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch if( p_ie == NULL || p_result == NULL || 229c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->samp_freq & ~A2D_SBC_IE_SAMP_FREQ_MSK) || 230c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->ch_mode & ~A2D_SBC_IE_CH_MD_MSK) || 231c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->block_len & ~A2D_SBC_IE_BLOCKS_MSK) || 232c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->num_subbands & ~A2D_SBC_IE_SUBBAND_MSK) || 2335821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) (p_ie->alloc_mthd & ~A2D_SBC_IE_ALLOC_MD_MSK) || 2345821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) (p_ie->max_bitpool < p_ie->min_bitpool) || 235c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->max_bitpool < A2D_SBC_IE_MIN_BITPOOL) || 236c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->max_bitpool > A2D_SBC_IE_MAX_BITPOOL) || 237c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->min_bitpool < A2D_SBC_IE_MIN_BITPOOL) || 238c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch (p_ie->min_bitpool > A2D_SBC_IE_MAX_BITPOOL) ) 239c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 240c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* if any unused bit is set */ 241c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch status = A2D_INVALID_PARAMS; 242c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch } 243c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch else 244c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 245c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch status = A2D_SUCCESS; 246c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch *p_result++ = A2D_SBC_INFO_LEN; 247c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch *p_result++ = media_type; 248c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch *p_result++ = A2D_MEDIA_CT_SBC; 249c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 250c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* Media Codec Specific Information Element */ 251c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch *p_result++ = p_ie->samp_freq | p_ie->ch_mode; 252c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 253c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch *p_result++ = p_ie->block_len | p_ie->num_subbands | p_ie->alloc_mthd; 254c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 255c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch *p_result++ = p_ie->min_bitpool; 256c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch *p_result = p_ie->max_bitpool; 2575821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 258cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles) return status; 259cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles)} 260cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles) 261cedac228d2dd51db4b79ea1e72c7f249408ee061Torne (Richard Coles)/****************************************************************************** 262c2e0dbddbe15c98d52c4786dac06cb8952a8ae6dTorne (Richard Coles)** 2635821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)** Function A2D_ParsSbcInfo 264a3f6a49ab37290eeeb8db0f41ec0f1cb74a68be7Torne (Richard Coles)** 265c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Description This function is called by an application to parse 266c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** the SBC Media Codec Capabilities byte sequence 267c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** beginning from the LOSC octet. 268c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Input Parameters: 269c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** p_info: the byte sequence to parse. 270c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 271c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** for_caps: TRUE, if the byte sequence is for get capabilities response. 272c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 273c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Output Parameters: 274c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** p_ie: The SBC Codec Information Element information. 275c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** 276c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Returns A2D_SUCCESS if function execution succeeded. 277c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch** Error status code, otherwise. 278c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch******************************************************************************/ 279c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen MurdochtA2D_STATUS A2D_ParsSbcInfo(tA2D_SBC_CIE *p_ie, UINT8 *p_info, BOOLEAN for_caps) 280c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch{ 281c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch tA2D_STATUS status; 282c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT8 losc; 283c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch UINT8 mt; 284c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch 285c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch if( p_ie == NULL || p_info == NULL) 286c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch status = A2D_INVALID_PARAMS; 287c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch else 288c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 289c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch losc = *p_info++; 290c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch mt = *p_info++; 291c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch /* If the function is called for the wrong Media Type or Media Codec Type */ 292c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch if(losc != A2D_SBC_INFO_LEN || *p_info != A2D_MEDIA_CT_SBC) 293c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch status = A2D_WRONG_CODEC; 294c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch else 295c5cede9ae108bb15f6b7a8aea21c7e1fefa2834cBen Murdoch { 296a3f6a49ab37290eeeb8db0f41ec0f1cb74a68be7Torne (Richard Coles) p_info++; 297a3f6a49ab37290eeeb8db0f41ec0f1cb74a68be7Torne (Richard Coles) p_ie->samp_freq = *p_info & A2D_SBC_IE_SAMP_FREQ_MSK; 2985821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) p_ie->ch_mode = *p_info & A2D_SBC_IE_CH_MD_MSK; 299 p_info++; 300 p_ie->block_len = *p_info & A2D_SBC_IE_BLOCKS_MSK; 301 p_ie->num_subbands = *p_info & A2D_SBC_IE_SUBBAND_MSK; 302 p_ie->alloc_mthd = *p_info & A2D_SBC_IE_ALLOC_MD_MSK; 303 p_info++; 304 p_ie->min_bitpool = *p_info++; 305 p_ie->max_bitpool = *p_info; 306 status = A2D_SUCCESS; 307 if(p_ie->min_bitpool < A2D_SBC_IE_MIN_BITPOOL || p_ie->min_bitpool > A2D_SBC_IE_MAX_BITPOOL ) 308 status = A2D_BAD_MIN_BITPOOL; 309 310 if(p_ie->max_bitpool < A2D_SBC_IE_MIN_BITPOOL || p_ie->max_bitpool > A2D_SBC_IE_MAX_BITPOOL || 311 p_ie->max_bitpool < p_ie->min_bitpool) 312 status = A2D_BAD_MAX_BITPOOL; 313 314 if(for_caps == FALSE) 315 { 316 if(A2D_BitsSet(p_ie->samp_freq) != A2D_SET_ONE_BIT) 317 status = A2D_BAD_SAMP_FREQ; 318 if(A2D_BitsSet(p_ie->ch_mode) != A2D_SET_ONE_BIT) 319 status = A2D_BAD_CH_MODE; 320 if(A2D_BitsSet(p_ie->block_len) != A2D_SET_ONE_BIT) 321 status = A2D_BAD_BLOCK_LEN; 322 if(A2D_BitsSet(p_ie->num_subbands) != A2D_SET_ONE_BIT) 323 status = A2D_BAD_SUBBANDS; 324 if(A2D_BitsSet(p_ie->alloc_mthd) != A2D_SET_ONE_BIT) 325 status = A2D_BAD_ALLOC_MTHD; 326 } 327 } 328 } 329 return status; 330} 331 332/****************************************************************************** 333** 334** Function A2D_BldSbcMplHdr 335** 336** Description This function is called by an application to parse 337** the SBC Media Payload header. 338** Input Parameters: 339** frag: 1, if fragmented. 0, otherwise. 340** 341** start: 1, if the starting packet of a fragmented frame. 342** 343** last: 1, if the last packet of a fragmented frame. 344** 345** num: If frag is 1, this is the number of remaining fragments 346** (including this fragment) of this frame. 347** If frag is 0, this is the number of frames in this packet. 348** 349** Output Parameters: 350** p_dst: the resulting media payload header byte sequence. 351** 352** Returns void. 353******************************************************************************/ 354void A2D_BldSbcMplHdr(UINT8 *p_dst, BOOLEAN frag, BOOLEAN start, BOOLEAN last, UINT8 num) 355{ 356 if(p_dst) 357 { 358 *p_dst = 0; 359 if(frag) 360 *p_dst |= A2D_SBC_HDR_F_MSK; 361 if(start) 362 *p_dst |= A2D_SBC_HDR_S_MSK; 363 if(last) 364 *p_dst |= A2D_SBC_HDR_L_MSK; 365 *p_dst |= (A2D_SBC_HDR_NUM_MSK & num); 366 } 367} 368 369/****************************************************************************** 370** 371** Function A2D_ParsSbcMplHdr 372** 373** Description This function is called by an application to parse 374** the SBC Media Payload header. 375** Input Parameters: 376** p_src: the byte sequence to parse.. 377** 378** Output Parameters: 379** frag: 1, if fragmented. 0, otherwise. 380** 381** start: 1, if the starting packet of a fragmented frame. 382** 383** last: 1, if the last packet of a fragmented frame. 384** 385** num: If frag is 1, this is the number of remaining fragments 386** (including this fragment) of this frame. 387** If frag is 0, this is the number of frames in this packet. 388** 389** Returns void. 390******************************************************************************/ 391void A2D_ParsSbcMplHdr(UINT8 *p_src, BOOLEAN *p_frag, BOOLEAN *p_start, BOOLEAN *p_last, UINT8 *p_num) 392{ 393 if(p_src && p_frag && p_start && p_last && p_num) 394 { 395 *p_frag = (*p_src & A2D_SBC_HDR_F_MSK) ? TRUE: FALSE; 396 *p_start= (*p_src & A2D_SBC_HDR_S_MSK) ? TRUE: FALSE; 397 *p_last = (*p_src & A2D_SBC_HDR_L_MSK) ? TRUE: FALSE; 398 *p_num = (*p_src & A2D_SBC_HDR_NUM_MSK); 399 } 400} 401 402#else /* A2D_SBC_INCLUDED == TRUE */ 403 404void A2D_SbcChkFrInit(UINT8 *p_pkt) 405{ 406 UNUSED(p_pkt); 407} 408 409void A2D_SbcDescramble(UINT8 *p_pkt, UINT16 len) 410{ 411 UNUSED(p_pkt); 412 UNUSED(len); 413} 414 415tA2D_STATUS A2D_BldSbcInfo(UINT8 media_type, tA2D_SBC_CIE *p_ie, 416 UINT8 *p_result) 417{ 418 UNUSED(media_type); 419 UNUSED(p_ie); 420 UNUSED(p_result); 421 return A2D_FAIL; 422} 423 424tA2D_STATUS A2D_ParsSbcInfo(tA2D_SBC_CIE *p_ie, UINT8 *p_info, 425 BOOLEAN for_caps) 426{ 427 UNUSED(p_ie); 428 UNUSED(p_info); 429 UNUSED(for_caps); 430 return A2D_FAIL; 431} 432 433void A2D_BldSbcMplHdr(UINT8 *p_dst, BOOLEAN frag, BOOLEAN start, 434 BOOLEAN last, UINT8 num) 435{ 436 UNUSED(p_dst); 437 UNUSED(frag); 438 UNUSED(start); 439 UNUSED(last); 440 UNUSED(num); 441} 442 443void A2D_ParsSbcMplHdr(UINT8 *p_src, BOOLEAN *p_frag, 444 BOOLEAN *p_start, BOOLEAN *p_last, 445 UINT8 *p_num) 446{ 447 UNUSED(p_src); 448 UNUSED(p_frag); 449 UNUSED(p_start); 450 UNUSED(p_last); 451 UNUSED(p_num); 452} 453 454 455#endif /* A2D_SBC_INCLUDED == TRUE */ 456