view src/g23m-gprs/llc/llc_rxp.c @ 292:0f688d07b068

block deep sleep on activity in new PWT and vibrator drivers
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 27 Mar 2022 00:29:19 +0000
parents fa8dc04885d8
children
line wrap: on
line source

/* 
+----------------------------------------------------------------------------- 
|  Project :  
|  Modul   :  
+----------------------------------------------------------------------------- 
|  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 :  This modul is part of the entity LLC and implements all 
|             functions to handles the incoming primitives as described in 
|             the SDL-documentation (RX-statemachine)
+----------------------------------------------------------------------------- 
*/ 

#ifndef LLC_RXP_C
#define LLC_RXP_C
#endif

#define ENTITY_LLC

/*==== INCLUDES =============================================================*/

#include "typedefs.h"   /* to get Condat data types */
#include "vsi.h"        /* to get a lot of macros */
#include "macdef.h"
#include "gprs.h"
#include "gsm.h"        /* to get a lot of macros */
#include "cnf_llc.h"    /* to get cnf-definitions */
#include "mon_llc.h"    /* to get mon-definitions */
#include "prim.h"       /* to get the definitions of used SAP and directions */
#include "llc.h"        /* to get the global entity definitions */

#include "llc_rxf.h"    /* to get local RX functions */
#include "llc_us.h"     /* to get signal interface to U */
#include "llc_uirxs.h"  /* to get signal interface to UIRX */
#include "llc_irxs.h"   /* to get signal interface to IRX */
 
#ifdef _SIMULATION_
#include <string.h>     /* to get memcpy() */
#endif

/*==== CONST ================================================================*/

/*==== LOCAL VARS ===========================================================*/

/*==== PRIVATE FUNCTIONS ====================================================*/

#ifdef _SIMULATION_
LOCAL void rx_copy_test_primitive_data  (T_GRLC_UNITDATA_IND_TEST 
                                         *grlc_unitdata_ind_test, 
                                         T_GRLC_UNITDATA_IND *grlc_unitdata_ind);
#endif

#ifndef CF_FAST_EXEC

GLOBAL void rx_grlc_xdata_ind             (T_GRLC_UNITDATA_IND *grlc_unitdata_ind);

#endif /* CF_FAST_EXEC */


/*==== PUBLIC FUNCTIONS =====================================================*/


/*
+------------------------------------------------------------------------------
| Function    : rx_grlc_data_ind
+------------------------------------------------------------------------------
| Description : Handles the primitive GRLC_DATA_IND
|
| Parameters  : *grlc_data_ind - Ptr to primitive payload
|
+------------------------------------------------------------------------------
*/
#ifndef CF_FAST_EXEC

GLOBAL void rx_grlc_data_ind ( T_GRLC_DATA_IND *grlc_data_ind )
{ 
  TRACE_FUNCTION( "grlc_data_ind" );
  
  switch( GET_STATE( RX ) )
  {
    case RX_TLLI_ASSIGNED:
    {
      /*
       * Both primitives are treated the same way and contain the same 
       * information.
       */
      PPASS (grlc_data_ind, grlc_unitdata_ind, GRLC_UNITDATA_IND);

      /*
       * Primitive is handled in rx_grlc_xdata_ind().
       */
      rx_grlc_xdata_ind (grlc_unitdata_ind);
      break;
    }
    default:
      PFREE_DESC (grlc_data_ind);
      TRACE_ERROR( "GRLC_DATA_IND unexpected" );
      break;
  }

} /* rx_grlc_data_ind() */

#endif /* CF_FAST_EXEC */


/*
+------------------------------------------------------------------------------
| Function    : rx_grlc_unitdata_ind
+------------------------------------------------------------------------------
| Description : Handles the primitive GRLC_UNITDATA_IND
|
| Parameters  : *grlc_unitdata_ind - Ptr to primitive payload
|
+------------------------------------------------------------------------------
*/
#ifndef CF_FAST_EXEC

