fc-magnetite: src/g23m-gprs/cci/cci

annotate src/g23m-gprs/cci/cci_fbsf.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

rev	line source
183 219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 +-----------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 \| Project :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 \| Modul : cci_fbsf.c
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 +-----------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 \| Copyright 2002 Texas Instruments Berlin, AG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 \| All rights reserved.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 \| Instruments Berlin, AG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 \| The receipt of or possession of this file does not convey
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 \| whole, or in part, without the specific written consent of
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 \| Texas Instruments Berlin, AG.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 +-----------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 \| Purpose : This module implements local functions for service FBS of
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 \| entity CCI.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 +-----------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #define CCI_FBSF_C
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #define ENTITY_LLC
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 /==== INCLUDES =============================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #include <string.h>
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include "typedefs.h" /* to get Condat data types */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include "vsi.h" /* to get a lot of macros */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include "macdef.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "gprs.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #include "gsm.h" /* to get a lot of macros */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "cnf_llc.h" /* to get cnf-definitions */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "mon_llc.h" /* to get mon-definitions */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #include "prim.h" /* to get the definitions of used SAP and directions */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #include "cci.h" /* to get the global entity definitions */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #include "llc.h" /* to get the global entity definitions */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #include "cci_fbsf.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #include "llc_txp.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #include "llc_rxp.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 #ifndef TI_PS_OP_CIPH_DRIVER
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include "cci_hw_sim.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 #if !defined(_GEA_SIMULATION_) && !defined(LL_2to1)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #include "config/chipset.cfg"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #if (CHIPSET == 12) \|\| (CHIPSET == 14)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 #include "cci_gea_start.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #endif /* CHIPSET */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #endif /* ! _GEA_SIMULATION_ && !LL_2to1 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 /* local buffer for the copy of ciphering key */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 static USHORT tmp_key[4];
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 /==== CONST ================================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 /==== LOCAL VARS ===========================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 USHORT* hw_reg = NULL;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 /==== LOCAL FUNCTION ===========================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 LOCAL void ciph_get_result (T_CIPH_out_data out_data, U8 status);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 LOCAL void ciph_init (void);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 LOCAL void ciph_reset_hw (void);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 LOCAL UBYTE ciph_fcs_check (UBYTE *fcs_start);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 LOCAL void ciph_get_ciphered_data (T_CIPH_out_data *out_data);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 LOCAL void ciph_get_deciphered_data (T_CIPH_out_data out_data, U8 status);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 LOCAL void ciph_fill_ul_reg (T_CIPH_cipher_req_parms *cipher_req_parms,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 T_CIPH_in_data_list *in_data_list);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 LOCAL void ciph_fill_dl_reg (T_CIPH_cipher_req_parms *cipher_req_parms,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 T_CIPH_in_data_list *in_data_list);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 /==== PRIVATE FUNCTIONS ====================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 #ifdef LLC_TRACE_GEA_PARAM
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 LOCAL void cci_trace_gea_param( void );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 /==== PUBLIC FUNCTIONS =====================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 \| Function : ciph_cipher_req_sim
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 \| Description : Handles the primitive ciph_cipher_req. It is used to request
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 \| ciphering or deciphering of a LLC PDU.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 \| Parameters :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 GLOBAL void ciph_cipher_req_sim (T_CIPH_cipher_req_parms *cipher_req_parms_ptr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 T_CIPH_in_data_list *in_data_ptr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 T_CIPH_out_data *out_data_ptr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 U8 *status) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 USHORT volatile *cntl = cci_data->fbs.cntl_reg;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 int i = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 ULONG cnt = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 TRACE_FUNCTION( "ciph_cipher_req" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 /* reset GEA (enables and then disables clock) */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 ciph_reset_hw();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 *cntl \|= CL_ENABLE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 /* fill UL or DL configuration and data registers */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 if (cci_data->fbs.ciph_params.direction == CIPH_UPLINK_DIR) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 ciph_fill_ul_reg (cipher_req_parms_ptr, in_data_ptr );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 #ifdef LL_2to1
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 cntl = (cntl & UL_DL_UP) \| START;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 #else /* LL_2to1 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 #if (CHIPSET == 12) \|\| (CHIPSET == 14)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 /* GEA work-around */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 cntl = (cntl & UL_DL_UP);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 gea_start();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 #else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 cntl = (cntl & UL_DL_UP) \| START;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 #endif /* LL_2to1 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 ciph_fill_dl_reg (cipher_req_parms_ptr, in_data_ptr );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 #ifdef LL_2to1
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 *cntl \|= (UL_DL_DOWN \| START);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 #else /* LL_2to1 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 #if (CHIPSET == 12) \|\| (CHIPSET == 14)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 /* GEA work-around */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 *cntl \|= (UL_DL_DOWN);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 gea_start();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 #else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 *cntl \|= (UL_DL_DOWN \| START);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 #endif /* LL_2to1 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 out_data_ptr->len = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 for (i = 0; i < in_data_ptr->c_in_data; i++) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 out_data_ptr->len += in_data_ptr->ptr_in_data[i].len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 if (cci_data->fbs.ciph_params.direction == CIPH_DOWNLINK_DIR) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 out_data_ptr->len -= FCS_SIZE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 out_data_ptr->len += FCS_SIZE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 if (cci_data->fbs.ciph_params.direction == CIPH_UPLINK_DIR) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 ciph_hw_sim_cipher(out_data_ptr->len);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 ciph_hw_sim_decipher();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 /* poll until data is processed */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 if(cci_data->fbs.cci_info_trace){
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 while (*(cci_data->fbs.status_reg) & CHECK_WORKING){
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 cnt += 1;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 };
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 TRACE_EVENT_P1("INFO CCI: ciphering completed, counter: %d", cnt);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 while (*(cci_data->fbs.status_reg) & CHECK_WORKING){ };
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 /* verify ciphering key, whether it has been corrupted */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 if(cci_data->fbs.cci_info_trace){
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 if(*cci_data->fbs.kc_reg1 != tmp_key[0] \|\|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 *cci_data->fbs.kc_reg2 != tmp_key[1] \|\|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 *cci_data->fbs.kc_reg3 != tmp_key[2] \|\|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 *cci_data->fbs.kc_reg4 != tmp_key[3])
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 TRACE_ERROR("CCI ERROR: Ciphering key has been corrupted!!");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 TRACE_EVENT_P4("CCI: original key: %04x %04x %04x %04x %04x %04x",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 tmp_key[0], tmp_key[1], tmp_key[2], tmp_key[3]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 TRACE_EVENT_P4("CCI: kc key: %04x %04x %04x %04x %04x %04x",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 cci_data->fbs.kc_reg1, cci_data->fbs.kc_reg2,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 cci_data->fbs.kc_reg3, cci_data->fbs.kc_reg4);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 /* and finally handle the result */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 ciph_get_result(out_data_ptr, status);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 /* disable clock until new frames are to process */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 *cntl &= CL_DISABLE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 \| Function : ciph_init_cipher_req_sim
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 \| Description : Handles the primitive ciph_init_cipher_req_sim.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 \| Parameters :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 GLOBAL void ciph_init_cipher_req_sim (T_CIPH_init_cipher_req_parms *init_cipher_req_parms_ptr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 void (*read_data) (void))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 if (!cci_data->fbs.initialized){
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 ciph_init();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 cci_data->fbs.initialized = TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 cci_data->fbs.ciph_params = *init_cipher_req_parms_ptr;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 \| Function : ciph_get_result
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 \| Description : Handles the function ciph_get_result. This function gets the
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 \| ciphered data in uplink direction or deciphered data in
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 \| downlink direction
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 \| Parameters :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 LOCAL void ciph_get_result (T_CIPH_out_data out_data, U8 status)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 TRACE_FUNCTION( "ciph_get_result" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 switch(cci_data->fbs.ciph_params.direction)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 case CIPH_UPLINK_DIR:
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 if( *(cci_data->fbs.status_reg) & CHECK_WORKING )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 break;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 ciph_get_ciphered_data (out_data);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 break;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 case CIPH_DOWNLINK_DIR:
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 if( *(cci_data->fbs.status_reg) & CHECK_WORKING )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 break;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 ciph_get_deciphered_data (out_data, status);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 break;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 default:
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 TRACE_ERROR( "TIMER unexpected" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 break;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 } /* ciph_get_result() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 \| Function : ciph_init
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 \| Description : The function ciph_init() initializes the registers.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 \| Parameters :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 LOCAL void ciph_init ( void )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 USHORT *reg;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 TRACE_FUNCTION( "ciph_init" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 TRACE_EVENT ("GEA simulation is used");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 * initialization of registers - do it only once to handle restart of CCI
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 * 'hw_req' points to a set of 16 bit registers
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 * 'fbs.simulated_reg_buffer' points to a 1596 bytes buffer for data
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 if (hw_reg == NULL)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 MALLOC(hw_reg, sizeof(USHORT) * 26+1 );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 memset(hw_reg, 0, sizeof(USHORT) * 26+1);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 if (cci_data->fbs.simulated_reg_buffer == NULL)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 MALLOC(cci_data->fbs.simulated_reg_buffer, 1596);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 memset(cci_data->fbs.simulated_reg_buffer, 0, 1596);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 reg = &hw_reg[0];
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 #else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 TRACE_EVENT ("GEA hardware is used");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 reg = (USHORT *)START_ADRESS;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample*/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 /* 01 / cci_data->fbs.cntl_reg = reg++; / 00 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 /* 02 / cci_data->fbs.status_reg = reg++; / 02 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 /* 03 / cci_data->fbs.status_irq_reg= reg++; / 04 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 /* 04 / cci_data->fbs.conf_ul_reg1 = reg++; / 06 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 /* 05 / cci_data->fbs.conf_ul_reg2 = reg++; / 08 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 /* 06 / cci_data->fbs.conf_ul_reg3 = reg++; / 0A */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 /* 07 / cci_data->fbs.conf_ul_reg4 = reg++; / 0C */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 /* 08 / cci_data->fbs.conf_ul_reg5 = reg++; / 0E */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 /* 09 / cci_data->fbs.conf_dl_reg1 = reg++; / 10 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 /* 10 / cci_data->fbs.conf_dl_reg2 = reg++; / 12 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 /* 11 / cci_data->fbs.conf_dl_reg3 = reg++; / 14 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 /* 12 / cci_data->fbs.conf_dl_reg4 = reg++; / 16 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 /* 13 / cci_data->fbs.conf_dl_reg5 = reg++; / 18 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 /* 14 / cci_data->fbs.kc_reg1 = reg++; / 1A */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 /* 15 / cci_data->fbs.kc_reg2 = reg++; / 1C */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 /* 16 / cci_data->fbs.kc_reg3 = reg++; / 1E */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 /* 17 / cci_data->fbs.kc_reg4 = reg++; / 20 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 /* 22 / reg++; / 22 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 /* 22 / reg++; / 24 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 /* 22 / reg++; / 26 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 /* 22 / reg++; / 28 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 /* 18 / cci_data->fbs.fcs_ul_reg1 = reg++; / 2A */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 /* 19 / cci_data->fbs.fcs_ul_reg2 = reg++; / 2C */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 /* 20 / cci_data->fbs.fcs_dl_reg1 = reg++; / 2E */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 /* 21 / cci_data->fbs.fcs_dl_reg2 = reg++; / 30 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 /* 22 / cci_data->fbs.switch_reg = reg++; / 32 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 /* 25 / cci_data->fbs.data16_reg = reg++; / 34 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 /* 26 / cci_data->fbs.data8_reg = (UBYTE)reg; /* 36 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 *cci_data->fbs.switch_reg = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 #else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 /* 01 / cci_data->fbs.cntl_reg = reg++; / 00 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 /* 02 / cci_data->fbs.status_reg = reg++; / 02 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 /* 03 / cci_data->fbs.status_irq_reg= reg++; / 04 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 /* 04 / cci_data->fbs.conf_ul_reg1 = reg++; / 06 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 /* 05 / cci_data->fbs.conf_ul_reg2 = reg++; / 08 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 /* 06 / cci_data->fbs.conf_ul_reg3 = reg++; / 0A */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 /* 07 / cci_data->fbs.conf_ul_reg4 = reg++; / 0C */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 /* 08 / cci_data->fbs.conf_ul_reg5 = reg++; / 0E */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 /* 09 / cci_data->fbs.conf_dl_reg1 = reg++; / 10 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 /* 10 / cci_data->fbs.conf_dl_reg2 = reg++; / 12 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 /* 11 / cci_data->fbs.conf_dl_reg3 = reg++; / 14 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 /* 12 / cci_data->fbs.conf_dl_reg4 = reg++; / 16 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 /* 13 / cci_data->fbs.conf_dl_reg5 = reg++; / 18 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 /* 14 / cci_data->fbs.kc_reg1 = reg++; / 1A */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 /* 15 / cci_data->fbs.kc_reg2 = reg++; / 1C */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 /* 16 / cci_data->fbs.kc_reg3 = reg++; / 1E */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 /* 17 / cci_data->fbs.kc_reg4 = reg++; / 20 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 /* 18 / cci_data->fbs.fcs_ul_reg1 = reg++; / 22 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 /* 19 / cci_data->fbs.fcs_ul_reg2 = reg++; / 24 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 /* 20 / cci_data->fbs.fcs_dl_reg1 = reg++; / 26 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 /* 21 / cci_data->fbs.fcs_dl_reg2 = reg++; / 28 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 /* 22 / reg++; / 2A */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 /* 23 / reg++; / 2C */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 /* 24 / reg++; / 2E */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 /* 25 / cci_data->fbs.data16_reg = reg++; / 30 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 /* 26 / cci_data->fbs.data8_reg = (UBYTE)reg; /* 32 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 #endif /* Board 61 or 71*/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 cci_data->fbs.simulated_reg = cci_data->fbs.simulated_reg_buffer;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 #ifndef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 TRACE_EVENT ("Received FCS will be verified");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 /* finaly reset the HW */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 ciph_reset_hw();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 /* initialize flag for CCI info trace */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 cci_data->fbs.cci_info_trace = FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 /* initialize freed partition counter */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 cci_data->fbs.cci_freed_partition = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 } /* ciph_init() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 \| Function : ciph_reset_hw
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 \| Description : Resets the hardware
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 LOCAL void ciph_reset_hw ( void )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 USHORT volatile *cntl = cci_data->fbs.cntl_reg;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 TRACE_FUNCTION( "ciph_reset_hw" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 /* making the clock enable */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 *cntl \|= CL_ENABLE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 /* start reset in both directions and disable interrupt */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 *cntl &= ~(RESET_UL \| RESET_DL \| IT_ENABLE);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 *cci_data->fbs.status_reg &= NOT_WORKING;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 /* simulate reset complete */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 *cntl \|= RESET_UL;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 *cntl \|= RESET_DL;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 /* wait until reset is ready (both bits back high) */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 while ((*cntl & (RESET_UL\|RESET_DL)) != (RESET_UL\|RESET_DL))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 ;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 /* disable clock until new frames are to process */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 *cntl &= CL_DISABLE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 } /* ciph_reset_hw() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 \| Function : ciph_fcs_check
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 \| Description : The function compares the 3 bytes FCS for downlink direction
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 \| Parameters : *fcs_start - pointer to beginning of fcs field
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 \| Returns : CCI_FCS_PASSED - if equal
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 \| CCI_FCS_FAILED - if NOT equal
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 LOCAL UBYTE ciph_fcs_check (UBYTE* fcs_start)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 TRACE_FUNCTION( "ciph_fcs_check" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 #ifdef _CHECK_RECEIVED_FCS_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 * Compare FCS, taking byte ordering of FCS registers into account (Intel
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 * format: high-/lowbyte swaped)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 if (* fcs_start == (UBYTE) (*cci_data->fbs.fcs_dl_reg1 & 0x00FF) &&
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 (fcs_start+1) == (UBYTE)((cci_data->fbs.fcs_dl_reg1 & 0xFF00) >> 8) &&
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 (fcs_start+2) == (UBYTE) (cci_data->fbs.fcs_dl_reg2 & 0x00FF) )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 /* clear bit to indicate FCS is ok */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 *cci_data->fbs.status_reg &= ~(FCS_FALSE_BIT);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 /* set bit to indicate FCS is false */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 *cci_data->fbs.status_reg \|= FCS_FALSE_BIT;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 * Check, if FCS false bit is set
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 if (*cci_data->fbs.status_reg & FCS_FALSE_BIT)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 TRACE_EVENT("Info: Received FCS is wrong");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 return CIPH_FCS_ERROR;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 #endif /* _GEA_SIMULATION_ */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 #endif /* _CHECK_RECEIVED_FCS_ */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 #ifndef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 * Check, if FCS false bit is set
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 if (*cci_data->fbs.status_reg & FCS_FALSE_BIT)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 TRACE_0_INFO("Received FCS is wrong");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 return CIPH_FCS_ERROR;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 #endif /* _GEA_SIMULATION_ */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 return CIPH_CIPH_PASS;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 } /* ciph_fcs_check() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 \| Function : ciph_get_ciphered_data
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 \| Description : The function ciph_get_ciphered_data() copies the result of the ciphered
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 \| data to destination buffer.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 \| Parameters :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 LOCAL void ciph_get_ciphered_data (T_CIPH_out_data *out_data)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 int frame16,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 frame8,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 i;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 USHORT *sdu_data16;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 UBYTE *sdu_data8;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 TRACE_FUNCTION( "ciph_get_ciphered_data" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 i = out_data->len - FCS_SIZE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 frame16 = i / 2;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 frame8 = i % 2;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545 cci_data->fbs.simulated_reg = cci_data->fbs.simulated_reg_buffer;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 #endif /* _GEA_SIMULATION_ */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 sdu_data16 = (USHORT*)out_data->buf;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 *cci_data->fbs.switch_reg = 1;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 #ifdef LLC_TRACE_GEA_PARAM
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 cci_trace_gea_param();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 for (i=0; i<frame16; i++)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 ciph_reg16_read_sim();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 sdu_data16 = cci_data->fbs.data16_reg;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 sdu_data16++;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571 sdu_data8 = (UBYTE*)sdu_data16;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 if (frame8 != 0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 ciph_reg8_read_sim();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 sdu_data8 = cci_data->fbs.data8_reg;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 sdu_data8++;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 *cci_data->fbs.switch_reg = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 * Copy FCS to destination sdu, taking byte ordering of FCS registers
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 * into account, e.g.:
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 * reg1 reg2 sdu
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 * 29 FC xx 36 -> FC 29 36
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 sdu_data8 = (UBYTE) (cci_data->fbs.fcs_ul_reg1 & 0x00FF);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596 sdu_data8++;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 sdu_data8 = (UBYTE)((cci_data->fbs.fcs_ul_reg1 & 0xFF00) >> 8);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 sdu_data8++;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 sdu_data8 = (UBYTE) (cci_data->fbs.fcs_ul_reg2 & 0x00FF);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 } /* ciph_get_ciphered_data() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 \| Function : ciph_get_deciphered_data
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 \| Description : The function ciph_get_deciphered_data() ....
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 \| Parameters : T_CCI_DECIPHER_CNF *decipher_cnf
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 LOCAL void ciph_get_deciphered_data (T_CIPH_out_data out_data, U8 status)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 int i,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 frame8,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 frame16;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618 USHORT *sdu_data16;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 UBYTE *sdu_data8;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 TRACE_FUNCTION( "ciph_get_deciphered_data" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 i = out_data->len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 frame16 = i / 2;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 frame8 = i % 2;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 cci_data->fbs.simulated_reg = cci_data->fbs.simulated_reg_buffer;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 sdu_data16 = (USHORT*)out_data->buf;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636 *cci_data->fbs.switch_reg = 1;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 for (i=0; i<frame16; i++)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 ciph_reg16_read_sim();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 sdu_data16 = cci_data->fbs.data16_reg;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 sdu_data16++;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 sdu_data8 = (UBYTE*)sdu_data16;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 if (frame8 != 0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657 ciph_reg8_read_sim();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660 sdu_data8 = cci_data->fbs.data8_reg;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662 sdu_data8++;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666 *cci_data->fbs.switch_reg = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670 * Get result from FCS calculation
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 *status = ciph_fcs_check(sdu_data8);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 } /* ciph_get_deciphered_data() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 \| Function : ciph_fill_ul_reg
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 \| Description : The function ciph_fill_ul_reg() fills the uplink registers.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684 \| Parameters :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 LOCAL void ciph_fill_ul_reg ( T_CIPH_cipher_req_parms *cipher_req_parms,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 T_CIPH_in_data_list *in_data_list )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 int i, j;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 int frame8;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692 UBYTE *desc_data8;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 U16 len = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 TRACE_FUNCTION( "ciph_fill_ul_reg" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 * setting the protected mode variable
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700 if (cipher_req_parms->gprs_parameters.pm EQ CIPH_PM_PROTECTED)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 *cci_data->fbs.conf_ul_reg1 \|= PROTECTED;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 *cci_data->fbs.conf_ul_reg1 &= NON_PROTECTED;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 * FCS is always calculated
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 *cci_data->fbs.conf_ul_reg1 \|= FCS_COMPUTED;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715 * direction is uplink
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717 /* Direction muss noch in init function gesetzt werden */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718 *cci_data->fbs.conf_ul_reg1 &= D_UL;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720 if (cci_data->fbs.ciph_params.algo NEQ CIPH_EA0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 *cci_data->fbs.conf_ul_reg1 \|= ENCRYPT;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 if(cci_data->fbs.ciph_params.algo EQ CIPH_EA1)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 *cci_data->fbs.conf_ul_reg1 &= GEA_FIRST;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729 if(cci_data->fbs.ciph_params.algo EQ CIPH_EA2)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 *cci_data->fbs.conf_ul_reg1 \|= GEA_SECOND;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735 TRACE_ERROR ("Illegal ciphering_algorithm");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 * if the condition is CCI_CIPHER_NO_ALGORITHM we don't use subsequent statements
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 *cci_data->fbs.kc_reg1 = (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[1]) << 8)+
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[0]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 *cci_data->fbs.kc_reg2 = (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[3]) << 8)+
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[2]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 *cci_data->fbs.kc_reg3 = (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[5]) << 8)+
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[4]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747 *cci_data->fbs.kc_reg4 = (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[7]) << 8)+
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[6]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 /* store ciphering key in the local buffer for later verification */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751 if(cci_data->fbs.cci_info_trace){
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752 tmp_key[0] = *cci_data->fbs.kc_reg1;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753 tmp_key[1] = *cci_data->fbs.kc_reg2;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754 tmp_key[2] = *cci_data->fbs.kc_reg3;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755 tmp_key[3] = *cci_data->fbs.kc_reg4;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 * FRAME DEPENDENT CIPHERING INPUT entity is ULONG in the primitive
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 *cci_data->fbs.conf_ul_reg4 = (USHORT)(cipher_req_parms->gprs_parameters.ciphering_input);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 *cci_data->fbs.conf_ul_reg5 = (USHORT)(cipher_req_parms->gprs_parameters.ciphering_input >> 16);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765 * it is assumed that MSB is first 16 bit and LSB part is last 16 bits
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 * in this case we don't fill the registers that contain ciphering keys
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773 *cci_data->fbs.conf_ul_reg1 &= NO_ENCRYPT;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 * Enter LLC-PDU size in bytes
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 for (i = 0; i < in_data_list->c_in_data; i++) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 len += in_data_list->ptr_in_data[i].len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782 *cci_data->fbs.conf_ul_reg2 = (USHORT)len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 * conf_ul_reg3 is seperated into 2 parts of UBYTE:
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 * -> lowbyte = N202
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 * -> hightbyte = LLC-PDU header size in bytes (indicate the offset of information)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 *cci_data->fbs.conf_ul_reg3 = (USHORT)((cipher_req_parms->gprs_parameters.header_size << 8) \| CIPH_N202);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791 cci_data->fbs.simulated_reg = cci_data->fbs.simulated_reg_buffer;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 *cci_data->fbs.conf_ul_reg1 &= NO_INPUT_SHIFT;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797 *cci_data->fbs.switch_reg = 1;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799 #ifdef LLC_TRACE_GEA_PARAM
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 cci_trace_gea_param();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805 for (i = 0; i < in_data_list->c_in_data; i++) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806 desc_data8 = (U8*)in_data_list->ptr_in_data[i].buf;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807 frame8 = in_data_list->ptr_in_data[i].len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 for (j=0; j < frame8; j++)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	810 cci_data->fbs.data8_reg = desc_data8;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 ciph_reg8_write_sim();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 desc_data8++;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820 *cci_data->fbs.switch_reg = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	821 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	822 } /* ciph_fill_ul_reg() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828 \| Function : ciph_fill_dl_reg
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 \| Description : The function ciph_fill_dl_reg()
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 \| Parameters :
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	834 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 LOCAL void ciph_fill_dl_reg (T_CIPH_cipher_req_parms *cipher_req_parms,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 T_CIPH_in_data_list *in_data_list )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 ULONG i, j;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 ULONG frame8;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 UBYTE *desc_data8;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842 ULONG len = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	844 TRACE_FUNCTION( "ciph_fill_dl_reg" );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	845
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	846 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	847 * setting the protected mode variable
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	848 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	849 if(cipher_req_parms->gprs_parameters.pm EQ CIPH_PM_PROTECTED)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	850 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	851 *cci_data->fbs.conf_dl_reg1 \|= PROTECTED;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	852 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	853 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	854 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	855 *cci_data->fbs.conf_dl_reg1 &= NON_PROTECTED;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	857
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	858 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	859 * FCS is always calculated
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	860 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	861 *cci_data->fbs.conf_dl_reg1 \|= FCS_COMPUTED;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	862
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	863 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	864 * data always copied aligned independent
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	865 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	866 *cci_data->fbs.conf_dl_reg1 &= NO_INPUT_SHIFT;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	867
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	868 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	869 * direction is downlink
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	870 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	871 *cci_data->fbs.conf_dl_reg1 \|= D_DL;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	872
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	873 if(cci_data->fbs.ciph_params.algo NEQ CIPH_EA0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	874 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	875 *cci_data->fbs.conf_dl_reg1 \|= ENCRYPT;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	876
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	877 if(cci_data->fbs.ciph_params.algo EQ CIPH_EA1)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	878 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	879 *cci_data->fbs.conf_dl_reg1 &= GEA_FIRST;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	880 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	881 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	882 if(cci_data->fbs.ciph_params.algo EQ CIPH_EA2)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	883 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	884 *cci_data->fbs.conf_dl_reg1 \|= GEA_SECOND;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	885 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	886 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	887 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	888 TRACE_ERROR ("Illegal ciphering_algorithm");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	889 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	890
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	891 *cci_data->fbs.kc_reg1 =
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	892 (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[1]) << 8) +
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	893 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[0]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	894
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	895 *cci_data->fbs.kc_reg2 =
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	896 (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[3]) << 8) +
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	897 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[2]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	898
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	899 *cci_data->fbs.kc_reg3 =
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	900 (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[5]) << 8) +
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	901 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[4]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	902
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	903 *cci_data->fbs.kc_reg4 =
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	904 (USHORT)((USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[7]) << 8) +
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	905 (USHORT)(cci_data->fbs.ciph_params.ptr_ck->ck_element[6]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	906
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	907 /* store ciphering key in local buffer for later verification */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	908 if(cci_data->fbs.cci_info_trace){
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	909 tmp_key[0] = *cci_data->fbs.kc_reg1;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	910 tmp_key[1] = *cci_data->fbs.kc_reg2;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	911 tmp_key[2] = *cci_data->fbs.kc_reg3;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	912 tmp_key[3] = *cci_data->fbs.kc_reg4;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	913 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	914
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	915 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	916 * FRAME DEPENDENT CIPHERING INPUT entity is ULONG in the primitive
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	917 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	918 *cci_data->fbs.conf_dl_reg4 = (USHORT)(cipher_req_parms->gprs_parameters.ciphering_input);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	919 *cci_data->fbs.conf_dl_reg5 = (USHORT)(cipher_req_parms->gprs_parameters.ciphering_input >> 16);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	920 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	921 else
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	922 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	923 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	924 * in this case we don't fill the registers that contain ciphering keys
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	925 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	926 *cci_data->fbs.conf_dl_reg1 &= NO_ENCRYPT;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	927 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	928
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	929 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	930 * Write length of LLC-PDU in bytes including FCS
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	931 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	932 for (i = 0; i < in_data_list->c_in_data; i++) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	933 len += in_data_list->ptr_in_data[i].len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	934 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	935
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	936 *cci_data->fbs.conf_dl_reg2 = (USHORT)len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	937
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	938 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	939 * conf_dl_reg3 is seperated into 2 parts of UBYTE:
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	940 * -> lowbyte = N202
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	941 * -> hightbyte = LLC-PDU header size in bytes (indicate the offset of information)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	942 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	943 *cci_data->fbs.conf_dl_reg3 = (USHORT)((cipher_req_parms->gprs_parameters.header_size << 8) \| CIPH_N202);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	944
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	945
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	946 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	947 cci_data->fbs.simulated_reg = cci_data->fbs.simulated_reg_buffer;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	948 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	949
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	950 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	951 *cci_data->fbs.switch_reg = 1;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	952 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	953
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	954 for (i = 0; i < in_data_list->c_in_data; i++) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	955 desc_data8 = (UBYTE*)in_data_list->ptr_in_data[i].buf;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	956 frame8 = in_data_list->ptr_in_data[i].len;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	957
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	958 for (j=0; j < frame8; j++){
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	959 *cci_data->fbs.data8_reg = desc_data8[j];
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	960 #ifdef _GEA_SIMULATION_
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	961 ciph_reg8_write_sim();
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	962 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	963 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	964 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	965
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	966 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	967 *cci_data->fbs.switch_reg = 0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	968 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	969
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	970 } /* ciph_fill_dl_reg() */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	971
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	972 #if (BOARD == 61 OR BOARD == 71) /* G-Sample or I-Sample */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	973
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	974 #ifdef LLC_TRACE_GEA_PARAM
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	975 LOCAL void cci_trace_gea_param( void )
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	976 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	977 TRACE_EVENT_P9( "cci_trace_gea_param_1 %04X %04X %04X %04X %04X %04X %04X %04X %04X",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	978 *cci_data->fbs.cntl_reg ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	979 *cci_data->fbs.status_reg ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	980 *cci_data->fbs.status_irq_reg,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	981 *cci_data->fbs.conf_ul_reg1 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	982 *cci_data->fbs.conf_ul_reg2 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	983 *cci_data->fbs.conf_ul_reg3 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	984 *cci_data->fbs.conf_ul_reg4 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	985 *cci_data->fbs.conf_ul_reg5 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	986 *cci_data->fbs.conf_dl_reg1 );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	987
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	988 TRACE_EVENT_P9( "cci_trace_gea_param_2 %04X %04X %04X %04X %04X %04X %04X %04X %04X",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	989 *cci_data->fbs.conf_dl_reg2 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	990 *cci_data->fbs.conf_dl_reg3 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	991 *cci_data->fbs.conf_dl_reg4 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	992 *cci_data->fbs.conf_dl_reg5 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	993 *cci_data->fbs.fcs_ul_reg1 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	994 *cci_data->fbs.fcs_ul_reg2 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	995 *cci_data->fbs.fcs_dl_reg1 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	996 *cci_data->fbs.fcs_dl_reg2 ,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	997 *cci_data->fbs.switch_reg );
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	998 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	999 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1000 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1001 #endif /* TI_PS_OP_CIPH_DRIVER */

FreeCalypso > hg > fc-magnetite

annotate src/g23m-gprs/cci/cci_fbsf.c @ 662:8cd8fd15a095