FreeCalypso > hg > freecalypso-citrine
diff ccd/s_padding.c @ 0:75a11d740a02
initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 09 Jun 2016 00:02:41 +0000 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/ccd/s_padding.c Thu Jun 09 00:02:41 2016 +0000 @@ -0,0 +1,183 @@ +/* ++----------------------------------------------------------------------------- +| Project : +| Modul : s_padding.c ++----------------------------------------------------------------------------- +| Copyright 2002 Texas Instruments Berlin, AG +| All rights reserved. +| +| This file is confidential and a trade secret of Texas +| Instruments Berlin, AG +| The receipt of or possession of this file does not convey +| any rights to reproduce or disclose its contents or to +| manufacture, use, or sell anything it may describe, in +| whole, or in part, without the specific written consent of +| Texas Instruments Berlin, AG. ++----------------------------------------------------------------------------- +| Purpose : Definition of encoding and decoding functions for S_PADDING elements ++----------------------------------------------------------------------------- +*/ + + +/* + * standard definitions like GLOBAL, UCHAR, ERROR etc. + */ +#include "typedefs.h" +#include "header.h" + +/* + * Prototypes of ccd (USE_DRIVER EQ undef) for prototypes only + * look at ccdapi.h + */ +#undef USE_DRIVER +#include "ccdapi.h" + +/* + * Types and functions for bit access and manipulation + */ +#include "ccd_globs.h" +#include "bitfun.h" + +/* + * Prototypes of ccd internal functions + */ +#include "ccd.h" + +/* + * Declaration of coder/decoder tables + */ +#include "ccdtable.h" +#include "ccddata.h" + +#ifndef RUN_FLASH +/* ++--------------------------------------------------------------------+ +| PROJECT : CCD (6144) MODULE : CDC_GSM | +| STATE : code ROUTINE : cdc_padd_decode | ++--------------------------------------------------------------------+ + + PURPOSE : Decoding of the GSM Type CSN1 spare padding. + This function does not evaluate the encoded bits, since + their content is irrelevant. +*/ + +SHORT cdc_padd_decode (const ULONG c_ref, const ULONG e_ref, T_CCD_Globs *globs) +{ + USHORT cixRef; + +#ifdef DEBUG_CCD + TRACE_CCD (globs, "cdc_padd_decode()"); +#endif + + /* + * Do not decode padding bits. They are not relevant. + * Just adjust the position pointer in the bit stream buffer. + * Either to the next octet boundary or to the message end, if necessary. + */ + bf_incBitpos (8-(globs->bitpos & 7), globs); + + /* First assume padding bits up to an octet boundary. In this case + * message extension could be made of T, TV or TLV types. + */ + globs->SeekTLVExt = TRUE; + + cixRef = melem[e_ref].calcIdxRef; + if (calcidx[cixRef].numPrologSteps > 0) + { + USHORT msgEnd = (USHORT) calc[calcidx[cixRef].prologStepRef].operand * 8; + if (msgEnd) + { + msgEnd += globs->bitoffs; + msgEnd = (USHORT)MINIMUM(globs->maxBitpos, msgEnd); + bf_setBitpos (msgEnd, globs); + /* + * Padding bytes exclude the presence of message extension. + */ + globs->SeekTLVExt = FALSE; + } + } + + return 1; +} +#endif /* !RUN_FLASH */ + +#ifndef RUN_FLASH +/* ++--------------------------------------------------------------------+ +| PROJECT : CCD (6144) MODULE : CDC_GSM | +| STATE : code ROUTINE : cdc_padd_encode | ++--------------------------------------------------------------------+ + + PURPOSE : Encoding of the GSM Type CSN1 spare padding. + Supported padding values are 0x00 and 0x2B, if first prolog + step is a value msg_len, padding is done until globs->bitpos is + msg_len*8, else until octet boundary +*/ + +SHORT cdc_padd_encode (const ULONG c_ref, const ULONG e_ref, T_CCD_Globs *globs) +{ + UBYTE padd_bit = 0; + USHORT cixRef; + +#ifdef DEBUG_CCD + TRACE_CCD (globs, "cdc_padd_encode()"); +#endif + + cixRef = melem[e_ref].calcIdxRef; + + /* + * if this element is conditional, check the condition + */ + if (calcidx[cixRef].numCondCalcs NEQ 0 + AND ! ccd_conditionOK (e_ref, globs)) + return 1; + + if (melem[e_ref].elemType EQ 'S' AND spare[melem[e_ref].elemRef].bSize EQ 8) + { + UBYTE spareVal = (UBYTE)(spare[melem[e_ref].elemRef].value); + /* + * Element is a SPARE of length 8. + */ + while (globs->bitpos % 8 NEQ 0) + { + switch(spareVal) + { + case 0: + break; + case 0x2B: + padd_bit = (UBYTE)GET_HL(0); + break; + default: + ccd_setError (globs, ERR_INTERNAL_ERROR, + BREAK, + (USHORT) (globs->bitpos), + (USHORT) -1); + } + bf_writeBit (padd_bit, globs); + } + if (calcidx[cixRef].numPrologSteps > 0) + { + if (calc[calcidx[cixRef].prologStepRef].operation NEQ 'P') + ccd_setError (globs, ERR_INTERNAL_ERROR, BREAK, (USHORT) -1); + else + { + USHORT msgLen = (USHORT)(calc[calcidx[cixRef].prologStepRef].operand * 8); + + while (globs->bitpos - globs->bitoffs < msgLen ) + { + bf_codeLongNumber (8, (ULONG) spareVal, globs); + } + } + } + } + else + { + ccd_setError (globs, ERR_INVALID_TYPE, + BREAK, + (USHORT) (globs->bitpos), + (USHORT) -1); + } + + return 1; +} +#endif /* !RUN_FLASH */