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: /tmp_amd/presto/export/kbs/jutta/src/gsm/RCS/gsm_encode.c,v 1.2 1996/07/02 09:59:05 jutta Exp $ */ 8 9#include "private.h" 10#include "gsm.h" 11#include "proto.h" 12 13void gsm_encode P3((s, source, c), gsm s, gsm_signal * source, gsm_byte * c) 14{ 15 word LARc[8], Nc[4], Mc[4], bc[4], xmaxc[4], xmc[13*4]; 16 17 Gsm_Coder(s, source, LARc, Nc, bc, Mc, xmaxc, xmc); 18 19 20 /* variable size 21 22 GSM_MAGIC 4 23 24 LARc[0] 6 25 LARc[1] 6 26 LARc[2] 5 27 LARc[3] 5 28 LARc[4] 4 29 LARc[5] 4 30 LARc[6] 3 31 LARc[7] 3 32 33 Nc[0] 7 34 bc[0] 2 35 Mc[0] 2 36 xmaxc[0] 6 37 xmc[0] 3 38 xmc[1] 3 39 xmc[2] 3 40 xmc[3] 3 41 xmc[4] 3 42 xmc[5] 3 43 xmc[6] 3 44 xmc[7] 3 45 xmc[8] 3 46 xmc[9] 3 47 xmc[10] 3 48 xmc[11] 3 49 xmc[12] 3 50 51 Nc[1] 7 52 bc[1] 2 53 Mc[1] 2 54 xmaxc[1] 6 55 xmc[13] 3 56 xmc[14] 3 57 xmc[15] 3 58 xmc[16] 3 59 xmc[17] 3 60 xmc[18] 3 61 xmc[19] 3 62 xmc[20] 3 63 xmc[21] 3 64 xmc[22] 3 65 xmc[23] 3 66 xmc[24] 3 67 xmc[25] 3 68 69 Nc[2] 7 70 bc[2] 2 71 Mc[2] 2 72 xmaxc[2] 6 73 xmc[26] 3 74 xmc[27] 3 75 xmc[28] 3 76 xmc[29] 3 77 xmc[30] 3 78 xmc[31] 3 79 xmc[32] 3 80 xmc[33] 3 81 xmc[34] 3 82 xmc[35] 3 83 xmc[36] 3 84 xmc[37] 3 85 xmc[38] 3 86 87 Nc[3] 7 88 bc[3] 2 89 Mc[3] 2 90 xmaxc[3] 6 91 xmc[39] 3 92 xmc[40] 3 93 xmc[41] 3 94 xmc[42] 3 95 xmc[43] 3 96 xmc[44] 3 97 xmc[45] 3 98 xmc[46] 3 99 xmc[47] 3 100 xmc[48] 3 101 xmc[49] 3 102 xmc[50] 3 103 xmc[51] 3 104 */ 105 106#ifdef WAV49 107 108 if (s->wav_fmt) { 109 s->frame_index = !s->frame_index; 110 if (s->frame_index) { 111 112 uword sr; 113 114 sr = 0; 115 sr = sr >> 6 | LARc[0] << 10; 116 sr = sr >> 6 | LARc[1] << 10; 117 *c++ = sr >> 4; 118 sr = sr >> 5 | LARc[2] << 11; 119 *c++ = sr >> 7; 120 sr = sr >> 5 | LARc[3] << 11; 121 sr = sr >> 4 | LARc[4] << 12; 122 *c++ = sr >> 6; 123 sr = sr >> 4 | LARc[5] << 12; 124 sr = sr >> 3 | LARc[6] << 13; 125 *c++ = sr >> 7; 126 sr = sr >> 3 | LARc[7] << 13; 127 sr = sr >> 7 | Nc[0] << 9; 128 *c++ = sr >> 5; 129 sr = sr >> 2 | bc[0] << 14; 130 sr = sr >> 2 | Mc[0] << 14; 131 sr = sr >> 6 | xmaxc[0] << 10; 132 *c++ = sr >> 3; 133 sr = sr >> 3 | xmc[0] << 13; 134 *c++ = sr >> 8; 135 sr = sr >> 3 | xmc[1] << 13; 136 sr = sr >> 3 | xmc[2] << 13; 137 sr = sr >> 3 | xmc[3] << 13; 138 *c++ = sr >> 7; 139 sr = sr >> 3 | xmc[4] << 13; 140 sr = sr >> 3 | xmc[5] << 13; 141 sr = sr >> 3 | xmc[6] << 13; 142 *c++ = sr >> 6; 143 sr = sr >> 3 | xmc[7] << 13; 144 sr = sr >> 3 | xmc[8] << 13; 145 *c++ = sr >> 8; 146 sr = sr >> 3 | xmc[9] << 13; 147 sr = sr >> 3 | xmc[10] << 13; 148 sr = sr >> 3 | xmc[11] << 13; 149 *c++ = sr >> 7; 150 sr = sr >> 3 | xmc[12] << 13; 151 sr = sr >> 7 | Nc[1] << 9; 152 *c++ = sr >> 5; 153 sr = sr >> 2 | bc[1] << 14; 154 sr = sr >> 2 | Mc[1] << 14; 155 sr = sr >> 6 | xmaxc[1] << 10; 156 *c++ = sr >> 3; 157 sr = sr >> 3 | xmc[13] << 13; 158 *c++ = sr >> 8; 159 sr = sr >> 3 | xmc[14] << 13; 160 sr = sr >> 3 | xmc[15] << 13; 161 sr = sr >> 3 | xmc[16] << 13; 162 *c++ = sr >> 7; 163 sr = sr >> 3 | xmc[17] << 13; 164 sr = sr >> 3 | xmc[18] << 13; 165 sr = sr >> 3 | xmc[19] << 13; 166 *c++ = sr >> 6; 167 sr = sr >> 3 | xmc[20] << 13; 168 sr = sr >> 3 | xmc[21] << 13; 169 *c++ = sr >> 8; 170 sr = sr >> 3 | xmc[22] << 13; 171 sr = sr >> 3 | xmc[23] << 13; 172 sr = sr >> 3 | xmc[24] << 13; 173 *c++ = sr >> 7; 174 sr = sr >> 3 | xmc[25] << 13; 175 sr = sr >> 7 | Nc[2] << 9; 176 *c++ = sr >> 5; 177 sr = sr >> 2 | bc[2] << 14; 178 sr = sr >> 2 | Mc[2] << 14; 179 sr = sr >> 6 | xmaxc[2] << 10; 180 *c++ = sr >> 3; 181 sr = sr >> 3 | xmc[26] << 13; 182 *c++ = sr >> 8; 183 sr = sr >> 3 | xmc[27] << 13; 184 sr = sr >> 3 | xmc[28] << 13; 185 sr = sr >> 3 | xmc[29] << 13; 186 *c++ = sr >> 7; 187 sr = sr >> 3 | xmc[30] << 13; 188 sr = sr >> 3 | xmc[31] << 13; 189 sr = sr >> 3 | xmc[32] << 13; 190 *c++ = sr >> 6; 191 sr = sr >> 3 | xmc[33] << 13; 192 sr = sr >> 3 | xmc[34] << 13; 193 *c++ = sr >> 8; 194 sr = sr >> 3 | xmc[35] << 13; 195 sr = sr >> 3 | xmc[36] << 13; 196 sr = sr >> 3 | xmc[37] << 13; 197 *c++ = sr >> 7; 198 sr = sr >> 3 | xmc[38] << 13; 199 sr = sr >> 7 | Nc[3] << 9; 200 *c++ = sr >> 5; 201 sr = sr >> 2 | bc[3] << 14; 202 sr = sr >> 2 | Mc[3] << 14; 203 sr = sr >> 6 | xmaxc[3] << 10; 204 *c++ = sr >> 3; 205 sr = sr >> 3 | xmc[39] << 13; 206 *c++ = sr >> 8; 207 sr = sr >> 3 | xmc[40] << 13; 208 sr = sr >> 3 | xmc[41] << 13; 209 sr = sr >> 3 | xmc[42] << 13; 210 *c++ = sr >> 7; 211 sr = sr >> 3 | xmc[43] << 13; 212 sr = sr >> 3 | xmc[44] << 13; 213 sr = sr >> 3 | xmc[45] << 13; 214 *c++ = sr >> 6; 215 sr = sr >> 3 | xmc[46] << 13; 216 sr = sr >> 3 | xmc[47] << 13; 217 *c++ = sr >> 8; 218 sr = sr >> 3 | xmc[48] << 13; 219 sr = sr >> 3 | xmc[49] << 13; 220 sr = sr >> 3 | xmc[50] << 13; 221 *c++ = sr >> 7; 222 sr = sr >> 3 | xmc[51] << 13; 223 sr = sr >> 4; 224 *c = sr >> 8; 225 s->frame_chain = *c; 226 } 227 else { 228 uword sr; 229 230 sr = 0; 231 sr = sr >> 4 | s->frame_chain << 12; 232 sr = sr >> 6 | LARc[0] << 10; 233 *c++ = sr >> 6; 234 sr = sr >> 6 | LARc[1] << 10; 235 *c++ = sr >> 8; 236 sr = sr >> 5 | LARc[2] << 11; 237 sr = sr >> 5 | LARc[3] << 11; 238 *c++ = sr >> 6; 239 sr = sr >> 4 | LARc[4] << 12; 240 sr = sr >> 4 | LARc[5] << 12; 241 *c++ = sr >> 6; 242 sr = sr >> 3 | LARc[6] << 13; 243 sr = sr >> 3 | LARc[7] << 13; 244 *c++ = sr >> 8; 245 sr = sr >> 7 | Nc[0] << 9; 246 sr = sr >> 2 | bc[0] << 14; 247 *c++ = sr >> 7; 248 sr = sr >> 2 | Mc[0] << 14; 249 sr = sr >> 6 | xmaxc[0] << 10; 250 *c++ = sr >> 7; 251 sr = sr >> 3 | xmc[0] << 13; 252 sr = sr >> 3 | xmc[1] << 13; 253 sr = sr >> 3 | xmc[2] << 13; 254 *c++ = sr >> 6; 255 sr = sr >> 3 | xmc[3] << 13; 256 sr = sr >> 3 | xmc[4] << 13; 257 *c++ = sr >> 8; 258 sr = sr >> 3 | xmc[5] << 13; 259 sr = sr >> 3 | xmc[6] << 13; 260 sr = sr >> 3 | xmc[7] << 13; 261 *c++ = sr >> 7; 262 sr = sr >> 3 | xmc[8] << 13; 263 sr = sr >> 3 | xmc[9] << 13; 264 sr = sr >> 3 | xmc[10] << 13; 265 *c++ = sr >> 6; 266 sr = sr >> 3 | xmc[11] << 13; 267 sr = sr >> 3 | xmc[12] << 13; 268 *c++ = sr >> 8; 269 sr = sr >> 7 | Nc[1] << 9; 270 sr = sr >> 2 | bc[1] << 14; 271 *c++ = sr >> 7; 272 sr = sr >> 2 | Mc[1] << 14; 273 sr = sr >> 6 | xmaxc[1] << 10; 274 *c++ = sr >> 7; 275 sr = sr >> 3 | xmc[13] << 13; 276 sr = sr >> 3 | xmc[14] << 13; 277 sr = sr >> 3 | xmc[15] << 13; 278 *c++ = sr >> 6; 279 sr = sr >> 3 | xmc[16] << 13; 280 sr = sr >> 3 | xmc[17] << 13; 281 *c++ = sr >> 8; 282 sr = sr >> 3 | xmc[18] << 13; 283 sr = sr >> 3 | xmc[19] << 13; 284 sr = sr >> 3 | xmc[20] << 13; 285 *c++ = sr >> 7; 286 sr = sr >> 3 | xmc[21] << 13; 287 sr = sr >> 3 | xmc[22] << 13; 288 sr = sr >> 3 | xmc[23] << 13; 289 *c++ = sr >> 6; 290 sr = sr >> 3 | xmc[24] << 13; 291 sr = sr >> 3 | xmc[25] << 13; 292 *c++ = sr >> 8; 293 sr = sr >> 7 | Nc[2] << 9; 294 sr = sr >> 2 | bc[2] << 14; 295 *c++ = sr >> 7; 296 sr = sr >> 2 | Mc[2] << 14; 297 sr = sr >> 6 | xmaxc[2] << 10; 298 *c++ = sr >> 7; 299 sr = sr >> 3 | xmc[26] << 13; 300 sr = sr >> 3 | xmc[27] << 13; 301 sr = sr >> 3 | xmc[28] << 13; 302 *c++ = sr >> 6; 303 sr = sr >> 3 | xmc[29] << 13; 304 sr = sr >> 3 | xmc[30] << 13; 305 *c++ = sr >> 8; 306 sr = sr >> 3 | xmc[31] << 13; 307 sr = sr >> 3 | xmc[32] << 13; 308 sr = sr >> 3 | xmc[33] << 13; 309 *c++ = sr >> 7; 310 sr = sr >> 3 | xmc[34] << 13; 311 sr = sr >> 3 | xmc[35] << 13; 312 sr = sr >> 3 | xmc[36] << 13; 313 *c++ = sr >> 6; 314 sr = sr >> 3 | xmc[37] << 13; 315 sr = sr >> 3 | xmc[38] << 13; 316 *c++ = sr >> 8; 317 sr = sr >> 7 | Nc[3] << 9; 318 sr = sr >> 2 | bc[3] << 14; 319 *c++ = sr >> 7; 320 sr = sr >> 2 | Mc[3] << 14; 321 sr = sr >> 6 | xmaxc[3] << 10; 322 *c++ = sr >> 7; 323 sr = sr >> 3 | xmc[39] << 13; 324 sr = sr >> 3 | xmc[40] << 13; 325 sr = sr >> 3 | xmc[41] << 13; 326 *c++ = sr >> 6; 327 sr = sr >> 3 | xmc[42] << 13; 328 sr = sr >> 3 | xmc[43] << 13; 329 *c++ = sr >> 8; 330 sr = sr >> 3 | xmc[44] << 13; 331 sr = sr >> 3 | xmc[45] << 13; 332 sr = sr >> 3 | xmc[46] << 13; 333 *c++ = sr >> 7; 334 sr = sr >> 3 | xmc[47] << 13; 335 sr = sr >> 3 | xmc[48] << 13; 336 sr = sr >> 3 | xmc[49] << 13; 337 *c++ = sr >> 6; 338 sr = sr >> 3 | xmc[50] << 13; 339 sr = sr >> 3 | xmc[51] << 13; 340 *c++ = sr >> 8; 341 } 342 } 343 344 else 345 346#endif /* WAV49 */ 347 { 348 349 *c++ = ((GSM_MAGIC & 0xF) << 4) /* 1 */ 350 | ((LARc[0] >> 2) & 0xF); 351 *c++ = ((LARc[0] & 0x3) << 6) 352 | (LARc[1] & 0x3F); 353 *c++ = ((LARc[2] & 0x1F) << 3) 354 | ((LARc[3] >> 2) & 0x7); 355 *c++ = ((LARc[3] & 0x3) << 6) 356 | ((LARc[4] & 0xF) << 2) 357 | ((LARc[5] >> 2) & 0x3); 358 *c++ = ((LARc[5] & 0x3) << 6) 359 | ((LARc[6] & 0x7) << 3) 360 | (LARc[7] & 0x7); 361 *c++ = ((Nc[0] & 0x7F) << 1) 362 | ((bc[0] >> 1) & 0x1); 363 *c++ = ((bc[0] & 0x1) << 7) 364 | ((Mc[0] & 0x3) << 5) 365 | ((xmaxc[0] >> 1) & 0x1F); 366 *c++ = ((xmaxc[0] & 0x1) << 7) 367 | ((xmc[0] & 0x7) << 4) 368 | ((xmc[1] & 0x7) << 1) 369 | ((xmc[2] >> 2) & 0x1); 370 *c++ = ((xmc[2] & 0x3) << 6) 371 | ((xmc[3] & 0x7) << 3) 372 | (xmc[4] & 0x7); 373 *c++ = ((xmc[5] & 0x7) << 5) /* 10 */ 374 | ((xmc[6] & 0x7) << 2) 375 | ((xmc[7] >> 1) & 0x3); 376 *c++ = ((xmc[7] & 0x1) << 7) 377 | ((xmc[8] & 0x7) << 4) 378 | ((xmc[9] & 0x7) << 1) 379 | ((xmc[10] >> 2) & 0x1); 380 *c++ = ((xmc[10] & 0x3) << 6) 381 | ((xmc[11] & 0x7) << 3) 382 | (xmc[12] & 0x7); 383 *c++ = ((Nc[1] & 0x7F) << 1) 384 | ((bc[1] >> 1) & 0x1); 385 *c++ = ((bc[1] & 0x1) << 7) 386 | ((Mc[1] & 0x3) << 5) 387 | ((xmaxc[1] >> 1) & 0x1F); 388 *c++ = ((xmaxc[1] & 0x1) << 7) 389 | ((xmc[13] & 0x7) << 4) 390 | ((xmc[14] & 0x7) << 1) 391 | ((xmc[15] >> 2) & 0x1); 392 *c++ = ((xmc[15] & 0x3) << 6) 393 | ((xmc[16] & 0x7) << 3) 394 | (xmc[17] & 0x7); 395 *c++ = ((xmc[18] & 0x7) << 5) 396 | ((xmc[19] & 0x7) << 2) 397 | ((xmc[20] >> 1) & 0x3); 398 *c++ = ((xmc[20] & 0x1) << 7) 399 | ((xmc[21] & 0x7) << 4) 400 | ((xmc[22] & 0x7) << 1) 401 | ((xmc[23] >> 2) & 0x1); 402 *c++ = ((xmc[23] & 0x3) << 6) 403 | ((xmc[24] & 0x7) << 3) 404 | (xmc[25] & 0x7); 405 *c++ = ((Nc[2] & 0x7F) << 1) /* 20 */ 406 | ((bc[2] >> 1) & 0x1); 407 *c++ = ((bc[2] & 0x1) << 7) 408 | ((Mc[2] & 0x3) << 5) 409 | ((xmaxc[2] >> 1) & 0x1F); 410 *c++ = ((xmaxc[2] & 0x1) << 7) 411 | ((xmc[26] & 0x7) << 4) 412 | ((xmc[27] & 0x7) << 1) 413 | ((xmc[28] >> 2) & 0x1); 414 *c++ = ((xmc[28] & 0x3) << 6) 415 | ((xmc[29] & 0x7) << 3) 416 | (xmc[30] & 0x7); 417 *c++ = ((xmc[31] & 0x7) << 5) 418 | ((xmc[32] & 0x7) << 2) 419 | ((xmc[33] >> 1) & 0x3); 420 *c++ = ((xmc[33] & 0x1) << 7) 421 | ((xmc[34] & 0x7) << 4) 422 | ((xmc[35] & 0x7) << 1) 423 | ((xmc[36] >> 2) & 0x1); 424 *c++ = ((xmc[36] & 0x3) << 6) 425 | ((xmc[37] & 0x7) << 3) 426 | (xmc[38] & 0x7); 427 *c++ = ((Nc[3] & 0x7F) << 1) 428 | ((bc[3] >> 1) & 0x1); 429 *c++ = ((bc[3] & 0x1) << 7) 430 | ((Mc[3] & 0x3) << 5) 431 | ((xmaxc[3] >> 1) & 0x1F); 432 *c++ = ((xmaxc[3] & 0x1) << 7) 433 | ((xmc[39] & 0x7) << 4) 434 | ((xmc[40] & 0x7) << 1) 435 | ((xmc[41] >> 2) & 0x1); 436 *c++ = ((xmc[41] & 0x3) << 6) /* 30 */ 437 | ((xmc[42] & 0x7) << 3) 438 | (xmc[43] & 0x7); 439 *c++ = ((xmc[44] & 0x7) << 5) 440 | ((xmc[45] & 0x7) << 2) 441 | ((xmc[46] >> 1) & 0x3); 442 *c++ = ((xmc[46] & 0x1) << 7) 443 | ((xmc[47] & 0x7) << 4) 444 | ((xmc[48] & 0x7) << 1) 445 | ((xmc[49] >> 2) & 0x1); 446 *c++ = ((xmc[49] & 0x3) << 6) 447 | ((xmc[50] & 0x7) << 3) 448 | (xmc[51] & 0x7); 449 450 } 451} 452