libgsmfr/src/gsm_encode.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_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
  13 void 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 }