GLOBAL void rx_grlc_unitdata_ind ( T_GRLC_UNITDATA_IND *grlc_unitdata_ind )
{ 
  TRACE_FUNCTION( "grlc_unitdata_ind" );
  
  switch( GET_STATE( RX ) )
  {
    case RX_TLLI_ASSIGNED:
      /*
       * Primitive is handled in rx_grlc_xdata_ind().
       */
      rx_grlc_xdata_ind (grlc_unitdata_ind);
      break;
    default:
      PFREE_DESC (grlc_unitdata_ind);
      TRACE_ERROR( "GRLC_UNITDATA_IND unexpected" );
      break;
  }

} /* rx_grlc_unitdata_ind() */

#endif /* CF_FAST_EXEC */


/*
+------------------------------------------------------------------------------
| Function    : rx_cci_decipher_cnf
+------------------------------------------------------------------------------
| Description : Handles the primitive CCI_DECIPHER_CNF. 
|               Note: The type LL_UNITDATA_IND is used instead to avoid PPASS
.
|
| Parameters  : *ll_unitdata_ind - Ptr to primitive payload
|
+------------------------------------------------------------------------------
*/
/*#if defined(CF_FAST_EXEC) || defined(_SIMULATION_) || \
   defined(LL_2to1) */

GLOBAL void rx_cci_decipher_cnf ( T_LL_UNITDATA_IND *ll_unitdata_ind)
{
  UBYTE             cipher;
  T_PDU_TYPE        frame_type;
  T_COMMAND         command;
  T_BIT             cr_bit;
  T_BIT             pf_bit;
  T_FRAME_NUM       nr;
  T_FRAME_NUM       ns;
  BOOL              frame_ok;
  UBYTE             frame_rej;
  USHORT            frame_rej_ctrl_length;
  USHORT            ctrl_len;


  TRACE_FUNCTION( "rx_cci_decipher_cnf" );

  cipher  = ll_unitdata_ind->cipher;

  switch( GET_STATE( RX ) )
  {
    case RX_TLLI_ASSIGNED:
      /* variable sapi is "misused" for fcs_check value */
      if (ll_unitdata_ind->sapi EQ CCI_FCS_PASSED)
      {

        {
          /*
           * Label INTERPRET
           */

          rx_interpret_frame (&ll_unitdata_ind->sdu, &ll_unitdata_ind->sapi, 
            &frame_type, &command, &cr_bit, &pf_bit, &nr, &ns, &frame_ok, 
            &frame_rej, &frame_rej_ctrl_length, cipher);

          SWITCH_LLC (ll_unitdata_ind->sapi);

          /*
           * In case of I-frames check, if the information field exceeds N201-I
           */
          if (frame_type == I_FRAME)
          {
            ctrl_len = I_CTRL_MIN_OCTETS;

            /*
             * Add sizeof SACK-Bitmap, if necessarry (add K+1)
             */
            if (command == I_SACK)
            {
              ctrl_len += (ll_unitdata_ind->sdu.buf[(ll_unitdata_ind->sdu.o_buf/8)+4] 
                            & 0x1F) + 1;
            }
            
            if (BYTELEN(ll_unitdata_ind->sdu.l_buf) > *(llc_data->n201_i) + ctrl_len)
            {
              frame_ok  = FALSE;
              frame_rej = FRMR_W2;

              TRACE_0_INFO("Received frame violates N201-I: send FRMR");
            }
          }

          /*
           * frame_ok includes: correct frame length, PD bit == 0, SAPI valid, 
           * FCS correct, known PDU type.
           */
          if (frame_ok EQ TRUE)
          {
            rx_strip_llc_header (&ll_unitdata_ind->sdu, frame_type, command);

            /*
             * Label S_DATA
             */

            switch (frame_type)
            {
              case U_FRAME:
                /*
                 * Label U_FRAME
                 */
        
                /*
                 * Service u_frames receives the SDU within the allocated UNITDATA
                 * primitive.
                 */
                sig_rx_u_data_ind (ll_unitdata_ind, command, cr_bit, pf_bit);
                break;
              case UI_FRAME:
                /*
                 * Label UI_FRAME
                 */
        
                sig_rx_uirx_data_ind (ll_unitdata_ind, nr);
                break;
              case S_FRAME:
                /*
                 * No break. S frames and I frames are treated the same way.
                 */
              case I_FRAME:
                /*
                 * Label I_FRAME
                 */

                sig_rx_irx_data_ind (ll_unitdata_ind, 
                                     command, frame_type, cr_bit, pf_bit, ns, nr);
                break;
              default:
                PFREE (ll_unitdata_ind);
                TRACE_ERROR ("unknown frame type");
                break;
            }
          }
          else /* frame_ok EQ FALSE */
          {
            /*
             * Check if frame rejection condition occurred, and if U has to be
             * informed.
             */
            if (frame_rej EQ FRAME_NOT_REJ)
            {
              TRACE_0_INFO("Frame ignored due to decode problem");
              PFREE (ll_unitdata_ind);
            }
            else /* W1 bit and/or W3 bit set */
            {
              /*
               * Inform U of the frame rejection condition.
               */
              TRACE_0_INFO("Frame rejected due to decode problem");
              sig_rx_u_frmr_ind (ll_unitdata_ind, frame_type, frame_rej_ctrl_length,
                cr_bit, frame_rej);
            }
          }
        } /* end of validity range of ll_unitdata_ind */
      }
      else /* fcs_check EQ CCI_FCS_FAILED */
      {
#ifdef TRACE_EVE
        UBYTE sapi;

        rx_interpret_frame (&ll_unitdata_ind->sdu, &sapi, 
          &frame_type, &command, &cr_bit, &pf_bit, &nr, &ns, &frame_ok, 
          &frame_rej, &frame_rej_ctrl_length, cipher);
#endif
        TRACE_0_INFO("Frame discarded due to FCS");
        PFREE (ll_unitdata_ind);
      }
      break;
    default:
      PFREE(ll_unitdata_ind);
      TRACE_ERROR( "CCI_DECIPHER_CNF unexpected" );
      break;
  }

} /* rx_cci_decipher_cnf() */

