libgsmfr/src/gsm_decode.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_decode.c,v 1.2 1996/07/02 09:59:05 jutta 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 }