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