/*#endif */ /* CF_FAST_EXEC || _SIMULATION_ */


/*
+------------------------------------------------------------------------------
| Function    : rx_grlc_data_ind_test
+------------------------------------------------------------------------------
| Description : Handles the primitive GRLC_DATA_IND_TEST
|               NOTE: This is only necessary in simulation environment.
|
| Parameters  : *grlc_data_ind_test - Ptr to primitive payload
|
+------------------------------------------------------------------------------
*/
#ifdef _SIMULATION_
GLOBAL void rx_grlc_data_ind_test ( T_GRLC_DATA_IND_TEST *grlc_data_ind_test )
{
  TRACE_FUNCTION( "grlc_data_ind_test" );
  
  switch( GET_STATE( RX ) )
  {
    case RX_TLLI_ASSIGNED:
    {
      /*
       * Allocate a "normal" GRLC_UNITDATA_IND primitive and copy the data
       * of the test primitive GRLC_DATA_IND_TEST (sdu) to 
       * GRLC_UNITDATA_IND (desc_list).
       */
      PALLOC_DESC (grlc_unitdata_ind, GRLC_UNITDATA_IND);

      grlc_unitdata_ind->tlli = grlc_data_ind_test->tlli;
      rx_copy_test_primitive_data ((T_GRLC_UNITDATA_IND_TEST *)grlc_data_ind_test,
        grlc_unitdata_ind);

      /*
       * Free the received test primitive.
       */
      PFREE (grlc_data_ind_test);

      /*
       * Primitive is handled in rx_grlc_xdata_ind().
       */
      rx_grlc_xdata_ind (grlc_unitdata_ind);
      break;
    }
    default:
      PFREE (grlc_data_ind_test);
      TRACE_ERROR( "GRLC_DATA_IND_TEST unexpected" );
      break;
  }

} /* rx_grlc_data_ind_test() */
#endif /* _SIMULATION_ */


