FreeCalypso > hg > fc-magnetite
view src/g23m-gprs/llc/llc_f.c @ 662:8cd8fd15a095
SIM speed enhancement re-enabled and made configurable
TI's original code supported SIM speed enhancement, but Openmoko had it
disabled, and OM's disabling of speed enhancement somehow caused certain
SIM cards to start working which didn't work before (OM's bug #666).
Because our FC community is much smaller in year 2020 than OM's community
was in their day, we are not able to find one of those #666-affected SIMs,
thus the real issue they had encountered remains elusive. Thus our
solution is to re-enable SIM speed enhancement and simply wait for if
and when someone runs into a #666-affected SIM once again. We provide
a SIM_allow_speed_enhancement global variable that allows SIM speed
enhancement to be enabled or disabled per session, and an /etc/SIM_spenh
file in FFS that allows it to enabled or disabled on a non-volatile
basis. SIM speed enhancement is now enabled by default.
| author | Mychaela Falconia <falcon@freecalypso.org> |
|---|---|
| date | Sun, 24 May 2020 05:02:28 +0000 |
| parents | 219afcfc6250 |
| 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 : 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 */