diff src/g23m-gprs/llc/llc_f.c @ 1:fa8dc04885d8

src/g23m-*: import from Magnetite
author Mychaela Falconia <falcon@freecalypso.org>
date Fri, 16 Oct 2020 06:25:50 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/g23m-gprs/llc/llc_f.c	Fri Oct 16 06:25:50 2020 +0000
@@ -0,0 +1,1457 @@
+/* 
++----------------------------------------------------------------------------- 
+|  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 :  Contains global functions of Logical Link Control (LLC)
++----------------------------------------------------------------------------- 
+*/ 
+
+#define LLC_F_C
+
+#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_par.h"    /* to get the default values of the LLC paramters */
+#include "llc_uf.h"     /* to get the XID parameter definitions */
+
+
+/*==== CONST ================================================================*/
+
+/*==== LOCAL VARS ===========================================================*/
+
+/*==== PRIVATE FUNCTIONS ====================================================*/
+
+/*==== PUBLIC FUNCTIONS =====================================================*/
+
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_init_parameters
++------------------------------------------------------------------------------
+| Description : This procedure initialises the LLC layer parameters with 
+|               their default values as they are defined in LLC_PAR.H.
+|
+| Parameters  : 
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_init_parameters (void)
+{
+  UBYTE             incarnation;
+
+  TRACE_FUNCTION ("llc_init_parameters");
+
+  llc_data->version                               = LLC_VERSION_ALL_SAPIS;
+
+  llc_data->iov_ui                                = LLC_IOV_UI_ALL_SAPIS;
+  llc_data->iov_i_base[IMAP(LL_SAPI_3)]           = LLC_IOV_I_SAPI_3;
+  llc_data->iov_i_base[IMAP(LL_SAPI_5)]           = LLC_IOV_I_SAPI_5;
+  llc_data->iov_i_base[IMAP(LL_SAPI_9)]           = LLC_IOV_I_SAPI_9;
+  llc_data->iov_i_base[IMAP(LL_SAPI_11)]          = LLC_IOV_I_SAPI_11;
+
+  /*
+   * The LLC parameters for T200 are contained in T200 service data.
+   */
+  llc_data->t200_base[UIMAP(LL_SAPI_1)].length    = LLC_T200_SAPI_1;
+  llc_data->t200_base[UIMAP(LL_SAPI_3)].length    = LLC_T200_SAPI_3;
+  llc_data->t200_base[UIMAP(LL_SAPI_5)].length    = LLC_T200_SAPI_5;
+  llc_data->t200_base[UIMAP(LL_SAPI_7)].length    = LLC_T200_SAPI_7;
+  llc_data->t200_base[UIMAP(LL_SAPI_9)].length    = LLC_T200_SAPI_9;
+  llc_data->t200_base[UIMAP(LL_SAPI_11)].length   = LLC_T200_SAPI_11;
+
+  /*
+   * The LLC parameters for T201 are contained in T201 service data.
+   * T201 is being set to the same values as T200 for all SAPIs.
+   * <R.LLC.LLC_PAR.A.015>
+   */
+  llc_data->n200_base[UIMAP(LL_SAPI_1)]           = LLC_N200_SAPI_1;
+  llc_data->n200_base[UIMAP(LL_SAPI_3)]           = LLC_N200_SAPI_3;
+  llc_data->n200_base[UIMAP(LL_SAPI_5)]           = LLC_N200_SAPI_5;
+  llc_data->n200_base[UIMAP(LL_SAPI_7)]           = LLC_N200_SAPI_7;
+  llc_data->n200_base[UIMAP(LL_SAPI_9)]           = LLC_N200_SAPI_9;
+  llc_data->n200_base[UIMAP(LL_SAPI_11)]          = LLC_N200_SAPI_11;
+
+  llc_data->n201_u_base[UIMAP(LL_SAPI_1)]         = LLC_N201_U_SAPI_1;
+  llc_data->n201_u_base[UIMAP(LL_SAPI_3)]         = LLC_N201_U_SAPI_3;
+  llc_data->n201_u_base[UIMAP(LL_SAPI_5)]         = LLC_N201_U_SAPI_5;
+  llc_data->n201_u_base[UIMAP(LL_SAPI_7)]         = LLC_N201_U_SAPI_7;
+  llc_data->n201_u_base[UIMAP(LL_SAPI_9)]         = LLC_N201_U_SAPI_9;
+  llc_data->n201_u_base[UIMAP(LL_SAPI_11)]        = LLC_N201_U_SAPI_11;
+
+  llc_data->n201_i_base[IMAP(LL_SAPI_3)]          = LLC_N201_I_SAPI_3;
+  llc_data->n201_i_base[IMAP(LL_SAPI_5)]          = LLC_N201_I_SAPI_5;
+  llc_data->n201_i_base[IMAP(LL_SAPI_9)]          = LLC_N201_I_SAPI_9;
+  llc_data->n201_i_base[IMAP(LL_SAPI_11)]         = LLC_N201_I_SAPI_11;
+      
+  llc_data->md_base[IMAP(LL_SAPI_3)]              = LLC_MD_SAPI_3;
+  llc_data->md_base[IMAP(LL_SAPI_5)]              = LLC_MD_SAPI_5;
+  llc_data->md_base[IMAP(LL_SAPI_9)]              = LLC_MD_SAPI_9;
+  llc_data->md_base[IMAP(LL_SAPI_11)]             = LLC_MD_SAPI_11;
+      
+  llc_data->mu_base[IMAP(LL_SAPI_3)]              = LLC_MU_SAPI_3;
+  llc_data->mu_base[IMAP(LL_SAPI_5)]              = LLC_MU_SAPI_5;
+  llc_data->mu_base[IMAP(LL_SAPI_9)]              = LLC_MU_SAPI_9;
+  llc_data->mu_base[IMAP(LL_SAPI_11)]             = LLC_MU_SAPI_11;
+      
+  llc_data->kd_base[IMAP(LL_SAPI_3)]              = LLC_KD_SAPI_3;
+  llc_data->kd_base[IMAP(LL_SAPI_5)]              = LLC_KD_SAPI_5;
+  llc_data->kd_base[IMAP(LL_SAPI_9)]              = LLC_KD_SAPI_9;
+  llc_data->kd_base[IMAP(LL_SAPI_11)]             = LLC_KD_SAPI_11;
+      
+  llc_data->ku_base[IMAP(LL_SAPI_3)]              = LLC_KU_SAPI_3;
+  llc_data->ku_base[IMAP(LL_SAPI_5)]              = LLC_KU_SAPI_5;
+  llc_data->ku_base[IMAP(LL_SAPI_9)]              = LLC_KU_SAPI_9;
+  llc_data->ku_base[IMAP(LL_SAPI_11)]             = LLC_KU_SAPI_11;
+
+  /*
+   * Reset all OCs for unacknowledged transfer.
+   */
+  for (incarnation = 0; incarnation < MAX_SAPI_INC; incarnation++)
+  {
+    llc_data->sapi_base[incarnation].oc_ui_tx = 0L;
+    llc_data->sapi_base[incarnation].oc_ui_rx = 0L;
+  }
+
+  return;
+} /* llc_init_parameters() */
+
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_get_ffs_data
++------------------------------------------------------------------------------
+| Description : Load configured LLC parameter from FFS. In case of _SIMULATION_
+|               only default values are returned.
+|
+| Parameters  : type             - XID Paramter type
+|               sapi_array_index - Array index of Sapi !!!
+|
++------------------------------------------------------------------------------
+*/
+LOCAL USHORT llc_get_ffs_data (UBYTE type, UBYTE sapi_array_index)
+{
+
+  switch (type)
+  {
+#ifdef _SIMULATION_
+
+    case XID_T200:      
+      if (llc_data->ffs_xid.t200[sapi_array_index].valid)
+        return llc_data->ffs_xid.t200[sapi_array_index].value; /* 50 = 5 sec !!! */
+      else
+        return (USHORT)INT2XID(llc_data->t200_base[sapi_array_index].length);
+
+    case XID_N200:      
+      if (llc_data->ffs_xid.n200[sapi_array_index].valid)
+        return (USHORT)llc_data->ffs_xid.n200[sapi_array_index].value;
+      else
+        return (USHORT)llc_data->n200_base[sapi_array_index];
+
+    case XID_MD:        
+      if (llc_data->ffs_xid.md[sapi_array_index].valid)
+        return llc_data->ffs_xid.md[sapi_array_index].value;
+      else
+        return llc_data->md_base[sapi_array_index];
+
+    case XID_MU:        
+      if (llc_data->ffs_xid.mu[sapi_array_index].valid)
+        return (USHORT)llc_data->ffs_xid.mu[sapi_array_index].value;
+      else
+        return (USHORT)llc_data->mu_base[sapi_array_index];
+
+    case XID_N201_U:    
+      if (llc_data->ffs_xid.n201_u[sapi_array_index].valid)
+        return llc_data->ffs_xid.n201_u[sapi_array_index].value;
+      else
+        return llc_data->n201_u_base[sapi_array_index];
+
+    case XID_N201_I:
+      if (llc_data->ffs_xid.n201_i[sapi_array_index].valid)
+        return llc_data->ffs_xid.n201_i[sapi_array_index].value;
+      else
+        return llc_data->n201_i_base[sapi_array_index];
+
+    case XID_KD:        
+      if (llc_data->ffs_xid.kd[sapi_array_index].valid)
+        return (USHORT)llc_data->ffs_xid.kd[sapi_array_index].value;
+      else
+        return (USHORT)llc_data->kd_base[sapi_array_index];
+
+    case XID_KU:        
+      if (llc_data->ffs_xid.ku[sapi_array_index].valid)
+        return (USHORT)llc_data->ffs_xid.ku[sapi_array_index].value;
+      else
+        return (USHORT)llc_data->ku_base[sapi_array_index];
+
+#else
+
+    case XID_T200:      return (USHORT)INT2XID(llc_data->t200_base[sapi_array_index].length);
+    case XID_N200:      return (USHORT)llc_data->n200_base[sapi_array_index];
+/*  case XID_N201_U:    return (USHORT)llc_data->n201_u_base[sapi_array_index]; */
+/*  case XID_KD:        return (USHORT)llc_data->kd_base[sapi_array_index]; */
+/*  case XID_KU:        return (USHORT)llc_data->ku_base[sapi_array_index]; */
+    case XID_N201_I:    return (USHORT)N201_I_SUPPORTED;
+    case XID_N201_U:    return (USHORT)N201_U_SUPPORTED;
+    case XID_KD:        return (USHORT)KD_KD_SUPPORTED; 
+    case XID_KU:        return (USHORT)KD_KU_SUPPORTED;
+    case XID_MD:        return (USHORT)KD_MD_SUPPORTED;
+    case XID_MU:        return (USHORT)KD_MU_SUPPORTED;
+
+
+#endif /* _SIMULATION_ */
+
+    default:
+      TRACE_ERROR ("Illegal FFS parameter used");
+      return 0;
+  }
+
+} /* llc_get_ffs_data */
+
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_init_requested_xid
++------------------------------------------------------------------------------
+| Description : Fill in requested XID parameters into requested_xid structure
+|
+| Parameters  : 
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_init_requested_xid (void)
+{
+  UBYTE  u_inc, i_inc, sapi;
+  USHORT requested_value;
+
+  for (u_inc = 0; u_inc < ACKNOWLEDGED_INC; u_inc++)
+  {
+    llc_data->requested_l3_xid_base[u_inc].valid  = FALSE;
+  }
+
+  for (sapi = LL_SAPI_1; sapi <= LL_SAPI_11; sapi += 2)
+  {
+    u_inc = UIMAP(sapi);
+
+    llc_data->u_base[u_inc].requested_xid.version.valid = FALSE;
+    llc_data->u_base[u_inc].requested_xid.iov_ui.valid  = FALSE;
+    llc_data->u_base[u_inc].requested_xid.iov_i.valid   = FALSE;
+    llc_data->u_base[u_inc].requested_xid.reset.valid   = FALSE;
+
+    llc_data->u_base[u_inc].requested_xid.t200.valid    = FALSE;
+    llc_data->u_base[u_inc].requested_xid.n200.valid    = FALSE;
+    llc_data->u_base[u_inc].requested_xid.n201_u.valid  = FALSE;
+    llc_data->u_base[u_inc].requested_xid.n201_i.valid  = FALSE;
+    llc_data->u_base[u_inc].requested_xid.kd.valid      = FALSE;
+    llc_data->u_base[u_inc].requested_xid.ku.valid      = FALSE;
+    llc_data->u_base[u_inc].requested_xid.md.valid      = FALSE;
+    llc_data->u_base[u_inc].requested_xid.mu.valid      = FALSE;
+
+    requested_value = llc_get_ffs_data (XID_T200, u_inc);
+    if (requested_value != (USHORT)INT2XID(llc_data->t200_base[u_inc].length))
+    {
+      llc_data->u_base[u_inc].requested_xid.t200.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.t200.value  = requested_value;
+    }
+
+    requested_value = llc_get_ffs_data (XID_N200, u_inc);
+    if (requested_value != llc_data->n200_base[u_inc])
+    {
+      llc_data->u_base[u_inc].requested_xid.n200.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.n200.value  = (UBYTE)requested_value;
+    }
+
+    requested_value = llc_get_ffs_data (XID_N201_U, u_inc);
+    if (requested_value != llc_data->n201_u_base[u_inc])
+    {
+      llc_data->u_base[u_inc].requested_xid.n201_u.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.n201_u.value  = requested_value;
+    }
+
+    if ((sapi != LL_SAPI_1) && (sapi != LL_SAPI_7))
+    {
+      i_inc = (UBYTE)IMAP(sapi);
+
+      requested_value = llc_get_ffs_data (XID_N201_I, i_inc);
+      if (requested_value != llc_data->n201_i_base[i_inc])
+      {
+        llc_data->u_base[u_inc].requested_xid.n201_i.valid  = TRUE;
+        llc_data->u_base[u_inc].requested_xid.n201_i.value  = requested_value;
+      }
+
+      requested_value = llc_get_ffs_data (XID_MD, i_inc);
+      if (requested_value != llc_data->md_base[i_inc])
+      {
+        llc_data->u_base[u_inc].requested_xid.md.valid  = TRUE;
+        llc_data->u_base[u_inc].requested_xid.md.value  = requested_value;
+      }
+
+      requested_value = llc_get_ffs_data (XID_MU, i_inc);
+      if (requested_value != llc_data->mu_base[i_inc])
+      {
+        llc_data->u_base[u_inc].requested_xid.mu.valid  = TRUE;
+        llc_data->u_base[u_inc].requested_xid.mu.value  = requested_value;
+      }
+
+      requested_value = llc_get_ffs_data (XID_KD, i_inc);
+      if (requested_value != llc_data->kd_base[i_inc])
+      {
+        llc_data->u_base[u_inc].requested_xid.kd.valid  = TRUE;
+        llc_data->u_base[u_inc].requested_xid.kd.value  = (UBYTE)requested_value;
+      }
+  
+      requested_value = llc_get_ffs_data (XID_KU, i_inc);
+      if (requested_value != llc_data->ku_base[i_inc])
+      {
+        llc_data->u_base[u_inc].requested_xid.ku.valid  = TRUE;
+        llc_data->u_base[u_inc].requested_xid.ku.value  = (UBYTE)requested_value;
+      }
+    }
+  }
+} /* llc_init_requested_xid() */
+
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_init_requested_xid_sapi
++------------------------------------------------------------------------------
+| Description : Fill in requested XID parameters into requested_xid structure
+|
+| Parameters  : 
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_init_requested_xid_sapi (T_SAPI sapi)
+{
+  UBYTE  u_inc, i_inc;
+  USHORT requested_value;
+
+  u_inc = UIMAP(sapi);
+
+  llc_data->u_base[u_inc].requested_xid.t200.valid    = FALSE;
+  llc_data->u_base[u_inc].requested_xid.n200.valid    = FALSE;
+  llc_data->u_base[u_inc].requested_xid.n201_u.valid  = FALSE;
+  llc_data->u_base[u_inc].requested_xid.n201_i.valid  = FALSE;
+  llc_data->u_base[u_inc].requested_xid.kd.valid      = FALSE;
+  llc_data->u_base[u_inc].requested_xid.ku.valid      = FALSE;
+  llc_data->u_base[u_inc].requested_xid.md.valid      = FALSE;
+  llc_data->u_base[u_inc].requested_xid.mu.valid      = FALSE;
+
+  requested_value = llc_get_ffs_data (XID_T200, u_inc);
+  if (requested_value != (USHORT)INT2XID(llc_data->t200_base[u_inc].length))
+  {
+    llc_data->u_base[u_inc].requested_xid.t200.valid  = TRUE;
+    llc_data->u_base[u_inc].requested_xid.t200.value  = requested_value;
+  }
+
+  requested_value = llc_get_ffs_data (XID_N200, u_inc);
+  if (requested_value != llc_data->n200_base[u_inc])
+  {
+    llc_data->u_base[u_inc].requested_xid.n200.valid  = TRUE;
+    llc_data->u_base[u_inc].requested_xid.n200.value  = (UBYTE)requested_value;
+  }
+
+  requested_value = llc_get_ffs_data (XID_N201_U, u_inc);
+  if (requested_value != llc_data->n201_u_base[u_inc])
+  {
+    llc_data->u_base[u_inc].requested_xid.n201_u.valid  = TRUE;
+    llc_data->u_base[u_inc].requested_xid.n201_u.value  = requested_value;
+  }
+
+  if ((sapi != LL_SAPI_1) && (sapi != LL_SAPI_7))
+  {
+    i_inc = (UBYTE)IMAP(sapi);
+
+    requested_value = llc_get_ffs_data (XID_N201_I, i_inc);
+    if (requested_value != llc_data->n201_i_base[i_inc])
+    {
+      llc_data->u_base[u_inc].requested_xid.n201_i.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.n201_i.value  = requested_value;
+    }
+
+    requested_value = llc_get_ffs_data (XID_MD, i_inc);
+    if (requested_value != llc_data->md_base[i_inc])
+    {
+      llc_data->u_base[u_inc].requested_xid.md.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.md.value  = requested_value;
+    }
+
+    requested_value = llc_get_ffs_data (XID_MU, i_inc);
+    if (requested_value != llc_data->mu_base[i_inc])
+    {
+      llc_data->u_base[u_inc].requested_xid.mu.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.mu.value  = requested_value;
+    }
+
+    requested_value = llc_get_ffs_data (XID_KD, i_inc);
+    if (requested_value != llc_data->kd_base[i_inc])
+    {
+      llc_data->u_base[u_inc].requested_xid.kd.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.kd.value  = (UBYTE)requested_value;
+    }
+  
+    requested_value = llc_get_ffs_data (XID_KU, i_inc);
+    if (requested_value != llc_data->ku_base[i_inc])
+    {
+      llc_data->u_base[u_inc].requested_xid.ku.valid  = TRUE;
+      llc_data->u_base[u_inc].requested_xid.ku.value  = (UBYTE)requested_value;
+    }
+  }
+} /* llc_init_requested_xid_sapi() */
+
+
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_generate_input
++------------------------------------------------------------------------------
+| Description : This procedure calculates the frame-dependent input for 
+|               UI_FRAMES / I_FRAMES. S_FRAMES are treated like I_FRAMES. 
+|               Parameter direction must be one of 
+|               CCI_DIRECTION_UPLINK/DOWNLINK. The input is generated 
+|               according to section A.2.1 in GSM 04.64, and written to 
+|               paramete input. This procedure is called from services 
+|               TX and RX.
+|
+| Parameters  : sapi          - valid SAPI number
+|               frame_type    - indicates acknowledged/unacknowledged frames
+|               lfn           - LLC frame number
+|               direction     - CCI_DIRECTION_UPLINK/CCI_DIRECTION_DOWNLINK
+|               cipher_input  - generated ciphering input
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_generate_input (UBYTE sapi,
+                                T_PDU_TYPE frame_type,
+                                T_FRAME_NUM lfn,
+                                ULONG *cipher_input,
+                                ULONG oc)
+{
+  ULONG             sx;
+
+
+  TRACE_FUNCTION ("llc_generate_input");
+
+  /*
+   * According to 04.64, Annex A.2.1:
+   *   SX = 2exp27 * SAPI + 2exp31
+   */
+  sx = 134217728 * sapi + 2147483648;
+
+  if ((frame_type EQ I_FRAME) OR (frame_type EQ S_FRAME))
+  {
+    /*
+     * According to 04.64, Annex A.2.1:
+     *   Input = ((IOV-I + LFN + OC) modulo 2exp32
+     */
+    *cipher_input = (ULONG)(*(llc_data->iov_i) + lfn + oc);
+  }
+  else /* unacknowledged mode */
+  {
+    /*
+     * According to 04.64, Annex A.2.1:
+     *   Input = ((IOV-UI XOR SX) + LFN + OC) modulo 2exp32
+     */
+    *cipher_input = (ULONG)((llc_data->iov_ui ^ sx) + lfn + oc);
+  }
+
+  return;
+} /* llc_generate_input() */
+
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_build_crc24
++------------------------------------------------------------------------------
+| Description : This procedure builds a CRC24 checksum according to RFC2440,
+|               which is needed by LLC to build and check the Frame Check
+|               Sequence (FCS) which is included in each frame.
+|
+| Parameters  : octets  - a valid pointer to the frame contents
+|               len     - number of valid octets
+|
++------------------------------------------------------------------------------
+*/
+
+/* 
+ * Precomputed table for polynomial : 0x00ad85dd (high term in LSB)
+ * 24-bit masks are packed in 16-bits words
+ *
+ */
+ 
+const USHORT a_fcs24_tab_rev_packed[384] = {
+  0x0000, 0x7600, 0xd6a7, 0x4557, 0x21f6, 0x20e2, 0x8115, 0x63b7, 0x6126, 0xc442, 0x3441, 0x9763, 
+  0x0991, 0xe734, 0xe2ae, 0x4cc6, 0xb0c2, 0x14eb, 0x8884, 0xf283, 0x552f, 0xcdd3, 0xa575, 0xa36a, 
+  0x1322, 0x5468, 0xbeb4, 0x5675, 0x039e, 0x48f1, 0x9237, 0x41df, 0x0935, 0xd760, 0x1629, 0xff70, 
+  0x1ab3, 0xc55c, 0x8abd, 0x5fe4, 0x92aa, 0x7cf8, 0x9ba6, 0xd0eb, 0x3d3c, 0xdef1, 0x871d, 0xcb79, 
+  0x2644, 0x32d0, 0x0681, 0x6313, 0x6526, 0xf0c4, 0xa751, 0x2767, 0xb100, 0xe206, 0x7091, 0x4745, 
+  0x2fd5, 0xa3e4, 0x3288, 0x6a82, 0xf412, 0xc4cd, 0xaec0, 0xb653, 0x8509, 0xeb97, 0xe1a5, 0x734c, 
+  0x3566, 0x10b8, 0x6e92, 0x7031, 0x474e, 0x98d7, 0xb473, 0x050f, 0xd913, 0xf124, 0x52f9, 0x2f56, 
+  0x3cf7, 0x818c, 0x5a9b, 0x79a0, 0xd67a, 0xacde, 0xbde2, 0x943b, 0xed1a, 0xf8b5, 0xc3cd, 0x1b5f, 
+  0x4733, 0x45fb, 0x2de0, 0x0264, 0x120d, 0xdba5, 0xc626, 0x504c, 0x9a61, 0x8371, 0x07ba, 0x6c24, 
+  0x4ea2, 0xd4cf, 0x19e9, 0x0bf5, 0x8339, 0xefac, 0xcfb7, 0xc178, 0xae68, 0x8ae0, 0x968e, 0x582d, 
+  0x5411, 0x6793, 0x45f3, 0x1146, 0x3065, 0xb3b6, 0xd504, 0x7224, 0xf272, 0x9053, 0x25d2, 0x0437, 
+  0x5d80, 0xf6a7, 0x71fa, 0x18d7, 0xa151, 0x87bf, 0xdc95, 0xe310, 0xc67b, 0x99c2, 0xb4e6, 0x303e, 
+  0x6177, 0x012b, 0xfdc6, 0x2420, 0x56dd, 0x0b83, 0xe062, 0x149c, 0x4a47, 0xa535, 0x436a, 0xbc02, 
+  0x68e6, 0x901f, 0xc9cf, 0x2db1, 0xc7e9, 0x3f8a, 0xe9f3, 0x85a8, 0x7e4e, 0xaca4, 0xd25e, 0x880b, 
+  0x7255, 0x2343, 0x95d5, 0x3702, 0x74b5, 0x6390, 0xf340, 0x36f4, 0x2254, 0xb617, 0x6102, 0xd411, 
+  0x7bc4, 0xb277, 0xa1dc, 0x3e93, 0xe581, 0x5799, 0xfad1, 0xa7c0, 0x165d, 0xbf86, 0xf036, 0xe018, 
+  0x85dd, 0xabad, 0x7b22, 0xc08a, 0xfc5b, 0x8d67, 0x04c8, 0xbe1a, 0xcca3, 0x419f, 0xe9ec, 0x3ae6, 
+  0x8c4c, 0x3a99, 0x4f2b, 0xc91b, 0x6d6f, 0xb96e, 0x0d59, 0x2f2e, 0xf8aa, 0x480e, 0x78d8, 0x0eef, 
+  0x96ff, 0x89c5, 0x1331, 0xd3a8, 0xde33, 0xe574, 0x17ea, 0x9c72, 0xa4b0, 0x52bd, 0xcb84, 0x52f5, 
+  0x9f6e, 0x18f1, 0x2738, 0xda39, 0x4f07, 0xd17d, 0x1e7b, 0x0d46, 0x90b9, 0x5b2c, 0x5ab0, 0x66fc, 
+  0xa399, 0xef7d, 0xab04, 0xe6ce, 0xb88b, 0x5d41, 0x228c, 0xfaca, 0x1c85, 0x67db, 0xad3c, 0xeac0, 
+  0xaa08, 0x7e49, 0x9f0d, 0xef5f, 0x29bf, 0x6948, 0x2b1d, 0x6bfe, 0x288c, 0x6e4a, 0x3c08, 0xdec9, 
+  0xb0bb, 0xcd15, 0xc317, 0xf5ec, 0x9ae3, 0x3552, 0x31ae, 0xd8a2, 0x7496, 0x74f9, 0x8f54, 0x82d3, 
+  0xb92a, 0x5c21, 0xf71e, 0xfc7d, 0x0bd7, 0x015b, 0x383f, 0x4996, 0x409f, 0x7d68, 0x1e60, 0xb6da, 
+  0xc2ee, 0x9856, 0x8065, 0x87b9, 0xcfa0, 0x7620, 0x43fb, 0x8de1, 0x37e4, 0x06ac, 0xda17, 0xc1a1, 
+  0xcb7f, 0x0962, 0xb46c, 0x8e28, 0x5e94, 0x4229, 0x4a6a, 0x1cd5, 0x03ed, 0x0f3d, 0x4b23, 0xf5a8, 
+  0xd1cc, 0xba3e, 0xe876, 0x949b, 0xedc8, 0x1e33, 0x50d9, 0xaf89, 0x5ff7, 0x158e, 0xf87f, 0xa9b2, 
+  0xd85d, 0x2b0a, 0xdc7f, 0x9d0a, 0x7cfc, 0x2a3a, 0x5948, 0x3ebd, 0x6bfe, 0x1c1f, 0x694b, 0x9dbb, 
+  0xe4aa, 0xdc86, 0x5043, 0xa1fd, 0x8b70, 0xa606, 0x65bf, 0xc931, 0xe7c2, 0x20e8, 0x9ec7, 0x1187, 
+  0xed3b, 0x4db2, 0x644a, 0xa86c, 0x1a44, 0x920f, 0x6c2e, 0x5805, 0xd3cb, 0x2979, 0x0ff3, 0x258e, 
+  0xf788, 0xfeee, 0x3850, 0xb2df, 0xa918, 0xce15, 0x769d, 0xeb59, 0x8fd1, 0x33ca, 0xbcaf, 0x7994, 
+  0xfe19, 0x6fda, 0x0c59, 0xbb4e, 0x382c, 0xfa1c, 0x7f0c, 0x7a6d, 0xbbd8, 0x3a5b, 0x2d9b, 0x4d9d
+};
+
+
+/******************************************************************************
+ *
+ *  FUNCTION NAME: f_crc24_tab
+ *
+ *  The function compute the 24-bit FCS and is using table for it 
+ *
+ *  ARGUMENT LIST:
+ *
+ *  Argument        Type      IO  Description
+ *  -------------   --------  --  ---------------------------------------------
+ *  data_p          T_BYTE*   I  Pointer on the input buffer
+ *  d_length          T_UINT16  I  Number of bytes to process
+ *  d_l_crc_init    T_UINT16  I  Init value of the CRC
+ *
+ * RETURN VALUE:    
+ *  Argument        Type      Description
+ *  -------------   --------  ---------------------------------------------
+ *  d_l_crc         T_UINT32  24-bit FCS stored in a 32-bit word
+ *
+ *****************************************************************************/
+GLOBAL ULONG llc_build_crc24 (UBYTE *d_data_p, 
+                              USHORT d_length)
+{
+  /*  GLOBAL VARIABLES:
+   *
+   *  Variables       Type      IO  Description
+   *  -------------   --------  --  -------------------------------------------
+   *  none
+   */
+
+  /*  LOCAL VARIABLES:
+   *
+   *  Variables       Type      Description
+   *  -------------   -------   ----------------------------------------------
+   *  d_l_crc         T_UINT32  24-bit FCS stored in a 32-bit word
+   *  d_l_tab_res     T_UINT32  FCS mask extracted from the table
+   *  d_l_tab_index   T_UINT32  Index of the FCS mask into the table
+   *  d_byte_msb      T_UINT16  Intermediate variable used to know the position
+   *                            FCSof the 24-bit FCS into two 16-bits words
+   */
+  ULONG  d_l_crc, d_l_tab_res, d_l_tab_index;
+  USHORT d_byte_msb;
+
+  d_l_crc = 0x00ffffff;
+  
+  do 
+  {
+    /* Most efficient C implementation with 32-bits tables but require more d_data rom */
+    /* d_l_crc = (d_l_crc >> 8) ^ a_fcs24_tab_rev[(d_l_crc ^ *d_data_p++) & 0xff];     */
+
+    /* Details very close to the ASM implementation */
+    d_l_tab_index = (d_l_crc ^ *d_data_p++) & 0x0ff;
+    d_l_crc >>= 8;
+
+    if(d_l_tab_index & 0x01)
+      d_byte_msb = 1;
+    else
+      d_byte_msb = 0;
+
+    d_l_tab_index *= 3;
+
+    d_l_tab_index >>= 1;
+
+    d_l_crc &= 0x0000ffff;  /* Replace the code in comment below */
+
+    d_l_tab_res = a_fcs24_tab_rev_packed[d_l_tab_index];
+    d_l_tab_res |= (a_fcs24_tab_rev_packed[d_l_tab_index+1] << 16);
+
+    if(d_byte_msb == 1)
+      d_l_tab_res >>= 8;
+
+    d_l_crc ^= d_l_tab_res;
+  } 
+  while (--d_length);
+
+  d_l_crc = (~d_l_crc) & 0x00ffffff;
+
+  return (d_l_crc);
+} /* llc_build_crc24() */
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_xid_value_acceptable
++------------------------------------------------------------------------------
+| Description : This procedure checks if the value of the XID parameter for
+|               the given SAPI is acceptable, or not. The return value is TRUE
+|               for an accepted value, and FALSE for an unaccepted value.
+|
+| Parameters  : sapi          - SAPI number
+|               xid_parameter - XID parameter (defined in llc_uf.h)
+|               xid_value     - value of XID parameter (actually UBYTE/USHORT/
+|                               ULONG, depending on the parameter)
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL BOOL llc_xid_value_acceptable (UBYTE sapi,
+                                      UBYTE xid_parameter,
+                                      ULONG xid_value)
+{
+  BOOL              rc;
+  UBYTE             u_inc, i_inc;
+
+
+  TRACE_FUNCTION ("llc_xid_value_acceptable");
+
+  /*
+   * Preset rc in case of unknown XID parameters or unknown SAPI values.
+   */
+  rc  = FALSE;
+  u_inc = UIMAP(sapi);
+  i_inc = IMAP(sapi);
+
+  /*
+   * Accept only possible (valid) values for now (defined in llc_uf.h).
+   */
+  switch (xid_parameter)
+  {
+    case XID_VERSION:
+      if (xid_value EQ LLC_VERSION_ALL_SAPIS)
+      {
+        rc = TRUE;
+        TRACE_EVENT ("Version value accepted");
+      }
+      else
+      {
+        TRACE_EVENT ("Version value NOT accepted");
+      }
+      break;
+
+    case XID_IOV_UI:
+      /*
+       * Must not be checked, ignored.
+       */
+      TRACE_EVENT ("IOV-UI values are not checked.");
+      break;
+
+    case XID_IOV_I:
+      /*
+       * Must not be checked, ignored.
+       */
+      TRACE_EVENT ("IOV-I values are not checked.");
+      break;
+
+    case XID_T200:
+      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:
+          if ( (xid_value >= (llc_data->u_base[u_inc].requested_xid.t200.valid ?
+                llc_get_ffs_data(XID_T200, u_inc): XID_T200_MIN))  
+               AND (xid_value <= XID_T200_MAX) )
+          {
+            rc = TRUE;
+            TRACE_EVENT ("T200 value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("T200 value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for T200");
+          break;
+      }
+      break;
+
+    case XID_N200:
+      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:
+          if ( (xid_value >= (llc_data->u_base[u_inc].requested_xid.n200.valid ?
+                llc_get_ffs_data(XID_N200, u_inc): XID_N200_MIN))  
+               AND (xid_value <= XID_N200_MAX) )
+          {
+            rc = TRUE;
+            TRACE_EVENT ("N200 value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("N200 value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for N200");
+          break;
+      }
+      break;
+
+    case XID_N201_U:
+      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:
+          if ( (xid_value >= (USHORT)XID_N201_U_MIN) AND 
+             (xid_value <= (llc_data->u_base[u_inc].requested_xid.n201_u.valid ?
+              llc_get_ffs_data(XID_N201_U, u_inc): XID_N201_U_MAX)) )
+          {
+            rc = TRUE;
+            TRACE_EVENT ("N201-U value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("N201-U value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for N201-U");
+          break;
+      }
+      break;
+
+    case XID_N201_I:
+      switch (sapi)
+      {
+        case LL_SAPI_3:
+        case LL_SAPI_5:
+        case LL_SAPI_9:
+        case LL_SAPI_11:
+          if ( (xid_value >= XID_N201_I_MIN) AND 
+               (xid_value <= (llc_data->u_base[u_inc].requested_xid.n201_i.valid ?
+                llc_get_ffs_data(XID_N201_I, i_inc): XID_N201_I_MAX)) )
+          {
+            rc = TRUE;
+            TRACE_EVENT ("N201-I value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("N201-I value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for N201-I");
+          break;
+      }
+      break;
+
+    case XID_MD:
+      switch (sapi)
+      {
+        case LL_SAPI_3:
+        case LL_SAPI_5:
+        case LL_SAPI_9:
+        case LL_SAPI_11:
+          if ( (xid_value == XID_MD_OFF) OR ((xid_value >= XID_MD_MIN) AND 
+               (xid_value <= (llc_data->u_base[u_inc].requested_xid.md.valid ?
+              llc_get_ffs_data(XID_MD, i_inc): XID_MD_MAX)) ))
+          {
+            rc = TRUE;
+            TRACE_EVENT ("mD value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("mD value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for mD");
+          break;
+      }
+      break;
+
+    case XID_MU:
+      switch (sapi)
+      {
+        case LL_SAPI_3:
+        case LL_SAPI_5:
+        case LL_SAPI_9:
+        case LL_SAPI_11:
+          if ( (xid_value == XID_MU_OFF) OR ((xid_value >= XID_MU_MIN) AND 
+               (xid_value <= (llc_data->u_base[u_inc].requested_xid.mu.valid ?
+                llc_get_ffs_data(XID_MU, i_inc): XID_MU_MAX)) ))
+          {
+            rc = TRUE;
+            TRACE_EVENT ("mU value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("mU value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for mU");
+          break;
+      }
+      break;
+
+    case XID_KD:
+      switch (sapi)
+      {
+        case LL_SAPI_3:
+        case LL_SAPI_5:
+        case LL_SAPI_9:
+        case LL_SAPI_11:
+          if ( (xid_value >= XID_KD_MIN) AND 
+               (xid_value <= (llc_data->u_base[u_inc].requested_xid.kd.valid ?
+                llc_get_ffs_data(XID_KD, i_inc): XID_KD_MAX)) )
+          {
+            rc = TRUE;
+            TRACE_EVENT ("kD value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("kD value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for kD");
+          break;
+      }
+      break;
+
+    case XID_KU:
+      switch (sapi)
+      {
+        case LL_SAPI_3:
+        case LL_SAPI_5:
+        case LL_SAPI_9:
+        case LL_SAPI_11:
+          if ( (xid_value >= XID_KU_MIN) AND
+               (xid_value <= (llc_data->u_base[u_inc].requested_xid.ku.valid ?
+                llc_get_ffs_data(XID_KU, i_inc): XID_KU_MAX)) )
+          {
+            rc = TRUE;
+            TRACE_EVENT ("kU value accepted");
+          }
+          else
+          {
+            TRACE_EVENT ("kU value NOT accepted");
+          }
+          break;
+        default:
+          TRACE_ERROR ("invalid SAPI value for kU");
+          break;
+      }
+      break;
+
+    case XID_LAYER_3:
+      /*
+       * Must not be checked, ignored.
+       */
+      TRACE_EVENT ("Layer-3 values are not checked.");
+      break;
+
+    case XID_RESET:
+      /*
+       * Must not be checked, ignored.
+       */
+      TRACE_EVENT ("Reset is not checked.");
+      break;
+
+    default:
+      TRACE_ERROR ("unknown XID parameter");
+      break;
+  }
+
+  return rc;
+} /* llc_xid_value_acceptable() */
+
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_palloc_desc
++------------------------------------------------------------------------------
+| Description : This function allocates a descriptor of type T_DESC3
+|
+| Parameters  : len -  length of descriptor
+|             : offset offset of descriptor
+|
+| Return      : poniter to T_DESC3
+|
++------------------------------------------------------------------------------
+*/
+#ifdef LL_DESC
+GLOBAL T_desc3* llc_palloc_desc( U16 len, U16 offset)
+{
+        T_desc3 *desc3;
+        U8 *buffer;
+
+        TRACE_FUNCTION ("llc_palloc_desc");
+
+        MALLOC (desc3, (USHORT)(sizeof(T_desc3)));
+        
+        MALLOC (buffer, len + offset);
+
+        desc3->next = NULL;
+        desc3->offset = offset;
+        desc3->len = len;
+        desc3->buffer = (ULONG)buffer;
+
+        return desc3;
+}
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_cl_desc3_free
++------------------------------------------------------------------------------
+| Description : Frees the descriptor connected to the desc3 descriptor. This 
+|               free will when applicable cause the frame to decrease a 
+|               connected counter attached to the allocation or really free
+|               the memory in case the counter is zero.
+|
+| Parameters  : T_desc3* pointer to desc3 descriptor.
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_cl_desc3_free(T_desc3* p_desc3)
+{
+  T_desc3* help;
+  while(p_desc3)
+  {
+    help = (T_desc3*)p_desc3->next;
+    MFREE(p_desc3->buffer);
+    MFREE(p_desc3);
+    p_desc3 = help;
+  }
+}
+#endif /* LL_DESC */
+
+#ifndef TI_PS_OP_CIPH_DRIVER
+/*
++------------------------------------------------------------------------------
+| Function    : llc_fbs_init
++------------------------------------------------------------------------------
+| Description : The function fbs_init() initializes service 
+|               variablaes
+|
+| Parameters  : void
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_fbs_init ( void )
+{ 
+  TRACE_FUNCTION( "llc_fbs_init" );
+  llc_data->fbs.initialized = FALSE;
+}
+#endif
+/*
++------------------------------------------------------------------------------
+| Function    : llc_copy_ul_data_to_list
++------------------------------------------------------------------------------
+| Description : The function copy_data_to_list copies the length and the pointer 
+|               of the linked descriptor list to the in_data_list.
+|               It is used in uplink direction
+|
+| Parameters  : 
+|
++------------------------------------------------------------------------------
+*/
+
+GLOBAL void llc_copy_ul_data_to_list
+( 
+ T_CCI_CIPHER_DESC_REQ *cipher_req,
+ T_CIPH_in_data_list *in_data_list
+)
+{ 
+  
+  T_desc3*           cipher_desc;
+  U16                cnt = 0;
+  T_CIPH_in_data*    in_data_array;
+
+
+  /*
+   * Count the number of descriptors in the incoming desc_list
+   */
+  cipher_desc = (T_desc3*)cipher_req->desc_list3.first;
+  while (cipher_desc){
+    cipher_desc = (T_desc3*)cipher_desc->next;  
+    cnt ++;
+  }
+  /*
+   * Allocate an array for T_CIPH_in_data_list 
+   */
+  MALLOC(in_data_array,(sizeof(T_CIPH_in_data) * cnt));
+  in_data_list->ptr_in_data = in_data_array;
+
+  /*
+   * Copy buf and len parameters from descriptors to the in_data's
+   */
+  cipher_desc = (T_desc3*)cipher_req->desc_list3.first;
+  cnt = 0;
+  while (cipher_desc)
+  {
+    in_data_list->ptr_in_data[cnt].buf = 
+      (U32)&((U8*)cipher_desc->buffer)[cipher_desc->offset];
+    in_data_list->ptr_in_data[cnt].len = cipher_desc->len;
+
+    cipher_desc = (T_desc3*)cipher_desc->next;  
+    cnt++;
+  }
+  in_data_list->c_in_data = cnt;  
+  
+} /* llc_copy_ul_data_to_list */
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_copy_dl_data_to_list
++------------------------------------------------------------------------------
+| Description : The function copy_data_to_list copies the length and the pointer 
+|               of the linked descriptor list to the in_data_list.
+|               It is used in downlink direction
+|
+| Parameters  :
+|
++------------------------------------------------------------------------------
+*/
+
+GLOBAL void llc_copy_dl_data_to_list
+( 
+ T_CCI_DECIPHER_REQ *decipher_req,
+ T_CIPH_in_data_list *in_data_list
+)
+{ 
+  
+  T_desc* decipher_desc;
+  T_CIPH_in_data*   in_data_array;
+  USHORT   cnt = 0;
+
+  /*
+   * Count the number of descriptors in the incoming desc_list
+   */
+  decipher_desc = (T_desc*)decipher_req->desc_list.first;
+  while (decipher_desc){
+    decipher_desc = (T_desc*)decipher_desc->next;  
+    cnt ++;  
+  }
+  
+  /*
+   * Allocate an array of for T_CIPH_in_data 
+   */
+  MALLOC(in_data_array, (sizeof(T_CIPH_in_data) * cnt));
+  in_data_list->ptr_in_data = in_data_array;
+
+  /*
+   * Copy buf and len parameters from descriptors to the in_data's
+   */
+  decipher_desc = (T_desc*)decipher_req->desc_list.first;
+  cnt = 0;
+  while (decipher_desc)
+  {
+    in_data_list->ptr_in_data[cnt].buf = (U32)decipher_desc->buffer;
+    in_data_list->ptr_in_data[cnt].len = decipher_desc->len;
+
+    decipher_desc = (T_desc*)decipher_desc->next;  
+    cnt++;
+  }
+  in_data_list->c_in_data = cnt;  
+  
+} /* llc_copy_dl_data_to_list */
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_fbs_enable_cci_info_trace
++------------------------------------------------------------------------------
+| Description : The llc_fbs_enable_cci_info_trace sets the variable 
+|               llc_data->fbs.cci_info_trace to TRUE 
+|
+| Parameters  : void
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_fbs_enable_cci_info_trace ( void )
+{ 
+  TRACE_FUNCTION( "llc_fbs_enable_cci_info_trace" );
+  llc_data->fbs.cci_info_trace = TRUE;
+}
+
+#ifdef LLC_TRACE_CIPHERING
+/*
++------------------------------------------------------------------------------
+| Function    : llc_trace_desc_list3_content
++------------------------------------------------------------------------------
+| Description : traces content of a desc3 descriptor list
+|
+| Parameters  : desc_list3 descriptor list
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_trace_desc_list3_content(T_desc_list3 desc_list3)
+{
+  U16 current_pos = 0;  
+  U16 dif;  
+  U16 data_len = 0;     /* The length of the data to be traced including data offset */
+  U8* p_data = NULL;    /* Pointer to byte data element */
+  T_desc3* p_desc3 = (T_desc3*)desc_list3.first; /* Pointer to the actual desc3 descriptor element */
+
+  while(p_desc3 != NULL)
+  {
+    current_pos = p_desc3->offset;
+    dif=0;
+    p_data = (U8*)p_desc3->buffer;
+    data_len = current_pos + p_desc3->len;
+    while(current_pos < data_len)
+    {
+      if (current_pos +8 <= data_len)
+      {
+        TRACE_EVENT_P8
+          ("%02x %02x %02x %02x %02x %02x %02x %02x",
+            p_data[current_pos],
+            p_data[current_pos+1],
+            p_data[current_pos+2],
+            p_data[current_pos+3],
+            p_data[current_pos+4],
+            p_data[current_pos+5],
+            p_data[current_pos+6],
+            p_data[current_pos+7]
+          );
+        current_pos += 8;
+      }
+      else
+      {
+        dif = data_len - current_pos;
+        switch(dif)
+        {
+          case 1:
+            TRACE_EVENT_P1
+            ("%02x",
+              p_data[current_pos]
+            );
+            current_pos += 1;
+            break;
+          case 2:
+            TRACE_EVENT_P2
+            ("%02x %02x",
+              p_data[current_pos],
+              p_data[current_pos+1]
+            );
+            current_pos += 2;
+            break;
+          case 3:
+            TRACE_EVENT_P3
+            ("%02x %02x %02x",
+              p_data[current_pos],
+              p_data[current_pos+1],
+              p_data[current_pos+2]
+            );
+            current_pos += 3;
+            break;
+          case 4:
+            TRACE_EVENT_P4
+            ("%02x %02x %02x %02x",
+              p_data[current_pos],
+              p_data[current_pos+1],
+              p_data[current_pos+2],
+              p_data[current_pos+3]
+            );
+            current_pos += 4;
+            break;
+          case 5:
+            TRACE_EVENT_P5
+            ("%02x %02x %02x %02x %02x",
+              p_data[current_pos],
+              p_data[current_pos+1],
+              p_data[current_pos+2],
+              p_data[current_pos+3],
+              p_data[current_pos+4]
+            );
+            current_pos += 5;
+            break;
+          case 6:
+            TRACE_EVENT_P6
+            ("%02x %02x %02x %02x %02x %02x",
+              p_data[current_pos],
+              p_data[current_pos+1],
+              p_data[current_pos+2],
+              p_data[current_pos+3],
+              p_data[current_pos+4],
+              p_data[current_pos+5]
+            );
+            current_pos += 6;
+            break;
+          case 7:
+            TRACE_EVENT_P7
+            ("%02x %02x %02x %02x %02x %02x %02x",
+              p_data[current_pos],
+              p_data[current_pos+1],
+              p_data[current_pos+2],
+              p_data[current_pos+3],
+              p_data[current_pos+4],
+              p_data[current_pos+5],
+              p_data[current_pos+6]
+            );
+            current_pos += 7;
+            break;
+        }  
+
+      }
+    }
+
+    p_desc3 = (T_desc3*)p_desc3->next;
+  }
+}
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_trace_sdu
++------------------------------------------------------------------------------
+| Description : traces content of one sdu
+|
+| Parameters  : pointer to sdu
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_trace_sdu(T_sdu* sdu)
+{
+
+  USHORT pos = sdu->o_buf >> 3;
+  USHORT  frame_len = (sdu->l_buf + 7) / 8;
+
+
+  TRACE_FUNCTION("llc_trace_sdu");
+
+  while(pos < (frame_len + (sdu->o_buf >> 3)))
+  {
+    if (pos + 8 <= (frame_len + (sdu->o_buf >> 3))) {
+      TRACE_EVENT_P8
+        ("%02x %02x %02x %02x %02x %02x %02x %02x",
+          sdu->buf[pos],
+          sdu->buf[pos + 1],
+          sdu->buf[pos + 2],
+          sdu->buf[pos + 3],
+          sdu->buf[pos + 4],
+          sdu->buf[pos + 5],
+          sdu->buf[pos + 6],
+          sdu->buf[pos + 7]
+        );
+      pos += 8;
+    } else if (pos + 7 <= (frame_len + (sdu->o_buf >> 3))){
+      TRACE_EVENT_P7
+        ("%02x %02x %02x %02x %02x %02x %02x",
+          sdu->buf[pos],
+          sdu->buf[pos + 1],
+          sdu->buf[pos + 2],
+          sdu->buf[pos + 3],
+          sdu->buf[pos + 4],
+          sdu->buf[pos + 5],
+          sdu->buf[pos + 6]
+        );
+      pos += 7;
+    } else if (pos + 6 <= (frame_len + (sdu->o_buf >> 3))){
+      TRACE_EVENT_P6
+        ("%02x %02x %02x %02x %02x %02x",
+          sdu->buf[pos],
+          sdu->buf[pos + 1],
+          sdu->buf[pos + 2],
+          sdu->buf[pos + 3],
+          sdu->buf[pos + 4],
+          sdu->buf[pos + 5]
+        );
+      pos += 6;
+    } else if (pos + 5 <= (frame_len + (sdu->o_buf >> 3))){
+      TRACE_EVENT_P5
+        ("%02x %02x %02x %02x %02x",
+          sdu->buf[pos],
+          sdu->buf[pos + 1],
+          sdu->buf[pos + 2],
+          sdu->buf[pos + 3],
+          sdu->buf[pos + 4]
+        );
+      pos += 5;
+    } else if (pos + 4 <= (frame_len + (sdu->o_buf >> 3))){
+      TRACE_EVENT_P4
+        ("%02x %02x %02x %02x",
+          sdu->buf[pos],
+          sdu->buf[pos + 1],
+          sdu->buf[pos + 2],
+          sdu->buf[pos + 3]
+        );
+      pos += 4;
+    } else if (pos + 3 <= (frame_len + (sdu->o_buf >> 3))){
+      TRACE_EVENT_P3
+        ("%02x %02x %02x",
+          sdu->buf[pos],
+          sdu->buf[pos + 1],
+          sdu->buf[pos + 2]
+        );
+      pos += 3;
+    } else if (pos + 2 <= (frame_len + (sdu->o_buf >> 3))){
+      TRACE_EVENT_P2
+        ("%02x %02x",
+          sdu->buf[pos],
+          sdu->buf[pos + 1]
+        );
+      pos += 2;
+    } else if (pos + 1 <= (frame_len + (sdu->o_buf >> 3))){
+      TRACE_EVENT_P1
+        ("%02x",
+          sdu->buf[pos]
+        );
+      pos++;
+    }
+
+  }
+}
+
+/*
++------------------------------------------------------------------------------
+| Function    : llc_trace_desc_list
++------------------------------------------------------------------------------
+| Description : traces content of one desc_list
+|
+| Parameters  : pointer to desc_list
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void llc_trace_desc_list(T_desc_list* desc_list)
+{
+  USHORT  frame_len = desc_list->list_len;
+  T_desc* desc = (T_desc*)desc_list->first;
+  USHORT  list_pos = 0;
+  USHORT  desc_pos = 0;
+
+  TRACE_FUNCTION("llc_trace_desc_list");
+
+  while(list_pos < frame_len)
+  {
+    if (desc != NULL) {
+      if (desc_pos >= desc->len) {
+        desc_pos = 0;
+        desc = (T_desc*)desc->next;
+      }
+    }
+    if (desc == NULL) {
+      return;
+    }
+    if (desc_pos + 8 <= desc->len) {
+      TRACE_EVENT_P8 ("%02x %02x %02x %02x %02x %02x %02x %02x ",
+                      desc->buffer[desc_pos],
+                      desc->buffer[desc_pos + 1],
+                      desc->buffer[desc_pos + 2],
+                      desc->buffer[desc_pos + 3],
+                      desc->buffer[desc_pos + 4],
+                      desc->buffer[desc_pos + 5],
+                      desc->buffer[desc_pos + 6],
+                      desc->buffer[desc_pos + 7]
+                     );
+      list_pos+= 8;
+      desc_pos+= 8;
+    } else if (desc_pos + 7 <= desc->len) {
+      TRACE_EVENT_P7 ("%02x %02x %02x %02x %02x %02x %02x ",
+                      desc->buffer[desc_pos],
+                      desc->buffer[desc_pos + 1],
+                      desc->buffer[desc_pos + 2],
+                      desc->buffer[desc_pos + 3],
+                      desc->buffer[desc_pos + 4],
+                      desc->buffer[desc_pos + 5],
+                      desc->buffer[desc_pos + 6]
+                     );
+      list_pos+= 7;
+      desc_pos+= 7;
+    } else if (desc_pos + 6 <= desc->len) {
+      TRACE_EVENT_P6 ("%02x %02x %02x %02x %02x %02x ",
+                      desc->buffer[desc_pos],
+                      desc->buffer[desc_pos + 1],
+                      desc->buffer[desc_pos + 2],
+                      desc->buffer[desc_pos + 3],
+                      desc->buffer[desc_pos + 4],
+                      desc->buffer[desc_pos + 5]
+                     );
+      list_pos+= 6;
+      desc_pos+= 6;
+    } else if (desc_pos + 5 <= desc->len) {
+      TRACE_EVENT_P5 ("%02x %02x %02x %02x %02x ",
+                      desc->buffer[desc_pos],
+                      desc->buffer[desc_pos + 1],
+                      desc->buffer[desc_pos + 2],
+                      desc->buffer[desc_pos + 3],
+                      desc->buffer[desc_pos + 4]
+                     );
+      list_pos+= 5;
+      desc_pos+= 5;
+    } else if (desc_pos + 4 <= desc->len) {
+      TRACE_EVENT_P4 ("%02x %02x %02x %02x ",
+                      desc->buffer[desc_pos],
+                      desc->buffer[desc_pos + 1],
+                      desc->buffer[desc_pos + 2],
+                      desc->buffer[desc_pos + 3]
+                     );
+      list_pos+= 4;
+      desc_pos+= 4;
+    } else if (desc_pos + 3 <= desc->len) {
+      TRACE_EVENT_P3 ("%02x %02x %02x ",
+                      desc->buffer[desc_pos],
+                      desc->buffer[desc_pos + 1],
+                      desc->buffer[desc_pos + 2]
+                     );
+      list_pos+= 3;
+      desc_pos+= 3;
+    } else if (desc_pos + 2 <= desc->len) {
+      TRACE_EVENT_P2 ("%02x %02x ",
+                      desc->buffer[desc_pos],
+                      desc->buffer[desc_pos + 1]
+                     );
+      list_pos+= 2;
+      desc_pos+= 2;
+    } else if (desc_pos + 1 <= desc->len) {
+      TRACE_EVENT_P1 ("%02x ",
+                      desc->buffer[desc_pos]
+                     );
+      list_pos++;
+      desc_pos++;
+    }
+  } /* while(list_pos < frame_len) */
+}
+#endif /*LLC_TRACE_CIPHERING */
+