/*
+------------------------------------------------------------------------------
| Function    : rx_grlc_unitdata_ind_test
+------------------------------------------------------------------------------
| Description : Handles the primitive GRLC_UNITDATA_IND_TEST
|               NOTE: This is only necessary in simulation environment.
|
| Parameters  : *grlc_unitdata_ind_test - Ptr to primitive payload
|
+------------------------------------------------------------------------------
*/
#ifdef _SIMULATION_
GLOBAL void rx_grlc_unitdata_ind_test ( T_GRLC_UNITDATA_IND_TEST 
                                      *grlc_unitdata_ind_test )
{
  TRACE_FUNCTION( "grlc_unitdata_ind_test" );
  
  switch( GET_STATE( RX ) )
  {
    case RX_TLLI_ASSIGNED:
    {
      /*
       * Allocate a "normal" GRLC_UNITDATA_IND primitive and copy the data
       * of the test primitive GRLC_UNITDATA_IND_TEST (sdu) to 
       * GRLC_UNITDATA_IND (desc_list).
       */
      PALLOC_DESC (grlc_unitdata_ind, GRLC_UNITDATA_IND);

      grlc_unitdata_ind->tlli = grlc_unitdata_ind_test->tlli;
      rx_copy_test_primitive_data (grlc_unitdata_ind_test, grlc_unitdata_ind);

      /*
       * Free the received test primitive.
       */
      PFREE (grlc_unitdata_ind_test);

      /*
       * Primitive is handled in rx_grlc_xdata_ind().
       */
      rx_grlc_xdata_ind (grlc_unitdata_ind);
      break;
    }
    default:
      PFREE (grlc_unitdata_ind_test);
      TRACE_ERROR( "GRLC_UNITDATA_IND_TEST unexpected" );
      break;
  }

} /* rx_grlc_unitdata_ind_test() */
#endif /* _SIMULATION_ */


/*
+------------------------------------------------------------------------------
| Function    : rx_copy_test_primitive_data
+------------------------------------------------------------------------------
| Description : Copies the data of a TEST primitive (sdu) to a normal 
|               primitive (desc_list).
|               ATTENTION: All other parameters of the primitives are left 
|               untouched and are not copied by this function!
|
| Parameters  : *grlc_unitdata_ind_test  - source primitive
|               *grlc_unitdata_ind       - destination primitive
|
+------------------------------------------------------------------------------
*/
#ifdef _SIMULATION_
LOCAL void rx_copy_test_primitive_data (T_GRLC_UNITDATA_IND_TEST 
                                        *grlc_unitdata_ind_test, 
                                        T_GRLC_UNITDATA_IND *grlc_unitdata_ind)
{
#define FRAG_LEN    80 /* value + 6 must fit in an pool with lots of entries */

  T_sdu             *sdu;
  T_desc            *desc;
  T_desc            *last_desc = NULL;
  int               sdu_index;
  int               length;


  sdu = &grlc_unitdata_ind_test->sdu;

  /*
   * Begin at the first relevant octet.
   */
  sdu_index = sdu->o_buf/8;

  /*
   * Initialise descriptor list length.
   */
  grlc_unitdata_ind->desc_list.list_len = 0;


  /*
   * Copy complete SDU to descriptor list using descriptors of max. 10 bytes.
   */
  while (sdu_index < sdu->l_buf/8)
  {
    /*
     * Calculate length of descriptor data (= length of remaining sdu buffer
     * with a maximum of FRAG_LEN)
     */
    length = (sdu_index+FRAG_LEN < sdu->l_buf/8) ? FRAG_LEN 
                                                 : (sdu->l_buf/8 - sdu_index);

    /*
     * Allocate the necessary size for the data descriptor. The size is 
     * calculated as follows:
     * - take the size of a descriptor structure
     * - subtract one because of the array buffer[1] to get the size of
     *   descriptor control information
     * - add number of octets of descriptor data
     */
    MALLOC (desc, (USHORT)(sizeof(T_desc) - 1 + length));

    /*
     * Fill descriptor control information.
     */
    desc->next  = (ULONG)NULL;
    desc->len   = length;

    /*
     * Add length of descriptor data to list length.
     */
    grlc_unitdata_ind->desc_list.list_len  += length;

    /*
     * Copy user data from SDU to descriptor.
     */
    memcpy (desc->buffer, &sdu->buf[sdu_index], length);
    sdu_index += length;

    if (last_desc)
    {
      /*
       * Add this descriptor (not the first) to the descriptor list.
       */
      last_desc->next = (ULONG)desc;
    }
    else
    {
      /*
       * Insert first descriptor in descriptor list.
       */
      grlc_unitdata_ind->desc_list.first     = (ULONG)desc;
    }

    /*
     * Store this descriptor for later use.
     */
    last_desc = desc;
  }

  return;
} /* rx_copy_test_primitive_data */
#endif /* _SIMULATION_ */


