1 /* 2 * Copyright 1992 by Jutta Degener and Carsten Bormann, Technische 3 * Universitaet Berlin. See the accompanying file "COPYRIGHT" for 4 * details. THERE IS ABSOLUTELY NO WARRANTY FOR THIS SOFTWARE. 5 */ 6 7 /* $Header: /home/cvs/giga/ladspa-swh/gsm/gsm_decode.c,v 1.1 2001/06/10 21:36:51 swh Exp $ */ 8 9 #include "private.h" 10 11 #include "gsm.h" 12 #include "proto.h" 13 14 int gsm_decode P3((s, c, target), gsm s, gsm_byte * c, gsm_signal * target) 15 { 16 word LARc[8], Nc[4], Mc[4], bc[4], xmaxc[4], xmc[13*4]; 17 18 #ifdef WAV49 19 if (s->wav_fmt) { 20 21 uword sr = 0; 22 23 s->frame_index = !s->frame_index; 24 if (s->frame_index) { 25 26 sr = *c++; 27 LARc[0] = sr & 0x3f; sr >>= 6; 28 sr |= (uword)*c++ << 2; 29 LARc[1] = sr & 0x3f; sr >>= 6; 30 sr |= (uword)*c++ << 4; 31 LARc[2] = sr & 0x1f; sr >>= 5; 32 LARc[3] = sr & 0x1f; sr >>= 5; 33 sr |= (uword)*c++ << 2; 34 LARc[4] = sr & 0xf; sr >>= 4; 35 LARc[5] = sr & 0xf; sr >>= 4; 36 sr |= (uword)*c++ << 2; /* 5 */ 37 LARc[6] = sr & 0x7; sr >>= 3; 38 LARc[7] = sr & 0x7; sr >>= 3; 39 sr |= (uword)*c++ << 4; 40 Nc[0] = sr & 0x7f; sr >>= 7; 41 bc[0] = sr & 0x3; sr >>= 2; 42 Mc[0] = sr & 0x3; sr >>= 2; 43 sr |= (uword)*c++ << 1; 44 xmaxc[0] = sr & 0x3f; sr >>= 6; 45 xmc[0] = sr & 0x7; sr >>= 3; 46 sr = *c++; 47 xmc[1] = sr & 0x7; sr >>= 3; 48 xmc[2] = sr & 0x7; sr >>= 3; 49 sr |= (uword)*c++ << 2; 50 xmc[3] = sr & 0x7; sr >>= 3; 51 xmc[4] = sr & 0x7; sr >>= 3; 52 xmc[5] = sr & 0x7; sr >>= 3; 53 sr |= (uword)*c++ << 1; /* 10 */ 54 xmc[6] = sr & 0x7; sr >>= 3; 55 xmc[7] = sr & 0x7; sr >>= 3; 56 xmc[8] = sr & 0x7; sr >>= 3; 57 sr = *c++; 58 xmc[9] = sr & 0x7; sr >>= 3; 59 xmc[10] = sr & 0x7; sr >>= 3; 60 sr |= (uword)*c++ << 2; 61 xmc[11] = sr & 0x7; sr >>= 3; 62 xmc[12] = sr & 0x7; sr >>= 3; 63 sr |= (uword)*c++ << 4; 64 Nc[1] = sr & 0x7f; sr >>= 7; 65 bc[1] = sr & 0x3; sr >>= 2; 66 Mc[1] = sr & 0x3; sr >>= 2; 67 sr |= (uword)*c++ << 1; 68 xmaxc[1] = sr & 0x3f; sr >>= 6; 69 xmc[13] = sr & 0x7; sr >>= 3; 70 sr = *c++; /* 15 */ 71 xmc[14] = sr & 0x7; sr >>= 3; 72 xmc[15] = sr & 0x7; sr >>= 3; 73 sr |= (uword)*c++ << 2; 74 xmc[16] = sr & 0x7; sr >>= 3; 75 xmc[17] = sr & 0x7; sr >>= 3; 76 xmc[18] = sr & 0x7; sr >>= 3; 77 sr |= (uword)*c++ << 1; 78 xmc[19] = sr & 0x7; sr >>= 3; 79 xmc[20] = sr & 0x7; sr >>= 3; 80 xmc[21] = sr & 0x7; sr >>= 3; 81 sr = *c++; 82 xmc[22] = sr & 0x7; sr >>= 3; 83 xmc[23] = sr & 0x7; sr >>= 3; 84 sr |= (uword)*c++ << 2; 85 xmc[24] = sr & 0x7; sr >>= 3; 86 xmc[25] = sr & 0x7; sr >>= 3; 87 sr |= (uword)*c++ << 4; /* 20 */ 88 Nc[2] = sr & 0x7f; sr >>= 7; 89 bc[2] = sr & 0x3; sr >>= 2; 90 Mc[2] = sr & 0x3; sr >>= 2; 91 sr |= (uword)*c++ << 1; 92 xmaxc[2] = sr & 0x3f; sr >>= 6; 93 xmc[26] = sr & 0x7; sr >>= 3; 94 sr = *c++; 95 xmc[27] = sr & 0x7; sr >>= 3; 96 xmc[28] = sr & 0x7; sr >>= 3; 97 sr |= (uword)*c++ << 2; 98 xmc[29] = sr & 0x7; sr >>= 3; 99 xmc[30] = sr & 0x7; sr >>= 3; 100 xmc[31] = sr & 0x7; sr >>= 3; 101 sr |= (uword)*c++ << 1; 102 xmc[32] = sr & 0x7; sr >>= 3; 103 xmc[33] = sr & 0x7; sr >>= 3; 104 xmc[34] = sr & 0x7; sr >>= 3; 105 sr = *c++; /* 25 */ 106 xmc[35] = sr & 0x7; sr >>= 3; 107 xmc[36] = sr & 0x7; sr >>= 3; 108 sr |= (uword)*c++ << 2; 109 xmc[37] = sr & 0x7; sr >>= 3; 110 xmc[38] = sr & 0x7; sr >>= 3; 111 sr |= (uword)*c++ << 4; 112 Nc[3] = sr & 0x7f; sr >>= 7; 113 bc[3] = sr & 0x3; sr >>= 2; 114 Mc[3] = sr & 0x3; sr >>= 2; 115 sr |= (uword)*c++ << 1; 116 xmaxc[3] = sr & 0x3f; sr >>= 6; 117 xmc[39] = sr & 0x7; sr >>= 3; 118 sr = *c++; 119 xmc[40] = sr & 0x7; sr >>= 3; 120 xmc[41] = sr & 0x7; sr >>= 3; 121 sr |= (uword)*c++ << 2; /* 30 */ 122 xmc[42] = sr & 0x7; sr >>= 3; 123 xmc[43] = sr & 0x7; sr >>= 3; 124 xmc[44] = sr & 0x7; sr >>= 3; 125 sr |= (uword)*c++ << 1; 126 xmc[45] = sr & 0x7; sr >>= 3; 127 xmc[46] = sr & 0x7; sr >>= 3; 128 xmc[47] = sr & 0x7; sr >>= 3; 129 sr = *c++; 130 xmc[48] = sr & 0x7; sr >>= 3; 131 xmc[49] = sr & 0x7; sr >>= 3; 132 sr |= (uword)*c++ << 2; 133 xmc[50] = sr & 0x7; sr >>= 3; 134 xmc[51] = sr & 0x7; sr >>= 3; 135 136 s->frame_chain = sr & 0xf; 137 } 138 else { 139 sr = s->frame_chain; 140 sr |= (uword)*c++ << 4; /* 1 */ 141 LARc[0] = sr & 0x3f; sr >>= 6; 142 LARc[1] = sr & 0x3f; sr >>= 6; 143 sr = *c++; 144 LARc[2] = sr & 0x1f; sr >>= 5; 145 sr |= (uword)*c++ << 3; 146 LARc[3] = sr & 0x1f; sr >>= 5; 147 LARc[4] = sr & 0xf; sr >>= 4; 148 sr |= (uword)*c++ << 2; 149 LARc[5] = sr & 0xf; sr >>= 4; 150 LARc[6] = sr & 0x7; sr >>= 3; 151 LARc[7] = sr & 0x7; sr >>= 3; 152 sr = *c++; /* 5 */ 153 Nc[0] = sr & 0x7f; sr >>= 7; 154 sr |= (uword)*c++ << 1; 155 bc[0] = sr & 0x3; sr >>= 2; 156 Mc[0] = sr & 0x3; sr >>= 2; 157 sr |= (uword)*c++ << 5; 158 xmaxc[0] = sr & 0x3f; sr >>= 6; 159 xmc[0] = sr & 0x7; sr >>= 3; 160 xmc[1] = sr & 0x7; sr >>= 3; 161 sr |= (uword)*c++ << 1; 162 xmc[2] = sr & 0x7; sr >>= 3; 163 xmc[3] = sr & 0x7; sr >>= 3; 164 xmc[4] = sr & 0x7; sr >>= 3; 165 sr = *c++; 166 xmc[5] = sr & 0x7; sr >>= 3; 167 xmc[6] = sr & 0x7; sr >>= 3; 168 sr |= (uword)*c++ << 2; /* 10 */ 169 xmc[7] = sr & 0x7; sr >>= 3; 170 xmc[8] = sr & 0x7; sr >>= 3; 171 xmc[9] = sr & 0x7; sr >>= 3; 172 sr |= (uword)*c++ << 1; 173 xmc[10] = sr & 0x7; sr >>= 3; 174 xmc[11] = sr & 0x7; sr >>= 3; 175 xmc[12] = sr & 0x7; sr >>= 3; 176 sr = *c++; 177 Nc[1] = sr & 0x7f; sr >>= 7; 178 sr |= (uword)*c++ << 1; 179 bc[1] = sr & 0x3; sr >>= 2; 180 Mc[1] = sr & 0x3; sr >>= 2; 181 sr |= (uword)*c++ << 5; 182 xmaxc[1] = sr & 0x3f; sr >>= 6; 183 xmc[13] = sr & 0x7; sr >>= 3; 184 xmc[14] = sr & 0x7; sr >>= 3; 185 sr |= (uword)*c++ << 1; /* 15 */ 186 xmc[15] = sr & 0x7; sr >>= 3; 187 xmc[16] = sr & 0x7; sr >>= 3; 188 xmc[17] = sr & 0x7; sr >>= 3; 189 sr = *c++; 190 xmc[18] = sr & 0x7; sr >>= 3; 191 xmc[19] = sr & 0x7; sr >>= 3; 192 sr |= (uword)*c++ << 2; 193 xmc[20] = sr & 0x7; sr >>= 3; 194 xmc[21] = sr & 0x7; sr >>= 3; 195 xmc[22] = sr & 0x7; sr >>= 3; 196 sr |= (uword)*c++ << 1; 197 xmc[23] = sr & 0x7; sr >>= 3; 198 xmc[24] = sr & 0x7; sr >>= 3; 199 xmc[25] = sr & 0x7; sr >>= 3; 200 sr = *c++; 201 Nc[2] = sr & 0x7f; sr >>= 7; 202 sr |= (uword)*c++ << 1; /* 20 */ 203 bc[2] = sr & 0x3; sr >>= 2; 204 Mc[2] = sr & 0x3; sr >>= 2; 205 sr |= (uword)*c++ << 5; 206 xmaxc[2] = sr & 0x3f; sr >>= 6; 207 xmc[26] = sr & 0x7; sr >>= 3; 208 xmc[27] = sr & 0x7; sr >>= 3; 209 sr |= (uword)*c++ << 1; 210 xmc[28] = sr & 0x7; sr >>= 3; 211 xmc[29] = sr & 0x7; sr >>= 3; 212 xmc[30] = sr & 0x7; sr >>= 3; 213 sr = *c++; 214 xmc[31] = sr & 0x7; sr >>= 3; 215 xmc[32] = sr & 0x7; sr >>= 3; 216 sr |= (uword)*c++ << 2; 217 xmc[33] = sr & 0x7; sr >>= 3; 218 xmc[34] = sr & 0x7; sr >>= 3; 219 xmc[35] = sr & 0x7; sr >>= 3; 220 sr |= (uword)*c++ << 1; /* 25 */ 221 xmc[36] = sr & 0x7; sr >>= 3; 222 xmc[37] = sr & 0x7; sr >>= 3; 223 xmc[38] = sr & 0x7; sr >>= 3; 224 sr = *c++; 225 Nc[3] = sr & 0x7f; sr >>= 7; 226 sr |= (uword)*c++ << 1; 227 bc[3] = sr & 0x3; sr >>= 2; 228 Mc[3] = sr & 0x3; sr >>= 2; 229 sr |= (uword)*c++ << 5; 230 xmaxc[3] = sr & 0x3f; sr >>= 6; 231 xmc[39] = sr & 0x7; sr >>= 3; 232 xmc[40] = sr & 0x7; sr >>= 3; 233 sr |= (uword)*c++ << 1; 234 xmc[41] = sr & 0x7; sr >>= 3; 235 xmc[42] = sr & 0x7; sr >>= 3; 236 xmc[43] = sr & 0x7; sr >>= 3; 237 sr = *c++; /* 30 */ 238 xmc[44] = sr & 0x7; sr >>= 3; 239 xmc[45] = sr & 0x7; sr >>= 3; 240 sr |= (uword)*c++ << 2; 241 xmc[46] = sr & 0x7; sr >>= 3; 242 xmc[47] = sr & 0x7; sr >>= 3; 243 xmc[48] = sr & 0x7; sr >>= 3; 244 sr |= (uword)*c++ << 1; 245 xmc[49] = sr & 0x7; sr >>= 3; 246 xmc[50] = sr & 0x7; sr >>= 3; 247 xmc[51] = sr & 0x7; sr >>= 3; 248 } 249 } 250 else 251 #endif 252 { 253 /* GSM_MAGIC = (*c >> 4) & 0xF; */ 254 255 if (((*c >> 4) & 0x0F) != GSM_MAGIC) return -1; 256 257 LARc[0] = (*c++ & 0xF) << 2; /* 1 */ 258 LARc[0] |= (*c >> 6) & 0x3; 259 LARc[1] = *c++ & 0x3F; 260 LARc[2] = (*c >> 3) & 0x1F; 261 LARc[3] = (*c++ & 0x7) << 2; 262 LARc[3] |= (*c >> 6) & 0x3; 263 LARc[4] = (*c >> 2) & 0xF; 264 LARc[5] = (*c++ & 0x3) << 2; 265 LARc[5] |= (*c >> 6) & 0x3; 266 LARc[6] = (*c >> 3) & 0x7; 267 LARc[7] = *c++ & 0x7; 268 Nc[0] = (*c >> 1) & 0x7F; 269 bc[0] = (*c++ & 0x1) << 1; 270 bc[0] |= (*c >> 7) & 0x1; 271 Mc[0] = (*c >> 5) & 0x3; 272 xmaxc[0] = (*c++ & 0x1F) << 1; 273 xmaxc[0] |= (*c >> 7) & 0x1; 274 xmc[0] = (*c >> 4) & 0x7; 275 xmc[1] = (*c >> 1) & 0x7; 276 xmc[2] = (*c++ & 0x1) << 2; 277 xmc[2] |= (*c >> 6) & 0x3; 278 xmc[3] = (*c >> 3) & 0x7; 279 xmc[4] = *c++ & 0x7; 280 xmc[5] = (*c >> 5) & 0x7; 281 xmc[6] = (*c >> 2) & 0x7; 282 xmc[7] = (*c++ & 0x3) << 1; /* 10 */ 283 xmc[7] |= (*c >> 7) & 0x1; 284 xmc[8] = (*c >> 4) & 0x7; 285 xmc[9] = (*c >> 1) & 0x7; 286 xmc[10] = (*c++ & 0x1) << 2; 287 xmc[10] |= (*c >> 6) & 0x3; 288 xmc[11] = (*c >> 3) & 0x7; 289 xmc[12] = *c++ & 0x7; 290 Nc[1] = (*c >> 1) & 0x7F; 291 bc[1] = (*c++ & 0x1) << 1; 292 bc[1] |= (*c >> 7) & 0x1; 293 Mc[1] = (*c >> 5) & 0x3; 294 xmaxc[1] = (*c++ & 0x1F) << 1; 295 xmaxc[1] |= (*c >> 7) & 0x1; 296 xmc[13] = (*c >> 4) & 0x7; 297 xmc[14] = (*c >> 1) & 0x7; 298 xmc[15] = (*c++ & 0x1) << 2; 299 xmc[15] |= (*c >> 6) & 0x3; 300 xmc[16] = (*c >> 3) & 0x7; 301 xmc[17] = *c++ & 0x7; 302 xmc[18] = (*c >> 5) & 0x7; 303 xmc[19] = (*c >> 2) & 0x7; 304 xmc[20] = (*c++ & 0x3) << 1; 305 xmc[20] |= (*c >> 7) & 0x1; 306 xmc[21] = (*c >> 4) & 0x7; 307 xmc[22] = (*c >> 1) & 0x7; 308 xmc[23] = (*c++ & 0x1) << 2; 309 xmc[23] |= (*c >> 6) & 0x3; 310 xmc[24] = (*c >> 3) & 0x7; 311 xmc[25] = *c++ & 0x7; 312 Nc[2] = (*c >> 1) & 0x7F; 313 bc[2] = (*c++ & 0x1) << 1; /* 20 */ 314 bc[2] |= (*c >> 7) & 0x1; 315 Mc[2] = (*c >> 5) & 0x3; 316 xmaxc[2] = (*c++ & 0x1F) << 1; 317 xmaxc[2] |= (*c >> 7) & 0x1; 318 xmc[26] = (*c >> 4) & 0x7; 319 xmc[27] = (*c >> 1) & 0x7; 320 xmc[28] = (*c++ & 0x1) << 2; 321 xmc[28] |= (*c >> 6) & 0x3; 322 xmc[29] = (*c >> 3) & 0x7; 323 xmc[30] = *c++ & 0x7; 324 xmc[31] = (*c >> 5) & 0x7; 325 xmc[32] = (*c >> 2) & 0x7; 326 xmc[33] = (*c++ & 0x3) << 1; 327 xmc[33] |= (*c >> 7) & 0x1; 328 xmc[34] = (*c >> 4) & 0x7; 329 xmc[35] = (*c >> 1) & 0x7; 330 xmc[36] = (*c++ & 0x1) << 2; 331 xmc[36] |= (*c >> 6) & 0x3; 332 xmc[37] = (*c >> 3) & 0x7; 333 xmc[38] = *c++ & 0x7; 334 Nc[3] = (*c >> 1) & 0x7F; 335 bc[3] = (*c++ & 0x1) << 1; 336 bc[3] |= (*c >> 7) & 0x1; 337 Mc[3] = (*c >> 5) & 0x3; 338 xmaxc[3] = (*c++ & 0x1F) << 1; 339 xmaxc[3] |= (*c >> 7) & 0x1; 340 xmc[39] = (*c >> 4) & 0x7; 341 xmc[40] = (*c >> 1) & 0x7; 342 xmc[41] = (*c++ & 0x1) << 2; 343 xmc[41] |= (*c >> 6) & 0x3; 344 xmc[42] = (*c >> 3) & 0x7; 345 xmc[43] = *c++ & 0x7; /* 30 */ 346 xmc[44] = (*c >> 5) & 0x7; 347 xmc[45] = (*c >> 2) & 0x7; 348 xmc[46] = (*c++ & 0x3) << 1; 349 xmc[46] |= (*c >> 7) & 0x1; 350 xmc[47] = (*c >> 4) & 0x7; 351 xmc[48] = (*c >> 1) & 0x7; 352 xmc[49] = (*c++ & 0x1) << 2; 353 xmc[49] |= (*c >> 6) & 0x3; 354 xmc[50] = (*c >> 3) & 0x7; 355 xmc[51] = *c & 0x7; /* 33 */ 356 } 357 358 Gsm_Decoder(s, LARc, Nc, bc, Mc, xmaxc, xmc, target); 359 360 return 0; 361 } 362