/*

 * 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.

 */

/* $Header: /tmp_amd/presto/export/kbs/jutta/src/gsm/RCS/gsm_implode.c,v 1.2 1996/07/02 14:32:43 jutta Exp jutta $ */

#include "private.h"

#include "gsm.h"

#include "proto.h"

void gsm_implode P3((s, source, c), gsm s, gsm_signal * source, gsm_byte * c)

{

	/*	variable	size	index

		GSM_MAGIC	4	-

		LARc[0]		6	0

		LARc[1]		6	1

		LARc[2]		5	2

		LARc[3]		5	3

		LARc[4]		4	4

		LARc[5]		4	5

		LARc[6]		3	6

		LARc[7]		3	7

		Nc[0]		7	8

		bc[0]		2	9

		Mc[0]		2	10

		xmaxc[0]	6	11

		xmc[0]		3	12

		xmc[1]		3	13

		xmc[2]		3	14

		xmc[3]		3	15

		xmc[4]		3	16

		xmc[5]		3	17

		xmc[6]		3	18

		xmc[7]		3	19

		xmc[8]		3	20

		xmc[9]		3	21

		xmc[10]		3	22

		xmc[11]		3	23

		xmc[12]		3	24

		Nc[1]		7	25

		bc[1]		2	26

		Mc[1]		2	27

		xmaxc[1]	6	28

		xmc[13]		3	29

		xmc[14]		3	30

		xmc[15]		3	31

		xmc[16]		3	32

		xmc[17]		3	33

		xmc[18]		3	34

		xmc[19]		3	35

		xmc[20]		3	36

		xmc[21]		3	37

		xmc[22]		3	38

		xmc[23]		3	39

		xmc[24]		3	40

		xmc[25]		3	41

		Nc[2]		7	42

		bc[2]		2	43

		Mc[2]		2	44

		xmaxc[2]	6	45

		xmc[26]		3	46

		xmc[27]		3	47

		xmc[28]		3	48

		xmc[29]		3	49

		xmc[30]		3	50

		xmc[31]		3	51

		xmc[32]		3	52

		xmc[33]		3	53

		xmc[34]		3	54

		xmc[35]		3	55

		xmc[36]		3	56

		xmc[37]		3	57

		xmc[38]		3	58

		Nc[3]		7	59

		bc[3]		2	60

		Mc[3]		2	61

		xmaxc[3]	6	62

		xmc[39]		3	63

		xmc[40]		3	64

		xmc[41]		3	65

		xmc[42]		3	66

		xmc[43]		3	67

		xmc[44]		3	68

		xmc[45]		3	69

		xmc[46]		3	70

		xmc[47]		3	71

		xmc[48]		3	72

		xmc[49]		3	73

		xmc[50]		3	74

		xmc[51]		3	75

	*/

	/*	There are 76 parameters per frame.  The first eight are

	 * 	unique.  The remaining 68 are four identical subframes of

	 * 	17 parameters each.  gsm_implode converts from a representation

	 * 	of these parameters as values in one array of signed words

	 * 	to the "packed" version of a GSM frame.

	 */

#	define	LARc	source

#	define	Nc	*((gsm_signal (*) [17])(source + 8))

#	define	bc	*((gsm_signal (*) [17])(source + 9))

#	define	Mc	*((gsm_signal (*) [17])(source + 10))

#	define	xmaxc	*((gsm_signal (*) [17])(source + 11))

// Wirlab

	(void)s;

#ifdef WAV49

	if (s->wav_fmt) {

		uword sr = 0;

		if (s->frame_index == 0) {

			sr = *c++;

			LARc[0] = sr & 0x3f;  sr >>= 6;

			sr |= (uword)*c++ << 2;

			LARc[1] = sr & 0x3f;  sr >>= 6;

			sr |= (uword)*c++ << 4;

			LARc[2] = sr & 0x1f;  sr >>= 5;

			LARc[3] = sr & 0x1f;  sr >>= 5;

			sr |= (uword)*c++ << 2;

			LARc[4] = sr & 0xf;  sr >>= 4;

			LARc[5] = sr & 0xf;  sr >>= 4;

			sr |= (uword)*c++ << 2;			/* 5 */

			LARc[6] = sr & 0x7;  sr >>= 3;

			LARc[7] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 4;

			Nc[0] = sr & 0x7f;  sr >>= 7;

			bc[0] = sr & 0x3;  sr >>= 2;

			Mc[0] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 1;

			xmaxc[0] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 12)

			xmc[0] = sr & 0x7;  sr >>= 3;

			sr = *c++;

			xmc[1] = sr & 0x7;  sr >>= 3;

			xmc[2] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 2;

			xmc[3] = sr & 0x7;  sr >>= 3;

			xmc[4] = sr & 0x7;  sr >>= 3;

			xmc[5] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 2;

			xmc[11] = sr & 0x7;  sr >>= 3;

			xmc[12] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 4;

			Nc[1] = sr & 0x7f;  sr >>= 7;

			bc[1] = sr & 0x3;  sr >>= 2;

			Mc[1] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 1;

			xmaxc[1] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 29 - 13)

			xmc[13] = sr & 0x7;  sr >>= 3;

			sr = *c++;				/* 15 */

			xmc[14] = sr & 0x7;  sr >>= 3;

			xmc[15] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 2;

			xmc[16] = sr & 0x7;  sr >>= 3;

			xmc[17] = sr & 0x7;  sr >>= 3;

			xmc[18] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 2;

			xmc[24] = sr & 0x7;  sr >>= 3;

			xmc[25] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 4;			/* 20 */

			Nc[2] = sr & 0x7f;  sr >>= 7;

			bc[2] = sr & 0x3;  sr >>= 2;

			Mc[2] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 1;

			xmaxc[2] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 46 - 26)

			xmc[26] = sr & 0x7;  sr >>= 3;

			sr = *c++;

			xmc[27] = sr & 0x7;  sr >>= 3;

			xmc[28] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 2;

			xmc[29] = sr & 0x7;  sr >>= 3;

			xmc[30] = sr & 0x7;  sr >>= 3;

			xmc[31] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 2;

			xmc[37] = sr & 0x7;  sr >>= 3;

			xmc[38] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 4;

			Nc[3] = sr & 0x7f;  sr >>= 7;

			bc[3] = sr & 0x3;  sr >>= 2;

			Mc[3] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 1;

			xmaxc[3] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 63 - 39)

			xmc[39] = sr & 0x7;  sr >>= 3;

			sr = *c++;

			xmc[40] = sr & 0x7;  sr >>= 3;

			xmc[41] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 2;			/* 30 */

			xmc[42] = sr & 0x7;  sr >>= 3;

			xmc[43] = sr & 0x7;  sr >>= 3;

			xmc[44] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*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 |= (uword)*c++ << 4;			/* 1 */

			LARc[0] = sr & 0x3f;  sr >>= 6;

			LARc[1] = sr & 0x3f;  sr >>= 6;

			sr = *c++;

			LARc[2] = sr & 0x1f;  sr >>= 5;

			sr |= (uword)*c++ << 3;

			LARc[3] = sr & 0x1f;  sr >>= 5;

			LARc[4] = sr & 0xf;  sr >>= 4;

			sr |= (uword)*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 |= (uword)*c++ << 1;

			bc[0] = sr & 0x3;  sr >>= 2;

			Mc[0] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 5;

			xmaxc[0] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 12)

			xmc[0] = sr & 0x7;  sr >>= 3;

			xmc[1] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 2;			/* 10 */

			xmc[7] = sr & 0x7;  sr >>= 3;

			xmc[8] = sr & 0x7;  sr >>= 3;

			xmc[9] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 1;

			bc[1] = sr & 0x3;  sr >>= 2;

			Mc[1] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 5;

			xmaxc[1] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 29 - 13)

			xmc[13] = sr & 0x7;  sr >>= 3;

			xmc[14] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 2;

			xmc[20] = sr & 0x7;  sr >>= 3;

			xmc[21] = sr & 0x7;  sr >>= 3;

			xmc[22] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 1;			/* 20 */

			bc[2] = sr & 0x3;  sr >>= 2;

			Mc[2] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 5;

			xmaxc[2] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 46 - 26)

			xmc[26] = sr & 0x7;  sr >>= 3;

			xmc[27] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 2;

			xmc[33] = sr & 0x7;  sr >>= 3;

			xmc[34] = sr & 0x7;  sr >>= 3;

			xmc[35] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 1;		

			bc[3] = sr & 0x3;  sr >>= 2;

			Mc[3] = sr & 0x3;  sr >>= 2;

			sr |= (uword)*c++ << 5;

			xmaxc[3] = sr & 0x3f;  sr >>= 6;

#undef	xmc

#define	xmc	(source + 63 - 39)

			xmc[39] = sr & 0x7;  sr >>= 3;

			xmc[40] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*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 |= (uword)*c++ << 2;

			xmc[46] = sr & 0x7;  sr >>= 3;

			xmc[47] = sr & 0x7;  sr >>= 3;

			xmc[48] = sr & 0x7;  sr >>= 3;

			sr |= (uword)*c++ << 1;

			xmc[49] = sr & 0x7;  sr >>= 3;

			xmc[50] = sr & 0x7;  sr >>= 3;

			xmc[51] = sr & 0x7;  sr >>= 3;

		}

	}

	else

#endif 

	{

	*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)

#undef xmc

#define	xmc	(source + 12)

	       | ((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)

#undef	xmc

#define	xmc	(source + 29 - 13)

	       | ((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)

#undef	xmc

#define	xmc	(source + 46 - 26)

	       | ((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)

#undef	xmc

#define	xmc	(source + 63 - 39)

	       | ((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);

	}

}