furnace/extern/libsndfile-modified/src/GSM610/gsm_decode.c
tildearrow 061991fe60 desubmodulize libsndfile - PLEASE READ
it appears a one-character typo in the cmake_minimum_required line prevents it from compiling under CMake 4.0.
in order to fix that, I had to take this thing out of submodules...

it is recommended to do this after you pull;

git submodule deinit extern/libsndfile
2025-04-02 15:09:53 -05:00

358 lines
11 KiB
C

/*
* 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 ;
}