libgsmfr/src/gsm_implode.c

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