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

annotate src/g23m-gprs/llc/llc_txf.c @ 76:a2052ac75672

l1_small_asm.S: import from Citrine

author	Mychaela Falconia <falcon@freecalypso.org>
date	Fri, 20 Jul 2018 05:56:58 +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 :
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 modul is part of the entity LLC and implements all
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	18 \| procedures and functions as described in the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	19 \| SDL-documentation (TX-statemachine)
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 #ifndef LLC_TXF_C
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	24 #define LLC_TXF_C
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	25 #endif
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 #define ENTITY_LLC
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	28
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	29 /==== INCLUDES =============================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	30
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	31 #include <string.h> /* to get memcpy() */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	32
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	33 #include "typedefs.h" /* to get Condat data types */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	34 #include "vsi.h" /* to get a lot of macros */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	35 #include "macdef.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	36 #include "gprs.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	37 #include "gsm.h" /* to get a lot of macros */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	38 #include "cnf_llc.h" /* to get cnf-definitions */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	39 #include "mon_llc.h" /* to get mon-definitions */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	40 #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	41 #include "llc.h" /* to get the global entity definitions */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	42
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	43 #include "llc_f.h" /* to get global functions, e.g. llc_generate_input */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	44 #include "llc_txf.h" /* to get the global entity definitions */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	45 #include "llc_txp.h" /* to get the function tx_cci_cipher_cnf */
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 #include "llc_uitxs.h" /* to get signal interface to UITX */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	48 #include "llc_itxs.h" /* to get signal interface to ITX */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	49
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	50 #ifndef TI_PS_OP_CIPH_DRIVER
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	51 #include "cci_fbsf.h" /* to get functional interface */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	52 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	53
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	54
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	55 /==== CONST ================================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	56
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	57 /==== LOCAL VARS ===========================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	58
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	59 /==== PRIVATE FUNCTIONS ====================================================/
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 /==== PUBLIC FUNCTIONS =====================================================/
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
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 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	66 \| Function : tx_init
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	67 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	68 \| Description : This procedure initialises all necessary variables of send_pdu.
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 \| Parameters :
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 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	73 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	74 GLOBAL void llc_tx_init (void)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	75 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	76 TRACE_FUNCTION( "tx_init" );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	77
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	78 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	79 * Initialise TX with state NOT_READY.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	80 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	81 INIT_STATE (TX, TX_TLLI_UNASSIGNED_NOT_READY);
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	84 * Flush TX queue, if there is (in case of an LLC
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	85 * restart) old stuff queued.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	86 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	87 tx_clear_buffer();
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 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	90 } /* tx_init() */
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 /*
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 \| Function : tx_clear_buffer
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	96 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	97 \| Description : This procedure frees all buffered CCI_CIPHER_CNF primitives.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	98 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	99 \| Parameters :
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 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	103 GLOBAL void tx_clear_buffer (void)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	104 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	105 T_TX_QUEUE *elem;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	106 T_TX_QUEUE *elem_next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	107
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	108
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	109 TRACE_FUNCTION( "tx_clear_buffer" );
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 for (elem = llc_data->tx.queue; elem NEQ NULL; elem = elem_next)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	112 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	113 elem_next = elem->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	114
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	115 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	116 * Free primitive if any is stored in queue element.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	117 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	118 if (elem->primitive NEQ (ULONG)NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	119 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	120 PFREE (elem->primitive);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	121 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	122
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	123 MFREE (elem);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	124 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	125
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	126 llc_data->tx.queue = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	127
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	128 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	129 * Initialise UITX space counter for each SAPI.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	130 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	131 llc_data->tx.queue_counter_uitx[0] = UITX_1_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	132 llc_data->tx.queue_counter_uitx[1] = UITX_3_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	133 llc_data->tx.queue_counter_uitx[2] = UITX_5_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	134 llc_data->tx.queue_counter_uitx[3] = UITX_7_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	135 llc_data->tx.queue_counter_uitx[4] = UITX_9_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	136 llc_data->tx.queue_counter_uitx[5] = UITX_11_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	137
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	138 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	139 * Initialise ITX space counter for each SAPI.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	140 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	141 llc_data->tx.queue_counter_itx[0] = ITX_3_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	142 llc_data->tx.queue_counter_itx[1] = ITX_5_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	143 llc_data->tx.queue_counter_itx[2] = ITX_9_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	144 llc_data->tx.queue_counter_itx[3] = ITX_11_QUEUE_SIZE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	145
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	146 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	147 } /* tx_clear_buffer() */
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	150 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	151 \| Function : tx_cipher_req
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 \| Description : Handles the function tx_cipher_req. This functions sets the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	154 \| ciphering parameters and calls the ciphering driver function.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	155 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	156 \| Parameters : todo
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	157 \|
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 GLOBAL void tx_cipher_req
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	161 (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	162 #ifdef LL_DESC
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	163 T_CCI_CIPHER_DESC_REQ *cipher_req
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 T_CCI_CIPHER_REQ *cipher_req
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	166 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	167 )
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 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	170 T_CIPH_init_cipher_req_parms init_cipher_req_parms;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	171 T_CIPH_cipher_req_parms cipher_req_parms;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	172 T_CIPH_in_data_list in_data_list;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	173 T_CIPH_out_data out_data;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	174 T_CIPH_ck ck;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	175 U16 i;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	176 U8 status;
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 TRACE_FUNCTION( "tx_cipher_req" );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	179
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	180 #ifdef LLC_TRACE_CIPHERING
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	181 TRACE_EVENT("UPLINK NON CIPHERED DATA");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	182 llc_trace_desc_list3_content(cipher_req->desc_list3);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	183 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	184 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	185 * Copy pointer to desc's from CIPHER_REQ to the in_data_list
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	186 * The in_data array in allocated dynamically in this func.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	187 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	188 llc_copy_ul_data_to_list(cipher_req, &in_data_list);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	189 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	190 * Store ciphering parameters
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	191 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	192 cipher_req_parms.gprs_parameters.pm = cipher_req->pm;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	193 cipher_req_parms.gprs_parameters.header_size = cipher_req->header_size;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	194 cipher_req_parms.gprs_parameters.ciphering_input = cipher_req->ciphering_input;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	195 cipher_req_parms.gprs_parameters.threshold = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	196 init_cipher_req_parms.direction = CIPH_UPLINK_DIR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	197 init_cipher_req_parms.algo = cipher_req->ciphering_algorithm;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	198 init_cipher_req_parms.ptr_ck = & ck;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	199 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	200 * Copy ciphering key
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 for (i=0; i<8;i++){
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	203 init_cipher_req_parms.ptr_ck->ck_element[i] = cipher_req->kc.key[i];
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 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	207 /* Use GRLC_DATA_REQ instead of CCI_CIPHER_CNF to avoid PPASS in LLC*/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	208 PALLOC_SDU (grlc_data_req, GRLC_DATA_REQ,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	209 (USHORT)(cipher_req->desc_list3.list_len*8 + FCS_SIZE_BITS));
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	210
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	211 grlc_data_req->sdu.o_buf = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	212 grlc_data_req->sdu.l_buf = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	213 out_data.buf = (U32)(&grlc_data_req->sdu.buf[grlc_data_req->sdu.o_buf]);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	214 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	215 * Initialize ciphering driver and cipher data
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 #ifdef TI_PS_OP_CIPH_DRIVER
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	218 ciph_init_cipher_req (&init_cipher_req_parms, NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	219 ciph_cipher_req (&cipher_req_parms, &in_data_list, &out_data, &status);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	220 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	221 ciph_init_cipher_req_sim (&init_cipher_req_parms, NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	222 ciph_cipher_req_sim (&cipher_req_parms, &in_data_list, &out_data, &status);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	223 #endif
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 * "Send" CIPHER_CNF to LLC
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 grlc_data_req->sdu.l_buf = out_data.len * 8;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	229 grlc_data_req->tlli = cipher_req->reference1;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	230
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	231 #ifdef LLC_TRACE_CIPHERING
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	232 TRACE_EVENT("UPLINK CIPHERED DATA");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	233 llc_trace_sdu(&grlc_data_req->sdu);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	234 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	235 tx_cci_cipher_cnf (grlc_data_req);
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 }
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 * Remove in use mark from the cipher request primitive
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 if (cipher_req != NULL) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	242 {
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 * Free cipher request, if not further used by other entities
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 if (cipher_req->attached_counter == CCI_NO_ATTACHE) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	247 #ifdef LL_DESC
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	248 llc_cl_desc3_free((T_desc3*)cipher_req->desc_list3.first);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	249 #endif /* LL_DESC */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	250 }
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 MFREE (cipher_req);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	253 cipher_req = NULL;
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	256 * Free in_data array from in_data_list
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	257 * allocated dynamically in llc_copy_ul_data_to_list()
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 if(in_data_list.ptr_in_data != NULL){
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	260 MFREE(in_data_list.ptr_in_data);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	261 in_data_list.ptr_in_data = NULL;
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	264 } /* tx_cipher_req() */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	265
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 \| Function : tx_send_cipher_req
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 \| Description : This procedure fills all necessary parameters in the primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	271 \| CCI_CIPHER_REQ and sends the primitive to CCI.
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 \| Parameters : cci_cipher_req - a valid pointer to a CCI_CIPHER_REQ primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	274 \| frame_type - indicates frame type (e.g. UI_FRAME)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	275 \| protected_mode - PM bit setting for CCI_CIPHER_REQ
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	276 \| ns - N(U) for UI frames
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	277 \| cipher - indicates if frame shall be ciphered or not
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	278 \| oc -
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 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	282 GLOBAL void tx_send_cipher_req
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	283 (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	284 #ifdef LL_DESC
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	285 T_CCI_CIPHER_DESC_REQ *cci_cipher_desc_req,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	286 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	287 T_CCI_CIPHER_REQ *cci_cipher_desc_req,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	288 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	289 T_PDU_TYPE frame_type,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	290 UBYTE protected_mode,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	291 T_FRAME_NUM ns,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	292 UBYTE cipher,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	293 ULONG oc
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	294 )
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	295 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	296 TRACE_FUNCTION( "tx_send_cipher_req" );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	297
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	298 cci_cipher_desc_req->pm = protected_mode;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	299
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	300 if ( (cipher EQ LL_CIPHER_ON) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	301 (llc_data->ciphering_algorithm NEQ LLGMM_CIPHER_NO_ALGORITHM) )
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 cci_cipher_desc_req->ciphering_algorithm = llc_data->ciphering_algorithm;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	304 memcpy (&cci_cipher_desc_req->kc, &llc_data->kc, sizeof(T_kc));
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	305
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	306 llc_generate_input (llc_data->current_sapi, frame_type, ns,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	307 &cci_cipher_desc_req->ciphering_input, oc);
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 cci_cipher_desc_req->direction = CCI_DIRECTION_UPLINK;
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 /* LL_CIPHER_OFF */
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 cci_cipher_desc_req->ciphering_algorithm = CCI_CIPHER_NO_ALGORITHM;
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	316 tx_cipher_req (cci_cipher_desc_req);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	317 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	318 } /* tx_send_cipher_desc_req() */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	319
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	322 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	323 \| Function : tx_reserve_buffer
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 \| Description : This procedure allocates an element for the local transmit
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	326 \| queue. If cause is DEFAULT or MOBILITY_MANAGEMENT, the element
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	327 \| is appended at the end of the queue, otherwise it is inserted
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	328 \| at the beginning. Necessary data like primitive header
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	329 \| information and additional important data for the (resulting)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	330 \| GRLC_xDATA_REQ primitive is stored in the reserved buffer
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	331 \| element. The primitive pointer in the element is set to NULL,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	332 \| to indicate that the element is not yet 'ready to send'.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	333 \| Parameter reservation_no will be set to the allocation number
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	334 \| of the element. Parameter buffer_available will be set to TRUE
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	335 \| if additional data primitives can be buffered for the current
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	336 \| sapi, otherwise it will be set to FALSE.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	337 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	338 \| Parameters : ll_unitdata_req - a valid pointer to a LL_UNITDATA_REQ
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	339 \| primitive, containing the data to be sent
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	340 \| prim_type - indicates GRLC_DATA/UNITDATA_REQ
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	341 \| cause - frame cause, only valid for GRLC_DATA_REQ
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	342 \| rx_service - service for flow control (if any)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	343 \| reservation_no - associated number for the buffer entry
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	344 \| buffer_available - still buffer space available for current
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	345 \| SAPI
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 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	348 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	349 GLOBAL void tx_reserve_buffer
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	350 (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	351 #ifdef LL_DESC
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	352 T_LL_UNITDESC_REQ *ll_unitdesc_req,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	353 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	354 T_LL_UNITDATA_REQ *ll_unitdesc_req,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	355 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	356 T_PRIM_TYPE prim_type,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	357 UBYTE cause,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	358 T_SERVICE rx_service,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	359 ULONG *reservation_no,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	360 BOOL *buffer_available
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 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	363 T_TX_QUEUE *elem;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	364 T_TX_QUEUE **insert;
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 static ULONG allocation_number = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	367
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	368 TRACE_FUNCTION ("tx_reserve_buffer");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	369
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	370 MALLOC (elem, sizeof(T_TX_QUEUE));
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	373 * Increase allocation number. Use of reservation_no must correspond
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	374 * to use in tx_store_buffer().
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	375 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	376 *reservation_no = ++(allocation_number);
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	379 * Store all required information in new queue element. Member primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	380 * is set to NULL to indicate that the element is not yet ready to be sent.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	381 * Copy necessary primitive header information to ph_* variables.
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 elem->primitive = (ULONG)NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	384 elem->prim_type = prim_type;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	385 elem->reference = allocation_number;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	386 elem->rx_service = rx_service;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	387 elem->remove_frame = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	388 elem->ph_sapi = ll_unitdesc_req->sapi;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	389 elem->ph_tlli = ll_unitdesc_req->tlli;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	390 elem->ph_grlc_qos_peak = ll_unitdesc_req->ll_qos.peak;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	391 elem->ph_radio_prio = ll_unitdesc_req->radio_prio;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	392 elem->ph_cause = cause;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	393 #ifdef REL99
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	394 elem->ph_pkt_flow_id = (UBYTE)ll_unitdesc_req->pkt_flow_id;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	395 #endif /* REL99 */
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 if ((cause EQ GRLC_DTACS_DEF) OR (cause EQ GRLC_DTACS_MOBILITY_MANAGEMENT))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	398 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	399 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	400 * "Normal" frame cause, append element at the end of queue. Let insert
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	401 * either point to llc_data->tx.queue or to the member .next of an element.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	402 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	403 insert = &llc_data->tx.queue;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	404 while (*insert NEQ NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	405 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	406 insert = &((*insert)->next);
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	409 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	410 * Insert new element at found location and mark element as last in queue.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	411 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	412 *insert = elem;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	413 elem->next = NULL;
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 else /* GRLC_DTACS_PAGE_RESPONSE OR GRLC_DTACS_CELL_UPDATE */
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 * No "normal" frame cause, thus LLGMM_TRIGGER_REQ must have been
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	419 * received. Insert element at the beginning of queue.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	420 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	421 elem->next = llc_data->tx.queue;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	422 llc_data->tx.queue = elem;
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
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 * Check if a service for flow control is specified (currently only
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	427 * SERVICE_UITX and SERVICE_ITX are recognized).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	428 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	429 *buffer_available = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	430
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	431 if (rx_service EQ SERVICE_UITX)
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	434 * Decrement the space counter of UITX primitives in the queue for the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	435 * current SAPI. This means that one place of the queue is occupied.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	436 * Check if there is space for one more primitive in the queue.
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 int n = llc_data->tx.queue_counter_uitx[UIMAP(llc_data->current_sapi)];
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 if (n > 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	441 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	442 llc_data->tx.queue_counter_uitx[UIMAP(llc_data->current_sapi)]--;
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 if (n > 1)
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 *buffer_available = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	447 }
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 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	450 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	451 TRACE_EVENT ("Check uitx-queue flow");
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 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	454 else if (rx_service EQ SERVICE_ITX)
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 * Decrement the space counter of ITX primitives in the queue for the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	458 * current SAPI. This means that one place of the queue is occupied.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	459 * Check if there is space for one more primitive in the queue.
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 int n = llc_data->tx.queue_counter_itx[IMAP(llc_data->current_sapi)];
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 if (n > 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	464 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	465 llc_data->tx.queue_counter_itx[IMAP(llc_data->current_sapi)]--;
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 if (n > 1)
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 *buffer_available = TRUE;
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 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	472 else
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 TRACE_EVENT ("Check itx-queue flow");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	475 }
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 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	478 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	479 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	480 * All other services (e.g. SERVICE_U) are allowed to send primitives
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	481 * per default. I.E. no flow control, except for service UITX and ITX.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	482 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	483 *buffer_available = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	484 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	485 } /* tx_reserve_buffer() */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	486
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	487
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 \| Function : tx_store_buffer
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	491 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	492 \| Description : This procedure stores the given CCI primitive as GRLC primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	493 \| in the already reserved local transmit queue element that is
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	494 \| given with primitive parameter reference. This queue element
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	495 \| is marked as 'ready to send'. The CCI primitive is being
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	496 \| PPASSED as GRLC_DATA_REQ/GRLC_UNITDATA_REQ, according to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	497 \| prim_type in the queue element. All header information for
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	498 \| the GRLC primitive is being filled in from the already stored
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	499 \| data in the element.
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 \| Parameters : cci_cipher_cnf - a valid pointer to a CCI_CIPHER_CNF primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	502 \|
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 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	505 GLOBAL void tx_store_buffer (T_GRLC_DATA_REQ *grlc_data_req)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	506 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	507 T_TX_QUEUE *elem = llc_data->tx.queue;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	508
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	509
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	510 TRACE_FUNCTION ("tx_store_buffer");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	511
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 * Find corresponding queue entry. Use of reference must correspond to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	514 * use in tx_reserve_buffer().
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	515 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	516 while (elem NEQ NULL)
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 if (elem->reference EQ grlc_data_req->tlli)
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 break;
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	523 elem = elem->next;
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	526 if (elem NEQ NULL)
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 if (elem->prim_type EQ PRIM_DATA)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	529 {
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 * Copy information from stored primitive header variables (ph_*) to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	532 * GRLC primitive.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	533 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	534 grlc_data_req->sapi = elem->ph_sapi;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	535 grlc_data_req->tlli = elem->ph_tlli;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	536 #ifdef LL_2to1
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	537 grlc_data_req->grlc_qos.peak = elem->ph_grlc_qos_peak;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	538 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	539 grlc_data_req->grlc_qos.peak = elem->ph_grlc_qos_peak;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	540 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	541 grlc_data_req->radio_prio = elem->ph_radio_prio;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	542 grlc_data_req->cause = elem->ph_cause;
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 REL99
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	545 grlc_data_req->pkt_flow_id[0] = elem->ph_pkt_flow_id;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	546 #endif /* REL99*/
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 #ifdef _SIMULATION_
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 * Initialize all (unused) members of grlc_qos, because otherwise the test
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	551 * cases fail.
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 LL_2to1
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	554 grlc_data_req->grlc_qos.delay = PS_DELAY_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	555 grlc_data_req->grlc_qos.relclass = PS_RELCLASS_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	556 grlc_data_req->grlc_qos.preced = PS_PRECED_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	557 grlc_data_req->grlc_qos.mean = PS_MEAN_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	558 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	559 grlc_data_req->grlc_qos.delay = GRLC_DELAY_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	560 grlc_data_req->grlc_qos.relclass = GRLC_RELCLASS_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	561 grlc_data_req->grlc_qos.preced = GRLC_PRECED_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	562 grlc_data_req->grlc_qos.mean = GRLC_MEAN_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	563 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	564
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	565 #endif /* _SIMULATION_ */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	566
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	567 elem->primitive = (ULONG)grlc_data_req;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	568 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	569 else /* PRIM_UNITDATA */
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	572 * Store CCI primitive as GRLC_UNITDATA_REQ (and mark it as stored).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	573 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	574 PPASS (grlc_data_req, grlc_unitdata_req, GRLC_UNITDATA_REQ);
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	577 * Copy information from stored primitive header variables (ph_*) to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	578 * GRLC primitive (omit ph_cause, because it is not present in
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	579 * GRLC_UNITDATA_REQ).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	580 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	581 grlc_unitdata_req->sapi = elem->ph_sapi;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	582 grlc_unitdata_req->tlli = elem->ph_tlli;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	583 #ifdef LL_2to1
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	584 grlc_unitdata_req->grlc_qos.peak = elem->ph_grlc_qos_peak;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	585 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	586 grlc_unitdata_req->grlc_qos.peak = elem->ph_grlc_qos_peak;
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 grlc_unitdata_req->radio_prio = elem->ph_radio_prio;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	589 #ifdef REL99
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	590 grlc_unitdata_req->pkt_flow_id[0] = elem->ph_pkt_flow_id;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	591 #endif /* REL99*/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	592 #ifdef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	593 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	594 * Initialize all (unused) members of grlc_qos, because otherwise the test
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	595 * cases fail.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	596 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	597 #ifdef LL_2to1
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	598 grlc_unitdata_req->grlc_qos.delay = PS_DELAY_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	599 grlc_unitdata_req->grlc_qos.relclass = PS_RELCLASS_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	600 grlc_unitdata_req->grlc_qos.preced = PS_PRECED_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	601 grlc_unitdata_req->grlc_qos.mean = PS_MEAN_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	602 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	603 grlc_unitdata_req->grlc_qos.delay = GRLC_DELAY_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	604 grlc_unitdata_req->grlc_qos.relclass = GRLC_RELCLASS_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	605 grlc_unitdata_req->grlc_qos.preced = GRLC_PRECED_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	606 grlc_unitdata_req->grlc_qos.mean = GRLC_MEAN_SUB;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	607 #endif /* LL_2to1 */
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
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 #endif /* _SIMULATION_ */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	613
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	614 elem->primitive = (ULONG)grlc_unitdata_req;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	615 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	616 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	617 else /* elem == NULL */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	618 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	619 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	620 * elem not found is possible in case of an LLC re-init, reset,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	621 * unassign, ...
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	622 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	623 TRACE_0_INFO("No TX queue entry for given reference found");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	624 PFREE (grlc_data_req);
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	627 } /* tx_store_buffer() */
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	630 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	631 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	632 \| Function : tx_get_next_frame
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	633 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	634 \| Description : When LLC is not suspended, this procedure gets (and removes)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	635 \| the first primitive out of the local transmit queue and stores
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	636 \| it in one of the parameters, according to the type of the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	637 \| primitive (which is written in prim_type). If no frame is
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	638 \| available in the queue (i.e. first queue element is not marked
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	639 \| as 'ready to send', or the queue is empty), the value NO_PRIM
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	640 \| is written in prim_type. The parameter rx_service indicates the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	641 \| originator service. In case the rx_service is UITX or ITX an
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	642 \| READY signal for flow control will be send after frame
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	643 \| transmission.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	644 \| When LLC is suspended, this procedure returns the first
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	645 \| primitive for SAPI 1 or the first U frame for any SAPI, which
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	646 \| is ready to send.
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 \| Parameters : grlc_data_req - a valid pointer to a pointer to a GRLC-DATA-REQ
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	649 \| primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	650 \| grlc_unitdata_req - a valid pointer to a pointer to a
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	651 \| GRLC-UNITDATA-REQ primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	652 \| prim_type - will be set to PRIM_DATA or PRIM_UNITDATA, must be
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	653 \| a valid pointer
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	654 \| rx_service - indicates the originater service
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	655 \| must be a valid pointer
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	656 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	657 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	658 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	659 GLOBAL void tx_get_next_frame (T_GRLC_DATA_REQ **grlc_data_req,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	660 T_GRLC_UNITDATA_REQ **grlc_unitdata_req,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	661 T_PRIM_TYPE *prim_type,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	662 T_SERVICE *rx_service,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	663 UBYTE *sapi)
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 int frame_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	666 int ctrl_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	667 T_TX_QUEUE *elem;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	668 T_TX_QUEUE **find;
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	671 TRACE_FUNCTION( "tx_get_next_frame" );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	672
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	675 * Initialise find w/ queue start. find points always to the element
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	676 * "before" the examined one, to be able to modifiy the queue, if
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	677 * an element is found.
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 find = &llc_data->tx.queue;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	680
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 * If LLC is suspended search the queue for the first GRLC_DATA_REQ primitive,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	683 * otherwise take the first primitive in queue (if any).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	684 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	685 if (llc_data->suspended EQ TRUE)
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	688 * LLC is in suspended mode. Search the queue for the first primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	689 * for SAPI 1 or the first U frame for any SAPI
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	690 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	691 while ( (*find NEQ NULL) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	692 ((*find)->ph_sapi NEQ LL_SAPI_1) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	693 ((*find)->rx_service NEQ SERVICE_U) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	694 ((*find)->primitive NEQ (ULONG)NULL) )
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	695 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	696 find = &((*find)->next);
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 }
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	701 * Let elem point to queue element (NULL, if no element present/found).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	702 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	703 elem = *find;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	704
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	707 * Check if queue is empty or "first" queue element (depending on suspended
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	708 * mode) is marked as not 'ready to send', i.e. it contains a NULL
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	709 * primitive pointer.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	710 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	711 if ((elem EQ NULL) OR (elem->primitive EQ (ULONG)NULL))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	712 {
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 * Queue is empty or "first" element is not yet 'ready to send'.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	715 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	716 *prim_type = NO_PRIM;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	717 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	718 else /* (elem NEQ NULL) AND (elem->primitive NEQ NULL) */
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	721 * Found a valid (and 'ready to send') element in queue.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	722 */
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	725 * Remove found element from queue (set member next of element before
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	726 * the found element to the element behind the found element and thus
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	727 * skip the found element).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	728 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	729 find = (find)->next;
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	732 * Store data of element in the given parameters.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	733 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	734 *prim_type = elem->prim_type;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	735 *rx_service = elem->rx_service;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	736 *sapi = elem->ph_sapi;
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 if (elem->prim_type EQ PRIM_DATA)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	739 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	740 grlc_data_req = (T_GRLC_DATA_REQ )elem->primitive;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	741
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	742 frame_len = BYTELEN((*grlc_data_req)->sdu.l_buf);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	743 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	744 else /* PRIM_UNITDATA */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	745 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	746 grlc_unitdata_req = (T_GRLC_UNITDATA_REQ )elem->primitive;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	747
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	748 frame_len = BYTELEN((*grlc_unitdata_req)->sdu.l_buf);
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	751 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	752 * If the information fild doesn't fit in current N201_U, remove frame
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	753 * (only applies to service U and UITX).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	754 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	755 if (rx_service == SERVICE_U \|\| rx_service == SERVICE_UITX)
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 ctrl_len = (*rx_service == SERVICE_U) ? U_FRAME_MIN_OCTETS
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	758 : UI_FRAME_MIN_OCTETS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	759
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	760 if (frame_len > llc_data->n201_u_base[UIMAP(*sapi)] + ctrl_len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	761 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	762 elem->remove_frame = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	763 TRACE_0_INFO("Primitive in TX exceeds N201-U: marked to remove");
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 }
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 * If frame is marked to remove, do it here
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 if (elem->remove_frame == TRUE)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	771 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	772 if (elem->prim_type EQ PRIM_DATA)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	773 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	774 PFREE (*grlc_data_req);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	775 TRACE_0_INFO("GRLC_DATA_REQ removed from TX queue");
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 else
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 PFREE (*grlc_unitdata_req);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	780 TRACE_0_INFO("GRLC_UNITDATA_REQ removed from TX queue");
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	783 *prim_type = PRIM_REMOVED;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	784 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	785
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	786 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	787 * Remove TX queue entry management element
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	788 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	789 MFREE (elem);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	790
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	791 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	792 * Check if service queue space should be tracked (at the moment only
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	793 * for service UITX and ITX, due to flow control to this service).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	794 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	795 if (*rx_service EQ SERVICE_UITX)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	796 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	797 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	798 * Increment the UITX space counter for the SAPI of the primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	799 * to indicate that the primitive has been stored in queue.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	800 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	801 if (*prim_type EQ PRIM_DATA)
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 llc_data->tx.queue_counter_uitx[UIMAP(*sapi)]++;
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 else /* PRIM_UNITDATA */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	806 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	807 llc_data->tx.queue_counter_uitx[UIMAP(*sapi)]++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	808 }
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 else if (*rx_service EQ SERVICE_ITX)
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	813 * Increment the ITX space counter for the SAPI of the primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	814 * to indicate that the primitive has been stored in queue.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	815 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	816 llc_data->tx.queue_counter_itx[IMAP(*sapi)]++;
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	820 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	821 } /* tx_get_next_frame() */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	822
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 \| Function : tx_get_first_data_frame
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 \| Description : This procedure finds the first GRLC_DATA_REQ primitive in the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	829 \| local transmit queue and stores its queue element in the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	830 \| parameter element, if any. The primitive (element) stays in
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	831 \| the queue. If no GRLC_DATA_REQ primitive is found in the queue,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	832 \| no element is stored in element, but the value NULL.
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 \| Parameters : elem - must be a valid pointer to a pointer to a
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	835 \| TX queue element
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	836 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	837 +------------------------------------------------------------------------------
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 GLOBAL void tx_get_first_data_frame (T_TX_QUEUE **elem)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	840 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	841 TRACE_FUNCTION( "tx_get_first_data_frame" );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	842
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 * Check the local transmit queue until a GRLC_DATA_REQ is found or the end
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	845 * of the queue has been reached. In the latter case, *elem is automatically
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	846 * set to NULL.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	847 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	848 for (elem = llc_data->tx.queue; elem NEQ NULL; elem = (elem)->next)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	849 {
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 * Check if primitive is a GRLC_DATA_REQ primitive.
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 if ((*elem)->prim_type EQ PRIM_DATA)
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 break;
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 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	860 } /* tx_get_first_data_frame() */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	861
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 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	865 \| Function : tx_remove_data_frames
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	866 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	867 \| Description : This procedure removes all PRIM_DATA for given SAPI and service
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	868 \| from TX queue. If an element is removed and
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	869 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	870 \| Parameters : service - service which requests to delete its primitives
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	871 \| sapi - the sapi of the primitives to delete
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 +------------------------------------------------------------------------------
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 GLOBAL void tx_remove_data_frames (T_SERVICE service, T_SAPI sapi)
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 T_TX_QUEUE *elem;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	878 T_TX_QUEUE **find = &llc_data->tx.queue;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	879 BOOL elem_removed = FALSE;
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 TRACE_FUNCTION( "tx_remove_data_frames" );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	882
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	883 while (*find NEQ NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	884 {
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 * Let elem point to queue element
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 elem = *find;
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 * Check if primitive is a GRLC_DATA_REQ primitive and
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	892 * check the sapi of the queue element
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	893 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	894 if ((elem->prim_type EQ PRIM_DATA) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	895 (elem->ph_sapi EQ sapi) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	896 (elem->rx_service EQ service) )
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	897 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	898 elem_removed = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	899
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	900 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	901 * Remove found element from queue (set member next of element before
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	902 * the found element to the element behind the found element and thus
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	903 * skip the found element).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	904 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	905 find = (find)->next;
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	908 * Check if we have a valid pointer to a primitive
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	909 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	910 if ((elem->primitive NEQ (ULONG)NULL))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	911 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	912 PFREE ((T_GRLC_DATA_REQ *)elem->primitive);
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 TRACE_0_INFO("TX queue element and primitive removed");
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 else
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	919 * Primitive is in use at CCI.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	920 * It is no problem if the corresponding primitive to this entry
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	921 * returns from CCI, because the reference number will not be found
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	922 * and the primitive data will then be freed.
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 TRACE_0_INFO("In use TX queue element removed");
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
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 * Remove TX queue entry management element.
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 MFREE (elem);
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 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	933 * Check if service queue space should be tracked (at the moment only
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	934 * for service UITX and ITX, due to flow control to this service).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	935 * In this case increment the space counter for the SAPI of the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	936 * primitive to indicate that the primitive has been stored in queue.
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 if (service EQ SERVICE_UITX)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	939 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	940 llc_data->tx.queue_counter_uitx[UIMAP(sapi)]++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	941 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	942 else if (service EQ SERVICE_ITX)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	943 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	944 llc_data->tx.queue_counter_itx[IMAP(sapi)]++;
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 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	947 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	948 {
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 * Point to the next queue element pointer
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	951 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	952 find = &((*find)->next);
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 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	955
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	956 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	957 * Now check, if a ready indication must be send must be send to the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	958 * requesting service (if at least one elem was removed, send one).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	959 * Currently only service UITX and ITX are requesting a signal.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	960 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	961 if (elem_removed)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	962 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	963 SWITCH_LLC (sapi);
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 if (service EQ SERVICE_UITX)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	966 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	967 sig_tx_uitx_ready_ind();
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	968 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	969 else if (service EQ SERVICE_ITX)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	970 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	971 sig_tx_itx_ready_ind();
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	972 }
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
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	975 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	976 } /* tx_remove_data_frames() */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	977

FreeCalypso > hg > fc-selenite

annotate src/g23m-gprs/llc/llc_txf.c @ 76:a2052ac75672