xref: /third_party/libsnd/src/GSM610/gsm_encode.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"

void gsm_encode (gsm s, gsm_signal * source, gsm_byte * c)
{
	int16_t		LARc [8], Nc [4], Mc [4], bc [4], xmaxc [4], xmc [13 * 4] ;

	Gsm_Coder (s, source, LARc, Nc, bc, Mc, xmaxc, xmc) ;


	/*	variable	size

		GSM_MAGIC	4

		LARc [0]		6
		LARc [1]		6
		LARc [2]		5
		LARc [3]		5
		LARc [4]		4
		LARc [5]		4
		LARc [6]		3
		LARc [7]		3

		Nc [0]		7
		bc [0]		2
		Mc [0]		2
		xmaxc [0]	6
		xmc [0]		3
		xmc [1]		3
		xmc [2]		3
		xmc [3]		3
		xmc [4]		3
		xmc [5]		3
		xmc [6]		3
		xmc [7]		3
		xmc [8]		3
		xmc [9]		3
		xmc [10]		3
		xmc [11]		3
		xmc [12]		3

		Nc [1]		7
		bc [1]		2
		Mc [1]		2
		xmaxc [1]	6
		xmc [13]		3
		xmc [14]		3
		xmc [15]		3
		xmc [16]		3
		xmc [17]		3
		xmc [18]		3
		xmc [19]		3
		xmc [20]		3
		xmc [21]		3
		xmc [22]		3
		xmc [23]		3
		xmc [24]		3
		xmc [25]		3

		Nc [2]		7
		bc [2]		2
		Mc [2]		2
		xmaxc [2]	6
		xmc [26]		3
		xmc [27]		3
		xmc [28]		3
		xmc [29]		3
		xmc [30]		3
		xmc [31]		3
		xmc [32]		3
		xmc [33]		3
		xmc [34]		3
		xmc [35]		3
		xmc [36]		3
		xmc [37]		3
		xmc [38]		3

		Nc [3]		7
		bc [3]		2
		Mc [3]		2
		xmaxc [3]	6
		xmc [39]		3
		xmc [40]		3
		xmc [41]		3
		xmc [42]		3
		xmc [43]		3
		xmc [44]		3
		xmc [45]		3
		xmc [46]		3
		xmc [47]		3
		xmc [48]		3
		xmc [49]		3
		xmc [50]		3
		xmc [51]		3
	*/

#ifdef WAV49

	if (s->wav_fmt)
	{	s->frame_index = !s->frame_index ;
		if (s->frame_index)
		{	uint16_t sr ;

			sr = 0 ;
			sr = sr >> 6 | LARc [0] << 10 ;
			sr = sr >> 6 | LARc [1] << 10 ;
			*c++ = sr >> 4 ;
			sr = sr >> 5 | LARc [2] << 11 ;
			*c++ = sr >> 7 ;
			sr = sr >> 5 | LARc [3] << 11 ;
			sr = sr >> 4 | LARc [4] << 12 ;
			*c++ = sr >> 6 ;
			sr = sr >> 4 | LARc [5] << 12 ;
			sr = sr >> 3 | LARc [6] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | LARc [7] << 13 ;
			sr = sr >> 7 | Nc [0] << 9 ;
			*c++ = sr >> 5 ;
			sr = sr >> 2 | bc [0] << 14 ;
			sr = sr >> 2 | Mc [0] << 14 ;
			sr = sr >> 6 | xmaxc [0] << 10 ;
			*c++ = sr >> 3 ;
			sr = sr >> 3 | xmc [0] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [1] << 13 ;
			sr = sr >> 3 | xmc [2] << 13 ;
			sr = sr >> 3 | xmc [3] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [4] << 13 ;
			sr = sr >> 3 | xmc [5] << 13 ;
			sr = sr >> 3 | xmc [6] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [7] << 13 ;
			sr = sr >> 3 | xmc [8] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [9] << 13 ;
			sr = sr >> 3 | xmc [10] << 13 ;
			sr = sr >> 3 | xmc [11] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [12] << 13 ;
			sr = sr >> 7 | Nc [1] << 9 ;
			*c++ = sr >> 5 ;
			sr = sr >> 2 | bc [1] << 14 ;
			sr = sr >> 2 | Mc [1] << 14 ;
			sr = sr >> 6 | xmaxc [1] << 10 ;
			*c++ = sr >> 3 ;
			sr = sr >> 3 | xmc [13] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [14] << 13 ;
			sr = sr >> 3 | xmc [15] << 13 ;
			sr = sr >> 3 | xmc [16] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [17] << 13 ;
			sr = sr >> 3 | xmc [18] << 13 ;
			sr = sr >> 3 | xmc [19] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [20] << 13 ;
			sr = sr >> 3 | xmc [21] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [22] << 13 ;
			sr = sr >> 3 | xmc [23] << 13 ;
			sr = sr >> 3 | xmc [24] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [25] << 13 ;
			sr = sr >> 7 | Nc [2] << 9 ;
			*c++ = sr >> 5 ;
			sr = sr >> 2 | bc [2] << 14 ;
			sr = sr >> 2 | Mc [2] << 14 ;
			sr = sr >> 6 | xmaxc [2] << 10 ;
			*c++ = sr >> 3 ;
			sr = sr >> 3 | xmc [26] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [27] << 13 ;
			sr = sr >> 3 | xmc [28] << 13 ;
			sr = sr >> 3 | xmc [29] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [30] << 13 ;
			sr = sr >> 3 | xmc [31] << 13 ;
			sr = sr >> 3 | xmc [32] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [33] << 13 ;
			sr = sr >> 3 | xmc [34] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [35] << 13 ;
			sr = sr >> 3 | xmc [36] << 13 ;
			sr = sr >> 3 | xmc [37] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [38] << 13 ;
			sr = sr >> 7 | Nc [3] << 9 ;
			*c++ = sr >> 5 ;
			sr = sr >> 2 | bc [3] << 14 ;
			sr = sr >> 2 | Mc [3] << 14 ;
			sr = sr >> 6 | xmaxc [3] << 10 ;
			*c++ = sr >> 3 ;
			sr = sr >> 3 | xmc [39] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [40] << 13 ;
			sr = sr >> 3 | xmc [41] << 13 ;
			sr = sr >> 3 | xmc [42] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [43] << 13 ;
			sr = sr >> 3 | xmc [44] << 13 ;
			sr = sr >> 3 | xmc [45] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [46] << 13 ;
			sr = sr >> 3 | xmc [47] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [48] << 13 ;
			sr = sr >> 3 | xmc [49] << 13 ;
			sr = sr >> 3 | xmc [50] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [51] << 13 ;
			sr = sr >> 4 ;
			*c = sr >> 8 ;
			s->frame_chain = *c ;
		}
		else {
			uint16_t sr ;

			sr = 0 ;
			sr = sr >> 4 | s->frame_chain << 12 ;
			sr = sr >> 6 | LARc [0] << 10 ;
			*c++ = sr >> 6 ;
			sr = sr >> 6 | LARc [1] << 10 ;
			*c++ = sr >> 8 ;
			sr = sr >> 5 | LARc [2] << 11 ;
			sr = sr >> 5 | LARc [3] << 11 ;
			*c++ = sr >> 6 ;
			sr = sr >> 4 | LARc [4] << 12 ;
			sr = sr >> 4 | LARc [5] << 12 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | LARc [6] << 13 ;
			sr = sr >> 3 | LARc [7] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 7 | Nc [0] << 9 ;
			sr = sr >> 2 | bc [0] << 14 ;
			*c++ = sr >> 7 ;
			sr = sr >> 2 | Mc [0] << 14 ;
			sr = sr >> 6 | xmaxc [0] << 10 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [0] << 13 ;
			sr = sr >> 3 | xmc [1] << 13 ;
			sr = sr >> 3 | xmc [2] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [3] << 13 ;
			sr = sr >> 3 | xmc [4] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [5] << 13 ;
			sr = sr >> 3 | xmc [6] << 13 ;
			sr = sr >> 3 | xmc [7] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [8] << 13 ;
			sr = sr >> 3 | xmc [9] << 13 ;
			sr = sr >> 3 | xmc [10] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [11] << 13 ;
			sr = sr >> 3 | xmc [12] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 7 | Nc [1] << 9 ;
			sr = sr >> 2 | bc [1] << 14 ;
			*c++ = sr >> 7 ;
			sr = sr >> 2 | Mc [1] << 14 ;
			sr = sr >> 6 | xmaxc [1] << 10 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [13] << 13 ;
			sr = sr >> 3 | xmc [14] << 13 ;
			sr = sr >> 3 | xmc [15] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [16] << 13 ;
			sr = sr >> 3 | xmc [17] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [18] << 13 ;
			sr = sr >> 3 | xmc [19] << 13 ;
			sr = sr >> 3 | xmc [20] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [21] << 13 ;
			sr = sr >> 3 | xmc [22] << 13 ;
			sr = sr >> 3 | xmc [23] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [24] << 13 ;
			sr = sr >> 3 | xmc [25] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 7 | Nc [2] << 9 ;
			sr = sr >> 2 | bc [2] << 14 ;
			*c++ = sr >> 7 ;
			sr = sr >> 2 | Mc [2] << 14 ;
			sr = sr >> 6 | xmaxc [2] << 10 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [26] << 13 ;
			sr = sr >> 3 | xmc [27] << 13 ;
			sr = sr >> 3 | xmc [28] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [29] << 13 ;
			sr = sr >> 3 | xmc [30] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [31] << 13 ;
			sr = sr >> 3 | xmc [32] << 13 ;
			sr = sr >> 3 | xmc [33] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [34] << 13 ;
			sr = sr >> 3 | xmc [35] << 13 ;
			sr = sr >> 3 | xmc [36] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [37] << 13 ;
			sr = sr >> 3 | xmc [38] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 7 | Nc [3] << 9 ;
			sr = sr >> 2 | bc [3] << 14 ;
			*c++ = sr >> 7 ;
			sr = sr >> 2 | Mc [3] << 14 ;
			sr = sr >> 6 | xmaxc [3] << 10 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [39] << 13 ;
			sr = sr >> 3 | xmc [40] << 13 ;
			sr = sr >> 3 | xmc [41] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [42] << 13 ;
			sr = sr >> 3 | xmc [43] << 13 ;
			*c++ = sr >> 8 ;
			sr = sr >> 3 | xmc [44] << 13 ;
			sr = sr >> 3 | xmc [45] << 13 ;
			sr = sr >> 3 | xmc [46] << 13 ;
			*c++ = sr >> 7 ;
			sr = sr >> 3 | xmc [47] << 13 ;
			sr = sr >> 3 | xmc [48] << 13 ;
			sr = sr >> 3 | xmc [49] << 13 ;
			*c++ = sr >> 6 ;
			sr = sr >> 3 | xmc [50] << 13 ;
			sr = sr >> 3 | xmc [51] << 13 ;
			*c++ = sr >> 8 ;
		}
	}

	else

#endif	/* WAV49 */
	{

		*c++ = ((GSM_MAGIC & 0xF) << 4)		/* 1 */
				| ((LARc [0] >> 2) & 0xF) ;
		*c++ = ((LARc [0] & 0x3) << 6)
				| (LARc [1] & 0x3F) ;
		*c++ = ((LARc [2] & 0x1F) << 3)
				| ((LARc [3] >> 2) & 0x7) ;
		*c++ = ((LARc [3] & 0x3) << 6)
				| ((LARc [4] & 0xF) << 2)
				| ((LARc [5] >> 2) & 0x3) ;
		*c++ = ((LARc [5] & 0x3) << 6)
				| ((LARc [6] & 0x7) << 3)
				| (LARc [7] & 0x7) ;
		*c++ = ((Nc [0] & 0x7F) << 1)
				| ((bc [0] >> 1) & 0x1) ;
		*c++ = ((bc [0] & 0x1) << 7)
				| ((Mc [0] & 0x3) << 5)
				| ((xmaxc [0] >> 1) & 0x1F) ;
		*c++ = ((xmaxc [0] & 0x1) << 7)
				| ((xmc [0] & 0x7) << 4)
				| ((xmc [1] & 0x7) << 1)
				| ((xmc [2] >> 2) & 0x1) ;
		*c++ = ((xmc [2] & 0x3) << 6)
				| ((xmc [3] & 0x7) << 3)
				| (xmc [4] & 0x7) ;
		*c++ = ((xmc [5] & 0x7) << 5)			/* 10 */
				| ((xmc [6] & 0x7) << 2)
				| ((xmc [7] >> 1) & 0x3) ;
		*c++ = ((xmc [7] & 0x1) << 7)
				| ((xmc [8] & 0x7) << 4)
				| ((xmc [9] & 0x7) << 1)
				| ((xmc [10] >> 2) & 0x1) ;
		*c++ = ((xmc [10] & 0x3) << 6)
				| ((xmc [11] & 0x7) << 3)
				| (xmc [12] & 0x7) ;
		*c++ = ((Nc [1] & 0x7F) << 1)
				| ((bc [1] >> 1) & 0x1) ;
		*c++ = ((bc [1] & 0x1) << 7)
				| ((Mc [1] & 0x3) << 5)
				| ((xmaxc [1] >> 1) & 0x1F) ;
		*c++ = ((xmaxc [1] & 0x1) << 7)
				| ((xmc [13] & 0x7) << 4)
				| ((xmc [14] & 0x7) << 1)
				| ((xmc [15] >> 2) & 0x1) ;
		*c++ = ((xmc [15] & 0x3) << 6)
				| ((xmc [16] & 0x7) << 3)
				| (xmc [17] & 0x7) ;
		*c++ = ((xmc [18] & 0x7) << 5)
				| ((xmc [19] & 0x7) << 2)
				| ((xmc [20] >> 1) & 0x3) ;
		*c++ = ((xmc [20] & 0x1) << 7)
				| ((xmc [21] & 0x7) << 4)
				| ((xmc [22] & 0x7) << 1)
				| ((xmc [23] >> 2) & 0x1) ;
		*c++ = ((xmc [23] & 0x3) << 6)
				| ((xmc [24] & 0x7) << 3)
				| (xmc [25] & 0x7) ;
		*c++ = ((Nc [2] & 0x7F) << 1)			/* 20 */
				| ((bc [2] >> 1) & 0x1) ;
		*c++ = ((bc [2] & 0x1) << 7)
				| ((Mc [2] & 0x3) << 5)
				| ((xmaxc [2] >> 1) & 0x1F) ;
		*c++ = ((xmaxc [2] & 0x1) << 7)
				| ((xmc [26] & 0x7) << 4)
				| ((xmc [27] & 0x7) << 1)
				| ((xmc [28] >> 2) & 0x1) ;
		*c++ = ((xmc [28] & 0x3) << 6)
				| ((xmc [29] & 0x7) << 3)
				| (xmc [30] & 0x7) ;
		*c++ = ((xmc [31] & 0x7) << 5)
				| ((xmc [32] & 0x7) << 2)
				| ((xmc [33] >> 1) & 0x3) ;
		*c++ = ((xmc [33] & 0x1) << 7)
				| ((xmc [34] & 0x7) << 4)
				| ((xmc [35] & 0x7) << 1)
				| ((xmc [36] >> 2) & 0x1) ;
		*c++ = ((xmc [36] & 0x3) << 6)
				| ((xmc [37] & 0x7) << 3)
				| (xmc [38] & 0x7) ;
		*c++ = ((Nc [3] & 0x7F) << 1)
				| ((bc [3] >> 1) & 0x1) ;
		*c++ = ((bc [3] & 0x1) << 7)
				| ((Mc [3] & 0x3) << 5)
				| ((xmaxc [3] >> 1) & 0x1F) ;
		*c++ = ((xmaxc [3] & 0x1) << 7)
				| ((xmc [39] & 0x7) << 4)
				| ((xmc [40] & 0x7) << 1)
				| ((xmc [41] >> 2) & 0x1) ;
		*c++ = ((xmc [41] & 0x3) << 6)			/* 30 */
				| ((xmc [42] & 0x7) << 3)
				| (xmc [43] & 0x7) ;
		*c++ = ((xmc [44] & 0x7) << 5)
				| ((xmc [45] & 0x7) << 2)
				| ((xmc [46] >> 1) & 0x3) ;
		*c++ = ((xmc [46] & 0x1) << 7)
				| ((xmc [47] & 0x7) << 4)
				| ((xmc [48] & 0x7) << 1)
				| ((xmc [49] >> 2) & 0x1) ;
		*c++ = ((xmc [49] & 0x3) << 6)
				| ((xmc [50] & 0x7) << 3)
				| (xmc [51] & 0x7) ;

	}
}