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

annotate src/g23m-gprs/cci/cci_fbsf.c @ 648:337e6d3a4454

abb.c: disable superdeep sleep on Luna

author	Mychaela Falconia <falcon@freecalypso.org>
date	Thu, 07 May 2020 06:28:56 +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 @ 648:337e6d3a4454