FreeCalypso > hg > freecalypso-sw
comparison gsm-fw/ccd/s_padding.c @ 648:970d6199f2c5
gsm-fw/ccd/*.[ch]: initial import from the LoCosto source
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Thu, 04 Sep 2014 05:48:57 +0000 |
parents | |
children |
comparison
equal
deleted
inserted
replaced
647:a60b375014e3 | 648:970d6199f2c5 |
---|---|
1 /* | |
2 +----------------------------------------------------------------------------- | |
3 | Project : | |
4 | Modul : s_padding.c | |
5 +----------------------------------------------------------------------------- | |
6 | Copyright 2002 Texas Instruments Berlin, AG | |
7 | All rights reserved. | |
8 | | |
9 | This file is confidential and a trade secret of Texas | |
10 | Instruments Berlin, AG | |
11 | The receipt of or possession of this file does not convey | |
12 | any rights to reproduce or disclose its contents or to | |
13 | manufacture, use, or sell anything it may describe, in | |
14 | whole, or in part, without the specific written consent of | |
15 | Texas Instruments Berlin, AG. | |
16 +----------------------------------------------------------------------------- | |
17 | Purpose : Definition of encoding and decoding functions for S_PADDING elements | |
18 +----------------------------------------------------------------------------- | |
19 */ | |
20 | |
21 | |
22 /* | |
23 * standard definitions like GLOBAL, UCHAR, ERROR etc. | |
24 */ | |
25 #include "typedefs.h" | |
26 #include "header.h" | |
27 | |
28 /* | |
29 * Prototypes of ccd (USE_DRIVER EQ undef) for prototypes only | |
30 * look at ccdapi.h | |
31 */ | |
32 #undef USE_DRIVER | |
33 #include "ccdapi.h" | |
34 | |
35 /* | |
36 * Types and functions for bit access and manipulation | |
37 */ | |
38 #include "ccd_globs.h" | |
39 #include "bitfun.h" | |
40 | |
41 /* | |
42 * Prototypes of ccd internal functions | |
43 */ | |
44 #include "ccd.h" | |
45 | |
46 /* | |
47 * Declaration of coder/decoder tables | |
48 */ | |
49 #include "ccdtable.h" | |
50 #include "ccddata.h" | |
51 | |
52 #ifndef RUN_FLASH | |
53 /* | |
54 +--------------------------------------------------------------------+ | |
55 | PROJECT : CCD (6144) MODULE : CDC_GSM | | |
56 | STATE : code ROUTINE : cdc_padd_decode | | |
57 +--------------------------------------------------------------------+ | |
58 | |
59 PURPOSE : Decoding of the GSM Type CSN1 spare padding. | |
60 This function does not evaluate the encoded bits, since | |
61 their content is irrelevant. | |
62 */ | |
63 | |
64 SHORT cdc_padd_decode (const ULONG c_ref, const ULONG e_ref, T_CCD_Globs *globs) | |
65 { | |
66 USHORT cixRef; | |
67 | |
68 #ifdef DEBUG_CCD | |
69 TRACE_CCD (globs, "cdc_padd_decode()"); | |
70 #endif | |
71 | |
72 /* | |
73 * Do not decode padding bits. They are not relevant. | |
74 * Just adjust the position pointer in the bit stream buffer. | |
75 * Either to the next octet boundary or to the message end, if necessary. | |
76 */ | |
77 bf_incBitpos (8-(globs->bitpos & 7), globs); | |
78 | |
79 /* First assume padding bits up to an octet boundary. In this case | |
80 * message extension could be made of T, TV or TLV types. | |
81 */ | |
82 globs->SeekTLVExt = TRUE; | |
83 | |
84 cixRef = melem[e_ref].calcIdxRef; | |
85 if (calcidx[cixRef].numPrologSteps > 0) | |
86 { | |
87 USHORT msgEnd = (USHORT) calc[calcidx[cixRef].prologStepRef].operand * 8; | |
88 if (msgEnd) | |
89 { | |
90 msgEnd += globs->bitoffs; | |
91 msgEnd = (USHORT)MINIMUM(globs->maxBitpos, msgEnd); | |
92 bf_setBitpos (msgEnd, globs); | |
93 /* | |
94 * Padding bytes exclude the presence of message extension. | |
95 */ | |
96 globs->SeekTLVExt = FALSE; | |
97 } | |
98 } | |
99 | |
100 return 1; | |
101 } | |
102 #endif /* !RUN_FLASH */ | |
103 | |
104 #ifndef RUN_FLASH | |
105 /* | |
106 +--------------------------------------------------------------------+ | |
107 | PROJECT : CCD (6144) MODULE : CDC_GSM | | |
108 | STATE : code ROUTINE : cdc_padd_encode | | |
109 +--------------------------------------------------------------------+ | |
110 | |
111 PURPOSE : Encoding of the GSM Type CSN1 spare padding. | |
112 Supported padding values are 0x00 and 0x2B, if first prolog | |
113 step is a value msg_len, padding is done until globs->bitpos is | |
114 msg_len*8, else until octet boundary | |
115 */ | |
116 | |
117 SHORT cdc_padd_encode (const ULONG c_ref, const ULONG e_ref, T_CCD_Globs *globs) | |
118 { | |
119 UBYTE padd_bit = 0; | |
120 USHORT cixRef; | |
121 | |
122 #ifdef DEBUG_CCD | |
123 TRACE_CCD (globs, "cdc_padd_encode()"); | |
124 #endif | |
125 | |
126 cixRef = melem[e_ref].calcIdxRef; | |
127 | |
128 /* | |
129 * if this element is conditional, check the condition | |
130 */ | |
131 if (calcidx[cixRef].numCondCalcs NEQ 0 | |
132 AND ! ccd_conditionOK (e_ref, globs)) | |
133 return 1; | |
134 | |
135 if (melem[e_ref].elemType EQ 'S' AND spare[melem[e_ref].elemRef].bSize EQ 8) | |
136 { | |
137 UBYTE spareVal = (UBYTE)(spare[melem[e_ref].elemRef].value); | |
138 /* | |
139 * Element is a SPARE of length 8. | |
140 */ | |
141 while (globs->bitpos % 8 NEQ 0) | |
142 { | |
143 switch(spareVal) | |
144 { | |
145 case 0: | |
146 break; | |
147 case 0x2B: | |
148 padd_bit = (UBYTE)GET_HL(0); | |
149 break; | |
150 default: | |
151 ccd_setError (globs, ERR_INTERNAL_ERROR, | |
152 BREAK, | |
153 (USHORT) (globs->bitpos), | |
154 (USHORT) -1); | |
155 } | |
156 bf_writeBit (padd_bit, globs); | |
157 } | |
158 if (calcidx[cixRef].numPrologSteps > 0) | |
159 { | |
160 if (calc[calcidx[cixRef].prologStepRef].operation NEQ 'P') | |
161 ccd_setError (globs, ERR_INTERNAL_ERROR, BREAK, (USHORT) -1); | |
162 else | |
163 { | |
164 USHORT msgLen = (USHORT)(calc[calcidx[cixRef].prologStepRef].operand * 8); | |
165 | |
166 while (globs->bitpos - globs->bitoffs < msgLen ) | |
167 { | |
168 bf_codeLongNumber (8, (ULONG) spareVal, globs); | |
169 } | |
170 } | |
171 } | |
172 } | |
173 else | |
174 { | |
175 ccd_setError (globs, ERR_INVALID_TYPE, | |
176 BREAK, | |
177 (USHORT) (globs->bitpos), | |
178 (USHORT) -1); | |
179 } | |
180 | |
181 return 1; | |
182 } | |
183 #endif /* !RUN_FLASH */ |