FreeCalypso > hg > fc-magnetite
view src/gpf3/ccd/s_padding.c @ 557:7aad22344e77
flash autodetection made to work on FC and Pirelli targets
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Tue, 11 Dec 2018 07:37:44 +0000 |
parents | c41a534f33c6 |
children |
line wrap: on
line source
/* +----------------------------------------------------------------------------- | 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 */