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

annotate src/g23m-gprs/cci/cci_fbsf.c @ 123:9582a626345c

rm doc/C155-target "won't support it" note

author	Mychaela Falconia <falcon@freecalypso.org>
date	Wed, 07 Nov 2018 09:16:23 +0000
parents	d393cd9bb723
children

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

FreeCalypso > hg > fc-selenite

annotate src/g23m-gprs/cci/cci_fbsf.c @ 123:9582a626345c