/*
+------------------------------------------------------------------------------
| Function    : rx_grlc_xdata_ind
+------------------------------------------------------------------------------
| Description : Handles the primitives GRLC_DATA_IND / GRLC_UNITDATA_IND.
|
| Parameters  : *grlc_unitdata_ind - Ptr to primitive payload
|
+------------------------------------------------------------------------------
*/
#ifndef CF_FAST_EXEC

GLOBAL void rx_grlc_xdata_ind ( T_GRLC_UNITDATA_IND *grlc_unitdata_ind )
{
  T_PDU_TYPE        frame_type;
  UBYTE             protected_mode;
  UBYTE             sapi;
  T_FRAME_NUM       ns;
  BOOL              ciphering;
  USHORT            header_size;
  BOOL              frame_ok;


  TRACE_FUNCTION( "grlc_xdata_ind" );

  /*
   * Unassigning old TLLI 
   *
   * GMM has to be informed, that new TLLI has been received. So GMM can unassign old TLLI 
   * and old PTMSI in GRLC
   * Old tlli will be unassigned here. Normally GMM has to sent LLGMM_ASSIGN_REQ with
   * new_tlli != all 1's and old_tlli == all 1,s. See 04.64 cp. 6.1 <R.LLC.TLLI_ASS.A.002>
   */
#ifdef LL_2to1
  if ( PS_TLLI_INVALID     != llc_data->tlli_old 
#else
  if ( LLGMM_TLLI_INVALID     != llc_data->tlli_old 
#endif
  &&   grlc_unitdata_ind->tlli != llc_data->tlli_old )
  {
    PALLOC ( llgmm_tlli_ind, LLGMM_TLLI_IND );
      llgmm_tlli_ind->new_tlli = grlc_unitdata_ind->tlli;
#ifdef LL_2to1
      llc_data->tlli_old = PS_TLLI_INVALID;
#else
      llc_data->tlli_old = LLGMM_TLLI_INVALID;
#endif
    PSEND ( hCommGMM,   llgmm_tlli_ind);
  }
  rx_analyse_ctrl_field (grlc_unitdata_ind, &frame_type, &protected_mode,
    &sapi, &ns, &ciphering, &header_size, &frame_ok);

  if (frame_ok EQ TRUE)
  {
    /*
     * Check, if the sapi of the frame is supported. If ok, switch context 
     * and handle the frame.
     */
    switch (sapi)
    {
      case LL_SAPI_1:
      case LL_SAPI_3:
      case LL_SAPI_5:
      case LL_SAPI_7:
      case LL_SAPI_9:
      case LL_SAPI_11:
        SWITCH_LLC (sapi);
        rx_send_decipher_req (grlc_unitdata_ind, frame_type, protected_mode, 
          ns, header_size, ciphering);
        /*
         * Free only the primitive (desc_list copied in rx_send_decipher_req)
         */
        PFREE (grlc_unitdata_ind); /* Do not use PFREE_DESC here !*/
        break;

      default:
        /*
         * Ignore frame.
         * Free prim and desc_list, because they are not used further
         */
        PFREE_DESC (grlc_unitdata_ind);
        TRACE_0_INFO("Frame received for reserved SAPI");
        break;
    }
  }
  else /* frame_ok NEQ TRUE */
  {
    /*
     * Free GRLC_UNITDATA_IND along with complete descriptor list.
     */
    PFREE_DESC (grlc_unitdata_ind);
    TRACE_EVENT("Frame ignored!");
  }

  return;
} /* rx_grlc_xdata_ind() */

#endif /* CF_FAST_EXEC */