1 /****************************************************************************** 2 * 3 * Copyright (C) 2014 The Android Open Source Project 4 * Copyright 2003 - 2004 Open Interface North America, Inc. All rights 5 * reserved. 6 * 7 * Licensed under the Apache License, Version 2.0 (the "License"); 8 * you may not use this file except in compliance with the License. 9 * You may obtain a copy of the License at: 10 * 11 * http://www.apache.org/licenses/LICENSE-2.0 12 * 13 * Unless required by applicable law or agreed to in writing, software 14 * distributed under the License is distributed on an "AS IS" BASIS, 15 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 16 * See the License for the specific language governing permissions and 17 * limitations under the License. 18 * 19 ******************************************************************************/ 20 21 /******************************************************************************* 22 $Revision: #1 $ 23 ******************************************************************************/ 24 25 /** 26 @file 27 Checksum and header-related functions. 28 29 @ingroup codec_internal 30 */ 31 32 /** 33 @addtogroup codec_internal 34 @{ 35 */ 36 37 #include "oi_assert.h" 38 #include "oi_codec_sbc_private.h" 39 40 /* asdasd */ 41 42 #define USE_NIBBLEWISE_CRC 43 44 /* #define PRINT_SAMPLES */ 45 /* #define PRINT_SCALEFACTORS */ 46 /* #define DEBUG_CRC */ 47 48 /* 49 * CRC-8 table for X^8 + X^4 + X^3 + X^2 + 1; byte-wise lookup 50 */ 51 #ifdef USE_WIDE_CRC 52 /* Save space if a char is 16 bits, such as on the C54x */ 53 const OI_BYTE crc8_wide[128] = { 54 0x001d, 0x3a27, 0x7469, 0x4e53, 0xe8f5, 0xd2cf, 0x9c81, 0xa6bb, 0xcdd0, 55 0xf7ea, 0xb9a4, 0x839e, 0x2538, 0x1f02, 0x514c, 0x6b76, 0x879a, 0xbda0, 56 0xf3ee, 0xc9d4, 0x6f72, 0x5548, 0x1b06, 0x213c, 0x4a57, 0x706d, 0x3e23, 57 0x0419, 0xa2bf, 0x9885, 0xd6cb, 0xecf1, 0x130e, 0x2934, 0x677a, 0x5d40, 58 0xfbe6, 0xc1dc, 0x8f92, 0xb5a8, 0xdec3, 0xe4f9, 0xaab7, 0x908d, 0x362b, 59 0x0c11, 0x425f, 0x7865, 0x9489, 0xaeb3, 0xe0fd, 0xdac7, 0x7c61, 0x465b, 60 0x0815, 0x322f, 0x5944, 0x637e, 0x2d30, 0x170a, 0xb1ac, 0x8b96, 0xc5d8, 61 0xffe2, 0x263b, 0x1c01, 0x524f, 0x6875, 0xced3, 0xf4e9, 0xbaa7, 0x809d, 62 0xebf6, 0xd1cc, 0x9f82, 0xa5b8, 0x031e, 0x3924, 0x776a, 0x4d50, 0xa1bc, 63 0x9b86, 0xd5c8, 0xeff2, 0x4954, 0x736e, 0x3d20, 0x071a, 0x6c71, 0x564b, 64 0x1805, 0x223f, 0x8499, 0xbea3, 0xf0ed, 0xcad7, 0x3528, 0x0f12, 0x415c, 65 0x7b66, 0xddc0, 0xe7fa, 0xa9b4, 0x938e, 0xf8e5, 0xc2df, 0x8c91, 0xb6ab, 66 0x100d, 0x2a37, 0x6479, 0x5e43, 0xb2af, 0x8895, 0xc6db, 0xfce1, 0x5a47, 67 0x607d, 0x2e33, 0x1409, 0x7f62, 0x4558, 0x0b16, 0x312c, 0x978a, 0xadb0, 68 0xe3fe, 0xd9c4, 69 }; 70 #elif defined(USE_NIBBLEWISE_CRC) 71 const OI_BYTE crc8_narrow[16] = {0x00, 0x1d, 0x3a, 0x27, 0x74, 0x69, 72 0x4e, 0x53, 0xe8, 0xf5, 0xd2, 0xcf, 73 0x9c, 0x81, 0xa6, 0xbb}; 74 #else 75 const OI_BYTE crc8_narrow[256] = { 76 0x00, 0x1d, 0x3a, 0x27, 0x74, 0x69, 0x4e, 0x53, 0xe8, 0xf5, 0xd2, 0xcf, 77 0x9c, 0x81, 0xa6, 0xbb, 0xcd, 0xd0, 0xf7, 0xea, 0xb9, 0xa4, 0x83, 0x9e, 78 0x25, 0x38, 0x1f, 0x02, 0x51, 0x4c, 0x6b, 0x76, 0x87, 0x9a, 0xbd, 0xa0, 79 0xf3, 0xee, 0xc9, 0xd4, 0x6f, 0x72, 0x55, 0x48, 0x1b, 0x06, 0x21, 0x3c, 80 0x4a, 0x57, 0x70, 0x6d, 0x3e, 0x23, 0x04, 0x19, 0xa2, 0xbf, 0x98, 0x85, 81 0xd6, 0xcb, 0xec, 0xf1, 0x13, 0x0e, 0x29, 0x34, 0x67, 0x7a, 0x5d, 0x40, 82 0xfb, 0xe6, 0xc1, 0xdc, 0x8f, 0x92, 0xb5, 0xa8, 0xde, 0xc3, 0xe4, 0xf9, 83 0xaa, 0xb7, 0x90, 0x8d, 0x36, 0x2b, 0x0c, 0x11, 0x42, 0x5f, 0x78, 0x65, 84 0x94, 0x89, 0xae, 0xb3, 0xe0, 0xfd, 0xda, 0xc7, 0x7c, 0x61, 0x46, 0x5b, 85 0x08, 0x15, 0x32, 0x2f, 0x59, 0x44, 0x63, 0x7e, 0x2d, 0x30, 0x17, 0x0a, 86 0xb1, 0xac, 0x8b, 0x96, 0xc5, 0xd8, 0xff, 0xe2, 0x26, 0x3b, 0x1c, 0x01, 87 0x52, 0x4f, 0x68, 0x75, 0xce, 0xd3, 0xf4, 0xe9, 0xba, 0xa7, 0x80, 0x9d, 88 0xeb, 0xf6, 0xd1, 0xcc, 0x9f, 0x82, 0xa5, 0xb8, 0x03, 0x1e, 0x39, 0x24, 89 0x77, 0x6a, 0x4d, 0x50, 0xa1, 0xbc, 0x9b, 0x86, 0xd5, 0xc8, 0xef, 0xf2, 90 0x49, 0x54, 0x73, 0x6e, 0x3d, 0x20, 0x07, 0x1a, 0x6c, 0x71, 0x56, 0x4b, 91 0x18, 0x05, 0x22, 0x3f, 0x84, 0x99, 0xbe, 0xa3, 0xf0, 0xed, 0xca, 0xd7, 92 0x35, 0x28, 0x0f, 0x12, 0x41, 0x5c, 0x7b, 0x66, 0xdd, 0xc0, 0xe7, 0xfa, 93 0xa9, 0xb4, 0x93, 0x8e, 0xf8, 0xe5, 0xc2, 0xdf, 0x8c, 0x91, 0xb6, 0xab, 94 0x10, 0x0d, 0x2a, 0x37, 0x64, 0x79, 0x5e, 0x43, 0xb2, 0xaf, 0x88, 0x95, 95 0xc6, 0xdb, 0xfc, 0xe1, 0x5a, 0x47, 0x60, 0x7d, 0x2e, 0x33, 0x14, 0x09, 96 0x7f, 0x62, 0x45, 0x58, 0x0b, 0x16, 0x31, 0x2c, 0x97, 0x8a, 0xad, 0xb0, 97 0xe3, 0xfe, 0xd9, 0xc4}; 98 #endif 99 const uint32_t dequant_long_scaled[17] = { 100 0, 0, 101 0x1ee9e116, /* bits=2 0.24151243 1/3 * (1/1.38019122262781) 102 (0x00000008)*/ 103 0x0d3fa99c, /* bits=3 0.10350533 1/7 * (1/1.38019122262781) 104 (0x00000013)*/ 105 0x062ec69e, /* bits=4 0.04830249 1/15 * (1/1.38019122262781) 106 (0x00000029)*/ 107 0x02fddbfa, /* bits=5 0.02337217 1/31 * (1/1.38019122262781) 108 (0x00000055)*/ 109 0x0178d9f5, /* bits=6 0.01150059 1/63 * (1/1.38019122262781) 110 (0x000000ad)*/ 111 0x00baf129, /* bits=7 0.00570502 1/127 * (1/1.38019122262781) 112 (0x0000015e)*/ 113 0x005d1abe, /* bits=8 0.00284132 1/255 * (1/1.38019122262781) 114 (0x000002bf)*/ 115 0x002e760d, /* bits=9 0.00141788 1/511 * (1/1.38019122262781) 116 (0x00000582)*/ 117 0x00173536, /* bits=10 0.00070825 1/1023 * (1/1.38019122262781) 118 (0x00000b07)*/ 119 0x000b9928, /* bits=11 0.00035395 1/2047 * (1/1.38019122262781) 120 (0x00001612)*/ 121 0x0005cc37, /* bits=12 0.00017693 1/4095 * (1/1.38019122262781) 122 (0x00002c27)*/ 123 0x0002e604, /* bits=13 0.00008846 1/8191 * (1/1.38019122262781) 124 (0x00005852)*/ 125 0x000172fc, /* bits=14 0.00004422 1/16383 * (1/1.38019122262781) 126 (0x0000b0a7)*/ 127 0x0000b97d, /* bits=15 0.00002211 1/32767 * (1/1.38019122262781) 128 (0x00016150)*/ 129 0x00005cbe, /* bits=16 0.00001106 1/65535 * (1/1.38019122262781) 130 (0x0002c2a5)*/ 131 }; 132 133 const uint32_t dequant_long_unscaled[17] = { 134 0, 0, 0x2aaaaaab, /* bits=2 0.33333333 1/3 (0x00000005)*/ 135 0x12492492, /* bits=3 0.14285714 1/7 (0x0000000e)*/ 136 0x08888889, /* bits=4 0.06666667 1/15 (0x0000001d)*/ 137 0x04210842, /* bits=5 0.03225806 1/31 (0x0000003e)*/ 138 0x02082082, /* bits=6 0.01587302 1/63 (0x0000007e)*/ 139 0x01020408, /* bits=7 0.00787402 1/127 (0x000000fe)*/ 140 0x00808081, /* bits=8 0.00392157 1/255 (0x000001fd)*/ 141 0x00402010, /* bits=9 0.00195695 1/511 (0x000003fe)*/ 142 0x00200802, /* bits=10 0.00097752 1/1023 (0x000007fe)*/ 143 0x00100200, /* bits=11 0.00048852 1/2047 (0x00000ffe)*/ 144 0x00080080, /* bits=12 0.00024420 1/4095 (0x00001ffe)*/ 145 0x00040020, /* bits=13 0.00012209 1/8191 (0x00003ffe)*/ 146 0x00020008, /* bits=14 0.00006104 1/16383 (0x00007ffe)*/ 147 0x00010002, /* bits=15 0.00003052 1/32767 (0x0000fffe)*/ 148 0x00008001, /* bits=16 0.00001526 1/65535 (0x0001fffc)*/ 149 }; 150 151 #if defined(OI_DEBUG) || defined(PRINT_SAMPLES) || defined(PRINT_SCALEFACTORS) 152 #include <stdio.h> 153 #endif 154 155 #ifdef USE_WIDE_CRC 156 INLINE OI_CHAR crc_iterate(uint8_t oldcrc, uint8_t next) { 157 OI_UINT crc; 158 OI_UINT idx; 159 idx = oldcrc ^ next; 160 crc = crc8_wide[idx >> 1]; 161 if (idx % 2) { 162 crc &= 0xff; 163 } else { 164 crc >>= 8; 165 } 166 167 return crc; 168 } 169 170 INLINE OI_CHAR crc_iterate_top4(uint8_t oldcrc, uint8_t next) { 171 OI_UINT crc; 172 OI_UINT idx; 173 idx = (oldcrc ^ next) >> 4; 174 crc = crc8_wide[idx >> 1]; 175 if (idx % 2) { 176 crc &= 0xff; 177 } else { 178 crc >>= 8; 179 } 180 181 return (oldcrc << 4) ^ crc; 182 } 183 184 #else // USE_WIDE_CRC 185 186 INLINE uint8_t crc_iterate_top4(uint8_t oldcrc, uint8_t next) { 187 return (oldcrc << 4) ^ crc8_narrow[(oldcrc ^ next) >> 4]; 188 } 189 190 #ifdef USE_NIBBLEWISE_CRC 191 INLINE uint8_t crc_iterate(uint8_t crc, uint8_t next) { 192 crc = (crc << 4) ^ crc8_narrow[(crc ^ next) >> 4]; 193 crc = (crc << 4) ^ crc8_narrow[((crc >> 4) ^ next) & 0xf]; 194 195 return crc; 196 } 197 198 #else // USE_NIBBLEWISE_CRC 199 INLINE uint8_t crc_iterate(uint8_t crc, uint8_t next) { 200 return crc8_narrow[crc ^ next]; 201 } 202 203 #endif // USE_NIBBLEWISE_CRC 204 205 #endif // USE_WIDE_CRC 206 207 PRIVATE uint8_t OI_SBC_CalculateChecksum(OI_CODEC_SBC_FRAME_INFO* frame, 208 OI_BYTE const* data) { 209 OI_UINT i; 210 uint8_t crc = 0x0f; 211 /* Count is the number of whole bytes subject to CRC. Actually, it's one 212 * more than this number, because data[3] is the CRC field itself, which is 213 * explicitly skipped. Since crc_iterate (should be) inlined, it's cheaper 214 * spacewise to include the check in the loop. This shouldn't be much of a 215 * bottleneck routine in the first place. */ 216 OI_UINT count = (frame->nrof_subbands * frame->nrof_channels / 2u) + 4; 217 218 if (frame->mode == SBC_JOINT_STEREO && frame->nrof_subbands == 8) { 219 count++; 220 } 221 222 for (i = 1; i < count; i++) { 223 if (i != 3) { 224 crc = crc_iterate(crc, data[i]); 225 } 226 } 227 228 if (frame->mode == SBC_JOINT_STEREO && frame->nrof_subbands == 4) { 229 crc = crc_iterate_top4(crc, data[i]); 230 } 231 232 return crc; 233 } 234 235 void OI_SBC_ExpandFrameFields(OI_CODEC_SBC_FRAME_INFO* frame) { 236 frame->nrof_blocks = block_values[frame->blocks]; 237 frame->nrof_subbands = band_values[frame->subbands]; 238 239 frame->frequency = freq_values[frame->freqIndex]; 240 frame->nrof_channels = channel_values[frame->mode]; 241 } 242 243 /** 244 * Unrolled macro to copy 4 32-bit aligned 32-bit values backward in memory 245 */ 246 #define COPY4WORDS_BACK(_dest, _src) \ 247 do { \ 248 int32_t _a, _b, _c, _d; \ 249 _a = *--(_src); \ 250 _b = *--(_src); \ 251 _c = *--(_src); \ 252 _d = *--(_src); \ 253 *--(_dest) = _a; \ 254 *--(_dest) = _b; \ 255 *--(_dest) = _c; \ 256 *--(_dest) = _d; \ 257 } while (0) 258 259 #if defined(USE_PLATFORM_MEMMOVE) || defined(USE_PLATFORM_MEMCPY) 260 #include <string.h> 261 #endif 262 PRIVATE void shift_buffer(SBC_BUFFER_T* dest, SBC_BUFFER_T* src, 263 OI_UINT wordCount) { 264 #ifdef USE_PLATFORM_MEMMOVE 265 memmove(dest, src, wordCount * sizeof(SBC_BUFFER_T)); 266 #elif defined(USE_PLATFORM_MEMCPY) 267 OI_ASSERT(((OI_CHAR*)(dest) - (OI_CHAR*)(src)) >= wordCount * sizeof(*dest)); 268 memcpy(dest, src, wordCount * sizeof(SBC_BUFFER_T)); 269 #else 270 OI_UINT n; 271 int32_t* d; 272 int32_t* s; 273 n = wordCount / 4 / (sizeof(int32_t) / sizeof(*dest)); 274 OI_ASSERT((n * 4 * (sizeof(int32_t) / sizeof(*dest))) == wordCount); 275 276 d = (void*)(dest + wordCount); 277 s = (void*)(src + wordCount); 278 279 do { 280 COPY4WORDS_BACK(d, s); 281 } while (--n); 282 #endif 283 } 284 /** 285 @} 286 */ 287
