view src/gpf3/ccd/s_padding.c @ 686:59f07d67eb45

luna target split into luna1 and luna2 luna1 is FC Luna based on iWOW DSK v4.0 or v5.0 motherboard luna2 is FC Luna based on FC Caramel2 MB
author Mychaela Falconia <falcon@freecalypso.org>
date Mon, 12 Oct 2020 18:51:24 +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 */