| /* | |
| * Copyright 1992 by Jutta Degener and Carsten Bormann, Technische | |
| * Universitaet Berlin. See the accompanying file "COPYRIGHT" for | |
| * details. THERE IS ABSOLUTELY NO WARRANTY FOR THIS SOFTWARE. | |
| */ | |
| #include "gsm610_priv.h" | |
| #include "gsm.h" | |
| int gsm_decode (gsm s, gsm_byte * c, gsm_signal * target) | |
| { | |
| int16_t LARc [8], Nc [4], Mc [4], bc [4], xmaxc [4], xmc [13 * 4] ; | |
| #ifdef WAV49 | |
| if (s->wav_fmt) | |
| { uint16_t sr = 0 ; | |
| s->frame_index = !s->frame_index ; | |
| if (s->frame_index) | |
| { sr = *c++ ; | |
| LARc [0] = sr & 0x3f ; sr >>= 6 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| LARc [1] = sr & 0x3f ; sr >>= 6 ; | |
| sr |= (uint16_t) *c++ << 4 ; | |
| LARc [2] = sr & 0x1f ; sr >>= 5 ; | |
| LARc [3] = sr & 0x1f ; sr >>= 5 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| LARc [4] = sr & 0xf ; sr >>= 4 ; | |
| LARc [5] = sr & 0xf ; sr >>= 4 ; | |
| sr |= (uint16_t) *c++ << 2 ; /* 5 */ | |
| LARc [6] = sr & 0x7 ; sr >>= 3 ; | |
| LARc [7] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 4 ; | |
| Nc [0] = sr & 0x7f ; sr >>= 7 ; | |
| bc [0] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [0] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmaxc [0] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [0] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [1] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [2] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [3] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [4] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [5] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; /* 10 */ | |
| xmc [6] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [7] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [8] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [9] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [10] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [11] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [12] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 4 ; | |
| Nc [1] = sr & 0x7f ; sr >>= 7 ; | |
| bc [1] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [1] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmaxc [1] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [13] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; /* 15 */ | |
| xmc [14] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [15] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [16] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [17] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [18] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [19] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [20] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [21] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [22] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [23] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [24] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [25] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 4 ; /* 20 */ | |
| Nc [2] = sr & 0x7f ; sr >>= 7 ; | |
| bc [2] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [2] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmaxc [2] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [26] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [27] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [28] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [29] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [30] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [31] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [32] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [33] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [34] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; /* 25 */ | |
| xmc [35] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [36] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [37] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [38] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 4 ; | |
| Nc [3] = sr & 0x7f ; sr >>= 7 ; | |
| bc [3] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [3] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmaxc [3] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [39] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [40] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [41] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; /* 30 */ | |
| xmc [42] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [43] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [44] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [45] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [46] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [47] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [48] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [49] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [50] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [51] = sr & 0x7 ; sr >>= 3 ; | |
| s->frame_chain = sr & 0xf ; | |
| } | |
| else { | |
| sr = s->frame_chain ; | |
| sr |= (uint16_t) *c++ << 4 ; /* 1 */ | |
| LARc [0] = sr & 0x3f ; sr >>= 6 ; | |
| LARc [1] = sr & 0x3f ; sr >>= 6 ; | |
| sr = *c++ ; | |
| LARc [2] = sr & 0x1f ; sr >>= 5 ; | |
| sr |= (uint16_t) *c++ << 3 ; | |
| LARc [3] = sr & 0x1f ; sr >>= 5 ; | |
| LARc [4] = sr & 0xf ; sr >>= 4 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| LARc [5] = sr & 0xf ; sr >>= 4 ; | |
| LARc [6] = sr & 0x7 ; sr >>= 3 ; | |
| LARc [7] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; /* 5 */ | |
| Nc [0] = sr & 0x7f ; sr >>= 7 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| bc [0] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [0] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 5 ; | |
| xmaxc [0] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [0] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [1] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [2] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [3] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [4] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [5] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [6] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; /* 10 */ | |
| xmc [7] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [8] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [9] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [10] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [11] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [12] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| Nc [1] = sr & 0x7f ; sr >>= 7 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| bc [1] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [1] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 5 ; | |
| xmaxc [1] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [13] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [14] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; /* 15 */ | |
| xmc [15] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [16] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [17] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [18] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [19] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [20] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [21] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [22] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [23] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [24] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [25] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| Nc [2] = sr & 0x7f ; sr >>= 7 ; | |
| sr |= (uint16_t) *c++ << 1 ; /* 20 */ | |
| bc [2] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [2] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 5 ; | |
| xmaxc [2] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [26] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [27] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [28] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [29] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [30] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| xmc [31] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [32] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [33] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [34] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [35] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; /* 25 */ | |
| xmc [36] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [37] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [38] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; | |
| Nc [3] = sr & 0x7f ; sr >>= 7 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| bc [3] = sr & 0x3 ; sr >>= 2 ; | |
| Mc [3] = sr & 0x3 ; sr >>= 2 ; | |
| sr |= (uint16_t) *c++ << 5 ; | |
| xmaxc [3] = sr & 0x3f ; sr >>= 6 ; | |
| xmc [39] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [40] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [41] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [42] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [43] = sr & 0x7 ; sr >>= 3 ; | |
| sr = *c++ ; /* 30 */ | |
| xmc [44] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [45] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 2 ; | |
| xmc [46] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [47] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [48] = sr & 0x7 ; sr >>= 3 ; | |
| sr |= (uint16_t) *c++ << 1 ; | |
| xmc [49] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [50] = sr & 0x7 ; sr >>= 3 ; | |
| xmc [51] = sr & 0x7 ; sr >>= 3 ; | |
| } | |
| } | |
| else | |
| #endif | |
| { | |
| /* GSM_MAGIC = (*c >> 4) & 0xF ; */ | |
| if (((*c >> 4) & 0x0F) != GSM_MAGIC) return -1 ; | |
| LARc [0] = (*c++ & 0xF) << 2 ; /* 1 */ | |
| LARc [0] |= (*c >> 6) & 0x3 ; | |
| LARc [1] = *c++ & 0x3F ; | |
| LARc [2] = (*c >> 3) & 0x1F ; | |
| LARc [3] = (*c++ & 0x7) << 2 ; | |
| LARc [3] |= (*c >> 6) & 0x3 ; | |
| LARc [4] = (*c >> 2) & 0xF ; | |
| LARc [5] = (*c++ & 0x3) << 2 ; | |
| LARc [5] |= (*c >> 6) & 0x3 ; | |
| LARc [6] = (*c >> 3) & 0x7 ; | |
| LARc [7] = *c++ & 0x7 ; | |
| Nc [0] = (*c >> 1) & 0x7F ; | |
| bc [0] = (*c++ & 0x1) << 1 ; | |
| bc [0] |= (*c >> 7) & 0x1 ; | |
| Mc [0] = (*c >> 5) & 0x3 ; | |
| xmaxc [0] = (*c++ & 0x1F) << 1 ; | |
| xmaxc [0] |= (*c >> 7) & 0x1 ; | |
| xmc [0] = (*c >> 4) & 0x7 ; | |
| xmc [1] = (*c >> 1) & 0x7 ; | |
| xmc [2] = (*c++ & 0x1) << 2 ; | |
| xmc [2] |= (*c >> 6) & 0x3 ; | |
| xmc [3] = (*c >> 3) & 0x7 ; | |
| xmc [4] = *c++ & 0x7 ; | |
| xmc [5] = (*c >> 5) & 0x7 ; | |
| xmc [6] = (*c >> 2) & 0x7 ; | |
| xmc [7] = (*c++ & 0x3) << 1 ; /* 10 */ | |
| xmc [7] |= (*c >> 7) & 0x1 ; | |
| xmc [8] = (*c >> 4) & 0x7 ; | |
| xmc [9] = (*c >> 1) & 0x7 ; | |
| xmc [10] = (*c++ & 0x1) << 2 ; | |
| xmc [10] |= (*c >> 6) & 0x3 ; | |
| xmc [11] = (*c >> 3) & 0x7 ; | |
| xmc [12] = *c++ & 0x7 ; | |
| Nc [1] = (*c >> 1) & 0x7F ; | |
| bc [1] = (*c++ & 0x1) << 1 ; | |
| bc [1] |= (*c >> 7) & 0x1 ; | |
| Mc [1] = (*c >> 5) & 0x3 ; | |
| xmaxc [1] = (*c++ & 0x1F) << 1 ; | |
| xmaxc [1] |= (*c >> 7) & 0x1 ; | |
| xmc [13] = (*c >> 4) & 0x7 ; | |
| xmc [14] = (*c >> 1) & 0x7 ; | |
| xmc [15] = (*c++ & 0x1) << 2 ; | |
| xmc [15] |= (*c >> 6) & 0x3 ; | |
| xmc [16] = (*c >> 3) & 0x7 ; | |
| xmc [17] = *c++ & 0x7 ; | |
| xmc [18] = (*c >> 5) & 0x7 ; | |
| xmc [19] = (*c >> 2) & 0x7 ; | |
| xmc [20] = (*c++ & 0x3) << 1 ; | |
| xmc [20] |= (*c >> 7) & 0x1 ; | |
| xmc [21] = (*c >> 4) & 0x7 ; | |
| xmc [22] = (*c >> 1) & 0x7 ; | |
| xmc [23] = (*c++ & 0x1) << 2 ; | |
| xmc [23] |= (*c >> 6) & 0x3 ; | |
| xmc [24] = (*c >> 3) & 0x7 ; | |
| xmc [25] = *c++ & 0x7 ; | |
| Nc [2] = (*c >> 1) & 0x7F ; | |
| bc [2] = (*c++ & 0x1) << 1 ; /* 20 */ | |
| bc [2] |= (*c >> 7) & 0x1 ; | |
| Mc [2] = (*c >> 5) & 0x3 ; | |
| xmaxc [2] = (*c++ & 0x1F) << 1 ; | |
| xmaxc [2] |= (*c >> 7) & 0x1 ; | |
| xmc [26] = (*c >> 4) & 0x7 ; | |
| xmc [27] = (*c >> 1) & 0x7 ; | |
| xmc [28] = (*c++ & 0x1) << 2 ; | |
| xmc [28] |= (*c >> 6) & 0x3 ; | |
| xmc [29] = (*c >> 3) & 0x7 ; | |
| xmc [30] = *c++ & 0x7 ; | |
| xmc [31] = (*c >> 5) & 0x7 ; | |
| xmc [32] = (*c >> 2) & 0x7 ; | |
| xmc [33] = (*c++ & 0x3) << 1 ; | |
| xmc [33] |= (*c >> 7) & 0x1 ; | |
| xmc [34] = (*c >> 4) & 0x7 ; | |
| xmc [35] = (*c >> 1) & 0x7 ; | |
| xmc [36] = (*c++ & 0x1) << 2 ; | |
| xmc [36] |= (*c >> 6) & 0x3 ; | |
| xmc [37] = (*c >> 3) & 0x7 ; | |
| xmc [38] = *c++ & 0x7 ; | |
| Nc [3] = (*c >> 1) & 0x7F ; | |
| bc [3] = (*c++ & 0x1) << 1 ; | |
| bc [3] |= (*c >> 7) & 0x1 ; | |
| Mc [3] = (*c >> 5) & 0x3 ; | |
| xmaxc [3] = (*c++ & 0x1F) << 1 ; | |
| xmaxc [3] |= (*c >> 7) & 0x1 ; | |
| xmc [39] = (*c >> 4) & 0x7 ; | |
| xmc [40] = (*c >> 1) & 0x7 ; | |
| xmc [41] = (*c++ & 0x1) << 2 ; | |
| xmc [41] |= (*c >> 6) & 0x3 ; | |
| xmc [42] = (*c >> 3) & 0x7 ; | |
| xmc [43] = *c++ & 0x7 ; /* 30 */ | |
| xmc [44] = (*c >> 5) & 0x7 ; | |
| xmc [45] = (*c >> 2) & 0x7 ; | |
| xmc [46] = (*c++ & 0x3) << 1 ; | |
| xmc [46] |= (*c >> 7) & 0x1 ; | |
| xmc [47] = (*c >> 4) & 0x7 ; | |
| xmc [48] = (*c >> 1) & 0x7 ; | |
| xmc [49] = (*c++ & 0x1) << 2 ; | |
| xmc [49] |= (*c >> 6) & 0x3 ; | |
| xmc [50] = (*c >> 3) & 0x7 ; | |
| xmc [51] = *c & 0x7 ; /* 33 */ | |
| } | |
| Gsm_Decoder (s, LARc, Nc, bc, Mc, xmaxc, xmc, target) ; | |
| return 0 ; | |
| } | |