fc-magnetite: src/g23m-aci/l2p/l2p.c annotate

author	Mychaela Falconia <falcon@freecalypso.org>
date	Tue, 11 Oct 2016 02:02:43 +0000
parents
children

rev	line source
162 53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 +-----------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 \| Project : BAT L2P ()
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 \| Modul : BAT_L2P
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 +-----------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 \| Copyright 2005 Texas Instruments Berlin, AG
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 \| All rights reserved.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 \| Instruments Berlin, AG
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 \| The receipt of or possession of this file does not convey
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 \| whole, or in part, without the specific written consent of
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 \| Texas Instruments Berlin, AG.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 +-----------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 \| Purpose : L2P function definitions
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 +-----------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 #include "typedefs.h" /* to get TI data types */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 #include "vsi.h" /* to get a lot of macros */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 #include "l2p_types.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #include "l2p.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #include "string.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 T_L2P_CONTROL_BLOCK l2p_control_block_list = (T_L2P_CONTROL_BLOCK )0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 ** Local function declarations
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 static char L2P_write_data_to_seg(char writePtr, char *dataPtr, U16 dataSize, U16 remain_seg_size,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 U16 *bytesWritten);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 static char L2P_read_data_from_seg(char readPtr, char *writePtr, U16 dataSize, U16 remain_seg_size,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 U16 *bytesWritten);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 ** L2P function definitions
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 +--------------------------------------------------------------------+
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 \| PROJECT: BAT L2P MODULE: L2P \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 \| STATE : code ROUTINE: L2P_Configure \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 +--------------------------------------------------------------------+
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 PURPOSE : L2P_Configure will initiaise the L2P for each instance of BAT Lib or BAT Module
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 that wishes to use its services. The following is a list of the parameters, and their uses:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 batId : A identifer to uniquely identify each instance of BAT using this L2P
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 mem : A block of memory for L2P to use as a Control Block (L2P cannot allocate its own memory)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 num_mux_chnls: The number of clients being supported at the application end (this information is
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 passed to BAT Module as part of the startup process)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 protocolId : The protocol being used to communicate with the peer entity
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 maxMTU : Maximum size of a transport unit.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 xxx_CB : These are callback functions, provided by the BAT Lib or BAT Module, to provide necessary
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 services to L2P to get Send and Receive buffers, Send the Frames and receive fully
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 completed packets
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 T_L2P_STATUS L2P_Configure(U8 batid, void *mem,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 T_L2P_SUPPORTED_PROTOCOLS protocolId,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 U16 maxMTU,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 L2P_Get_Tx_Buf_CB Get_Tx_Buf_Cb,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 L2P_Get_Rx_Buf_CB Get_Rx_Buf_Cb,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 L2P_Get_Next_Seg_CB Get_Next_Seg_Cb,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 L2P_Send_Frame_CB Send_Frame_Cb,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 L2P_Msg_Rxd_CB Msg_Rxd_Cb)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 T_L2P_CONTROL_BLOCK **curr_lcb_next_ptr;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 T_L2P_CONTROL_BLOCK *current_l2p_cntrl_block;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 T_L2P_CONTROL_BLOCK this_l2p_cntrl_block = (T_L2P_CONTROL_BLOCK )mem;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 TRACE_EVENT("L2P_Configure");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 ** check the incoming paramters to ensure they are valid
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 if (mem == (void *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 TRACE_EVENT("L2P_Configure - Mem pointer Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 /* protocolId is a non-negative value(so <0 check not reqd) */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 if ( protocolId >= L2P_SP_MAX_NUM )
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 TRACE_EVENT("L2P_Configure - Protocol Id Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 if (maxMTU <= (L2P_FRAME_CONTROL_SIZE))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 TRACE_EVENT("L2P_Configure - Max MTU value Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 if (Get_Tx_Buf_Cb == (L2P_Get_Tx_Buf_CB)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 TRACE_EVENT("L2P_Configure - Get Tx Buffer Callback Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 if (Get_Rx_Buf_Cb == (L2P_Get_Rx_Buf_CB)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 TRACE_EVENT("L2P_Configure - Get Rx Buffer Callback Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 if (Get_Next_Seg_Cb == (L2P_Get_Next_Seg_CB)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 TRACE_EVENT("L2P_Configure - Get Next Segment Callback Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 if (Send_Frame_Cb == (L2P_Send_Frame_CB)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 TRACE_EVENT("L2P_Configure - Send Frame Callback Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 if (Msg_Rxd_Cb == (L2P_Msg_Rxd_CB)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 TRACE_EVENT("L2P_Configure - Message Received Callback Invalid");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 ** initialise the data in the passed block of data
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 this_l2p_cntrl_block->batId = batid;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 this_l2p_cntrl_block->frameId = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 this_l2p_cntrl_block->protocolId = protocolId;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 this_l2p_cntrl_block->maxMTU = maxMTU;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 this_l2p_cntrl_block->rxBuf = (char *)0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 this_l2p_cntrl_block->muxId = 0xFD; /* Any value here will be a valid client Id, but this one is unlikely ... it MUST be initialised correctly before each use */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 this_l2p_cntrl_block->cmdTagReceived = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 this_l2p_cntrl_block->receivedCmdTag = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 this_l2p_cntrl_block->dataSize = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 this_l2p_cntrl_block->bytesToBeRead = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 this_l2p_cntrl_block->dataToBeRead = (char *)0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 this_l2p_cntrl_block->callbacks.Get_TxBuf_Cb = Get_Tx_Buf_Cb;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 this_l2p_cntrl_block->callbacks.Get_RxBuf_Cb = Get_Rx_Buf_Cb;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 this_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb = Get_Next_Seg_Cb;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 this_l2p_cntrl_block->callbacks.Send_Frame_Cb = Send_Frame_Cb;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 this_l2p_cntrl_block->callbacks.Msg_Rxd_Cb = Msg_Rxd_Cb;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 this_l2p_cntrl_block->next = (void *)0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 ** Check that the batId is not already in use
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 if (l2p_control_block_list != (T_L2P_CONTROL_BLOCK *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 ** Parse the list until either the batId is found (which would be an error)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 ** or the batId is larger than the one passed (ie the current batId is not in the list, and is thereofre valid)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 curr_lcb_next_ptr = &l2p_control_block_list;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 current_l2p_cntrl_block = l2p_control_block_list;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 while ((current_l2p_cntrl_block != (T_L2P_CONTROL_BLOCK *)0) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 (current_l2p_cntrl_block->batId < batid))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 ** Jump to the next node on the linked list,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 ** keeping track of the previous node so we can add in the details later
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 curr_lcb_next_ptr = &current_l2p_cntrl_block->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 current_l2p_cntrl_block = current_l2p_cntrl_block->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 if (current_l2p_cntrl_block == (T_L2P_CONTROL_BLOCK *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 ** BAT Id was not found ... and we've reached the end of the list
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 ** need to add the details at the end of the linked list
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 *curr_lcb_next_ptr = this_l2p_cntrl_block;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 else if (current_l2p_cntrl_block->batId == batid)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 ** BAT Id was found in the current list ... it is already configured ... send an error
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 TRACE_EVENT("L2P_Configure - BAT Id Already In Use");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 return L2P_STAT_BAT_ID_ALREADY_EXISTS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 ** BAT Id was not found ... but we haven't reached the end of the list
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 ** need to add the details in the middle of the linked list
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 this_l2p_cntrl_block->next = *curr_lcb_next_ptr;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 *curr_lcb_next_ptr = this_l2p_cntrl_block;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 ** The linked list of BAT and L2P Control blocks is empty, this is the first instance of BAT
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 ** to register with the L2P. Add the details as the first entry to the linked list.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 l2p_control_block_list = this_l2p_cntrl_block;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 return L2P_STAT_SUCCESS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 +--------------------------------------------------------------------+
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 \| PROJECT: BAT L2P MODULE: L2P \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 \| STATE : code ROUTINE: L2P_Remove \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 +--------------------------------------------------------------------+
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 PURPOSE : L2P_Remove will delete a BAT from L2Ps service list. The following is a list of
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 the parameters, and their uses:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 batId : A identifer to uniquely identify each instance of BAT using this L2P
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 T_L2P_STATUS L2P_Remove(U8 batid)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 T_L2P_CONTROL_BLOCK **curr_lcb_next_ptr;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 T_L2P_CONTROL_BLOCK *current_l2p_cntrl_block;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 TRACE_EVENT("L2P_Remove()");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 if (l2p_control_block_list == (T_L2P_CONTROL_BLOCK *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 return L2P_STAT_NO_SUCH_BAT_ID;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 if (l2p_control_block_list->batId == batid)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 l2p_control_block_list = l2p_control_block_list->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 return L2P_STAT_SUCCESS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 ** Parse the list until either the batId is found
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 ** or the batId is larger than the one passed (which would be an error)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 curr_lcb_next_ptr = &l2p_control_block_list;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 current_l2p_cntrl_block = l2p_control_block_list;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 while ((current_l2p_cntrl_block != (T_L2P_CONTROL_BLOCK *)0) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 (current_l2p_cntrl_block->batId < batid))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 ** Jump to the next node on the linked list,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 ** keeping track of the previous node so we can add in the details later
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 curr_lcb_next_ptr = &current_l2p_cntrl_block->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 current_l2p_cntrl_block = current_l2p_cntrl_block->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 if (current_l2p_cntrl_block == (T_L2P_CONTROL_BLOCK *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 ** BAT Id was not found and we've reached the end of the list
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 return L2P_STAT_NO_SUCH_BAT_ID;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 else if (current_l2p_cntrl_block->batId == batid)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 ** BAT Id was found in the current list ... remove the control balock from the linked list
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 *curr_lcb_next_ptr = current_l2p_cntrl_block->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 ** BAT Id was not found ... the current batid must be greater tahn the one passed
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 return L2P_STAT_NO_SUCH_BAT_ID;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 return L2P_STAT_SUCCESS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 +--------------------------------------------------------------------+
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 \| PROJECT: BAT L2P MODULE: L2P \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 \| STATE : code ROUTINE: L2P_Send \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 +--------------------------------------------------------------------+
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 PURPOSE : L2P_Send will receive an AT Command Tag and its data from the L2P User, and depending on the
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 MTU size of the communications link being used, split the data into multiple frames and send those
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 Frames across the link. The following is a list of the parameters, and their uses:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 batId : A identifer to uniquely identify each instance of BAT using this L2P
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 muxId : A client identifier to identify which clinet of the BAT instance either sent, or is to receive, the data.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 dataTag : This is a BAT Command or Response TAG to identify which AT command is being sent. This TAG
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 will be sent to the peer along with the data.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 dataBuf : pointer to the payload data to send
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 dataLen : length of the data in the 'dataBuf'
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 errVal : If there is a driver error, L2P_Send will return L2P_STAT_UNKNOWN_ERROR and will provide
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 the driver error code in errVal. This is because the number may be positive, and all errors in
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 T_L2P_STATUS are negative.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 T_L2P_STATUS L2P_Send(U8 batId, U8 muxId, U32 dataTag, void dataBuf, U16 dataLen, int errVal)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 T_L2P_CONTROL_BLOCK *curr_l2p_cntrl_block;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 T_L2P_FRAME_CONTROL_BYTES frameCntrlBytes;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 U16 bytesRemainingToBeSent;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 U16 frameCntrlBytesToBeWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 U16 bytesToBeWritten = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 U16 bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 U16 frameSizeReq;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 U16 totalBufSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 U16 segSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 U16 remainingSegSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 U16 totalSegSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 char *curTxSeg;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 char *dataToBeWritten = NULL;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 char *frameCntrlDataToBeWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 void *seg_hdr;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 char *txWritePtr;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 char cmdTagWritten = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 int drvRetVal = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 TRACE_EVENT("L2P_Send()");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 ** Check that the Bat Id is valid
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 curr_l2p_cntrl_block = l2p_control_block_list;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 while ((curr_l2p_cntrl_block != (T_L2P_CONTROL_BLOCK *)0) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 (curr_l2p_cntrl_block->batId != batId))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 curr_l2p_cntrl_block = curr_l2p_cntrl_block->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 if (curr_l2p_cntrl_block == (T_L2P_CONTROL_BLOCK *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 return L2P_STAT_NO_SUCH_BAT_ID;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 ** Check the rest of the parameters
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 if ((dataBuf == (void *)0) && (dataLen != 0))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 TRACE_EVENT("L2P_Send() - Invalid Data Buffer Pointer");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 if (errVal == (int *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 TRACE_EVENT("L2P_Send() - Invalid Error Return Pointer");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 return L2P_STAT_INVALID_PARAMETER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 ** The format of an L2 frame for BAT will be as follows :
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 **
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 ** For the first frame
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 ** ----------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 ** \| L2 Control Bytes \| BAT Cmd TAG \| BAT Command Data \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 ** \| (n Bytes) \| 4 Bytes \| (Remaining Bytes) \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 ** ----------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 **
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 ** For any subsequent frames
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 ** ----------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 ** \| L2 Control Bytes \| BAT Command Data \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 ** \| (n Bytes) \| (Remaining Bytes) \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 ** ----------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 bytesRemainingToBeSent = dataLen + sizeof(int);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 ** Fill in the Frame Control Bytes
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 frameCntrlBytes.dataLen = dataLen;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 frameCntrlBytes.frame_id = 0; /* Each new packet will start with a frame Id of 0 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 frameCntrlBytes.frame_type = L2P_FT_UNKNOWN_FRAME_TYPE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 frameCntrlBytes.mux_id = muxId;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 frameCntrlBytes.protocol_id = (U8)curr_l2p_cntrl_block->protocolId;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 while (bytesRemainingToBeSent >0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 ** Calculate the required size of Transmit buffer and how many frames will be required
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 if ((bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE) > curr_l2p_cntrl_block->maxMTU)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 ** Data will not fit in a single frame, so will need to be fragmented and reassembled
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 frameSizeReq = curr_l2p_cntrl_block->maxMTU;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 ** Data will fit in a single frame, so will be sent complete
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 frameSizeReq = bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 ** Request the Transmit frame from the buffer
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 curTxSeg = (char *)curr_l2p_cntrl_block->callbacks.Get_TxBuf_Cb(batId, frameSizeReq,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 &seg_hdr, &totalBufSize, &segSize);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 if (curTxSeg == (char *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 return L2P_STAT_UNABLE_TO_GET_BUFFER;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 totalSegSize = remainingSegSize = segSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 ** Now we know the size of buffer given so we can tell whether the entire message will fit in a single frame
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 if (totalBufSize >= (bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 if (frameCntrlBytes.frame_type == L2P_FT_UNKNOWN_FRAME_TYPE)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 frameCntrlBytes.frame_type = (U8)L2P_FT_COMPLETE_FRAME;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 frameCntrlBytes.frame_type = (U8)L2P_FT_END_FRAME;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 frameCntrlBytes.frameLen = bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 if (frameCntrlBytes.frame_type == L2P_FT_UNKNOWN_FRAME_TYPE)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 frameCntrlBytes.frame_type = (U8)L2P_FT_START_FRAME;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 frameCntrlBytes.frame_type = L2P_FT_CONTINUATION_FRAME;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 frameCntrlBytes.frameLen = totalBufSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 txWritePtr = curTxSeg;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 ** We can assume that the buffer will be at least big enough for the L2 Frame Header plus some data
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 **
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 ** Write the L2 Frames Control Bytes
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 frameCntrlBytesToBeWritten = L2P_FRAME_CONTROL_SIZE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 frameCntrlDataToBeWritten = (char *)&frameCntrlBytes;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 while (frameCntrlBytesToBeWritten > 0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 txWritePtr = L2P_write_data_to_seg(txWritePtr, frameCntrlDataToBeWritten, frameCntrlBytesToBeWritten,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 remainingSegSize, &bytesWritten);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 frameCntrlBytesToBeWritten -= bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 remainingSegSize -= bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 frameCntrlDataToBeWritten += bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 ** Frame Control Bytes are NOT included in the bytesRemainingToBeSent count so do not decrease the size!
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 if (txWritePtr == (char *)0)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 ** We have reached the end of the current Segment, so get the next.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 curTxSeg = curr_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb(batId, seg_hdr, &seg_hdr, &segSize);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 txWritePtr = curTxSeg;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 totalSegSize +=segSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 remainingSegSize = segSize;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 ** if necessary, write the cmd Tag into the Buffer
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 if ((frameCntrlBytes.frame_type == L2P_FT_COMPLETE_FRAME) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 (frameCntrlBytes.frame_type == L2P_FT_START_FRAME))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 bytesToBeWritten = sizeof(dataTag);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 dataToBeWritten = (char *)&dataTag;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 while ((txWritePtr != (char )0) && / There is still space in the buffer segement */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 (!cmdTagWritten)) /* The command Tag has not completed */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 txWritePtr = L2P_write_data_to_seg(txWritePtr, dataToBeWritten, bytesToBeWritten,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 remainingSegSize, &bytesWritten);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 bytesToBeWritten -= bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 remainingSegSize -= bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 dataToBeWritten += bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 ** Decrement the bytesRemainingToBeSent counter
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 bytesRemainingToBeSent -= bytesWritten;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 if ((txWritePtr == (char *)0) && (totalSegSize < totalBufSize))

162

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2 +-----------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3 | Project : BAT L2P ()

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

4 | Modul : BAT_L2P

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

5 +-----------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

8 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

9 | This file is confidential and a trade secret of Texas

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

10 | Instruments Berlin, AG

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

11 | The receipt of or possession of this file does not convey

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

12 | any rights to reproduce or disclose its contents or to

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

13 | manufacture, use, or sell anything it may describe, in

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

14 | whole, or in part, without the specific written consent of

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

15 | Texas Instruments Berlin, AG.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

16 +-----------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

17 | Purpose : L2P function definitions

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

18 +-----------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

19 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

20 #include "typedefs.h" /* to get TI data types */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

21 #include "vsi.h" /* to get a lot of macros */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

22 #include "l2p_types.h"

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

23 #include "l2p.h"

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

24

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

25 #include "string.h"

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

26

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

27 T_L2P_CONTROL_BLOCK *l2p_control_block_list = (T_L2P_CONTROL_BLOCK *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

28

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

29 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

30 ** Local function declarations

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

31 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

32 static char *L2P_write_data_to_seg(char *writePtr, char *dataPtr, U16 dataSize, U16 remain_seg_size,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

33 U16 *bytesWritten);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

34

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

35 static char *L2P_read_data_from_seg(char *readPtr, char *writePtr, U16 dataSize, U16 remain_seg_size,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

36 U16 *bytesWritten);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

37

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

38

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

39 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

40 ** L2P function definitions

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

41 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

42

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

43 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

44 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

45 | PROJECT: BAT L2P MODULE: L2P |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

46 | STATE : code ROUTINE: L2P_Configure |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

47 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

48

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

49 PURPOSE : L2P_Configure will initiaise the L2P for each instance of BAT Lib or BAT Module

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

50 that wishes to use its services. The following is a list of the parameters, and their uses:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

51

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

52 batId : A identifer to uniquely identify each instance of BAT using this L2P

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

53 mem : A block of memory for L2P to use as a Control Block (L2P cannot allocate its own memory)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

54 num_mux_chnls: The number of clients being supported at the application end (this information is

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

55 passed to BAT Module as part of the startup process)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

56 protocolId : The protocol being used to communicate with the peer entity

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

57 maxMTU : Maximum size of a transport unit.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

58 xxx_CB : These are callback functions, provided by the BAT Lib or BAT Module, to provide necessary

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

59 services to L2P to get Send and Receive buffers, Send the Frames and receive fully

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

60 completed packets

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

61

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

62 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

63 T_L2P_STATUS L2P_Configure(U8 batid, void *mem,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

64 T_L2P_SUPPORTED_PROTOCOLS protocolId,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

65 U16 maxMTU,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

66 L2P_Get_Tx_Buf_CB Get_Tx_Buf_Cb,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

67 L2P_Get_Rx_Buf_CB Get_Rx_Buf_Cb,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

68 L2P_Get_Next_Seg_CB Get_Next_Seg_Cb,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

69 L2P_Send_Frame_CB Send_Frame_Cb,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

70 L2P_Msg_Rxd_CB Msg_Rxd_Cb)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

71 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

72 T_L2P_CONTROL_BLOCK **curr_lcb_next_ptr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

73 T_L2P_CONTROL_BLOCK *current_l2p_cntrl_block;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

74 T_L2P_CONTROL_BLOCK *this_l2p_cntrl_block = (T_L2P_CONTROL_BLOCK *)mem;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

75

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

76 TRACE_EVENT("L2P_Configure");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

77 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

78 ** check the incoming paramters to ensure they are valid

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

79 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

80 if (mem == (void *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

81 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

82 TRACE_EVENT("L2P_Configure - Mem pointer Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

83 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

84 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

85

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

86 /* protocolId is a non-negative value(so <0 check not reqd) */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

87 if ( protocolId >= L2P_SP_MAX_NUM )

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

88 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

89 TRACE_EVENT("L2P_Configure - Protocol Id Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

90 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

91 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

92

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

93 if (maxMTU <= (L2P_FRAME_CONTROL_SIZE))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

94 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

95 TRACE_EVENT("L2P_Configure - Max MTU value Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

96 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

97 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

98

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

99 if (Get_Tx_Buf_Cb == (L2P_Get_Tx_Buf_CB)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

100 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

101 TRACE_EVENT("L2P_Configure - Get Tx Buffer Callback Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

102 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

103 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

104

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

105 if (Get_Rx_Buf_Cb == (L2P_Get_Rx_Buf_CB)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

106 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

107 TRACE_EVENT("L2P_Configure - Get Rx Buffer Callback Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

108 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

109 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

110

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

111 if (Get_Next_Seg_Cb == (L2P_Get_Next_Seg_CB)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

112 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

113 TRACE_EVENT("L2P_Configure - Get Next Segment Callback Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

114 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

115 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

116

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

117 if (Send_Frame_Cb == (L2P_Send_Frame_CB)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

118 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

119 TRACE_EVENT("L2P_Configure - Send Frame Callback Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

120 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

121 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

122

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

123 if (Msg_Rxd_Cb == (L2P_Msg_Rxd_CB)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

124 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

125 TRACE_EVENT("L2P_Configure - Message Received Callback Invalid");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

126 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

127 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

128

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

129 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

130 ** initialise the data in the passed block of data

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

131 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

132 this_l2p_cntrl_block->batId = batid;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

133 this_l2p_cntrl_block->frameId = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

134 this_l2p_cntrl_block->protocolId = protocolId;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

135 this_l2p_cntrl_block->maxMTU = maxMTU;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

136 this_l2p_cntrl_block->rxBuf = (char *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

137 this_l2p_cntrl_block->muxId = 0xFD; /* Any value here will be a valid client Id, but this one is unlikely ... it MUST be initialised correctly before each use */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

138 this_l2p_cntrl_block->cmdTagReceived = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

139 this_l2p_cntrl_block->receivedCmdTag = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

140 this_l2p_cntrl_block->dataSize = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

141 this_l2p_cntrl_block->bytesToBeRead = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

142 this_l2p_cntrl_block->dataToBeRead = (char *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

143

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

144 this_l2p_cntrl_block->callbacks.Get_TxBuf_Cb = Get_Tx_Buf_Cb;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

145 this_l2p_cntrl_block->callbacks.Get_RxBuf_Cb = Get_Rx_Buf_Cb;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

146 this_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb = Get_Next_Seg_Cb;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

147 this_l2p_cntrl_block->callbacks.Send_Frame_Cb = Send_Frame_Cb;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

148 this_l2p_cntrl_block->callbacks.Msg_Rxd_Cb = Msg_Rxd_Cb;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

149

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

150 this_l2p_cntrl_block->next = (void *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

151

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

152 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

153 ** Check that the batId is not already in use

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

154 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

155 if (l2p_control_block_list != (T_L2P_CONTROL_BLOCK *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

156 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

157 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

158 ** Parse the list until either the batId is found (which would be an error)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

159 ** or the batId is larger than the one passed (ie the current batId is not in the list, and is thereofre valid)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

160 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

161 curr_lcb_next_ptr = &l2p_control_block_list;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

162 current_l2p_cntrl_block = l2p_control_block_list;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

163

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

164 while ((current_l2p_cntrl_block != (T_L2P_CONTROL_BLOCK *)0) &&

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

165 (current_l2p_cntrl_block->batId < batid))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

166 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

167 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

168 ** Jump to the next node on the linked list,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

169 ** keeping track of the previous node so we can add in the details later

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

170 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

171 curr_lcb_next_ptr = &current_l2p_cntrl_block->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

172 current_l2p_cntrl_block = current_l2p_cntrl_block->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

173 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

174

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

175 if (current_l2p_cntrl_block == (T_L2P_CONTROL_BLOCK *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

176 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

177 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

178 ** BAT Id was not found ... and we've reached the end of the list

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

179 ** need to add the details at the end of the linked list

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

180 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

181 *curr_lcb_next_ptr = this_l2p_cntrl_block;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

182 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

183 else if (current_l2p_cntrl_block->batId == batid)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

184 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

185 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

186 ** BAT Id was found in the current list ... it is already configured ... send an error

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

187 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

188 TRACE_EVENT("L2P_Configure - BAT Id Already In Use");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

189 return L2P_STAT_BAT_ID_ALREADY_EXISTS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

190 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

191 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

192 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

193 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

194 ** BAT Id was not found ... but we haven't reached the end of the list

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

195 ** need to add the details in the middle of the linked list

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

196 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

197 this_l2p_cntrl_block->next = *curr_lcb_next_ptr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

198 *curr_lcb_next_ptr = this_l2p_cntrl_block;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

199 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

200 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

201 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

202 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

203 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

204 ** The linked list of BAT and L2P Control blocks is empty, this is the first instance of BAT

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

205 ** to register with the L2P. Add the details as the first entry to the linked list.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

206 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

207 l2p_control_block_list = this_l2p_cntrl_block;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

208 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

209 return L2P_STAT_SUCCESS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

210 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

211

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

212 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

213 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

214 | PROJECT: BAT L2P MODULE: L2P |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

215 | STATE : code ROUTINE: L2P_Remove |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

216 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

217

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

218 PURPOSE : L2P_Remove will delete a BAT from L2Ps service list. The following is a list of

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

219 the parameters, and their uses:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

220

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

221 batId : A identifer to uniquely identify each instance of BAT using this L2P

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

222

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

223 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

224 T_L2P_STATUS L2P_Remove(U8 batid)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

225 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

226 T_L2P_CONTROL_BLOCK **curr_lcb_next_ptr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

227 T_L2P_CONTROL_BLOCK *current_l2p_cntrl_block;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

228

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

229 TRACE_EVENT("L2P_Remove()");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

230

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

231 if (l2p_control_block_list == (T_L2P_CONTROL_BLOCK *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

232 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

233 return L2P_STAT_NO_SUCH_BAT_ID;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

234 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

235

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

236 if (l2p_control_block_list->batId == batid)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

237 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

238 l2p_control_block_list = l2p_control_block_list->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

239 return L2P_STAT_SUCCESS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

240 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

241

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

242 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

243 ** Parse the list until either the batId is found

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

244 ** or the batId is larger than the one passed (which would be an error)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

245 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

246 curr_lcb_next_ptr = &l2p_control_block_list;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

247 current_l2p_cntrl_block = l2p_control_block_list;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

248

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

249 while ((current_l2p_cntrl_block != (T_L2P_CONTROL_BLOCK *)0) &&

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

250 (current_l2p_cntrl_block->batId < batid))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

251 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

252 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

253 ** Jump to the next node on the linked list,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

254 ** keeping track of the previous node so we can add in the details later

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

255 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

256 curr_lcb_next_ptr = &current_l2p_cntrl_block->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

257 current_l2p_cntrl_block = current_l2p_cntrl_block->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

258 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

259

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

260 if (current_l2p_cntrl_block == (T_L2P_CONTROL_BLOCK *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

261 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

262 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

263 ** BAT Id was not found and we've reached the end of the list

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

264 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

265 return L2P_STAT_NO_SUCH_BAT_ID;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

266 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

267 else if (current_l2p_cntrl_block->batId == batid)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

268 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

269 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

270 ** BAT Id was found in the current list ... remove the control balock from the linked list

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

271 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

272 *curr_lcb_next_ptr = current_l2p_cntrl_block->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

273 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

274 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

275 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

276 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

277 ** BAT Id was not found ... the current batid must be greater tahn the one passed

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

278 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

279 return L2P_STAT_NO_SUCH_BAT_ID;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

280 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

281

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

282 return L2P_STAT_SUCCESS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

283 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

284

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

285 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

286 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

287 | PROJECT: BAT L2P MODULE: L2P |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

288 | STATE : code ROUTINE: L2P_Send |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

289 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

290

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

291 PURPOSE : L2P_Send will receive an AT Command Tag and its data from the L2P User, and depending on the

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

292 MTU size of the communications link being used, split the data into multiple frames and send those

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

293 Frames across the link. The following is a list of the parameters, and their uses:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

294

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

295 batId : A identifer to uniquely identify each instance of BAT using this L2P

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

296 muxId : A client identifier to identify which clinet of the BAT instance either sent, or is to receive, the data.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

297 dataTag : This is a BAT Command or Response TAG to identify which AT command is being sent. This TAG

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

298 will be sent to the peer along with the data.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

299 dataBuf : pointer to the payload data to send

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

300 dataLen : length of the data in the 'dataBuf'

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

301 errVal : If there is a driver error, L2P_Send will return L2P_STAT_UNKNOWN_ERROR and will provide

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

302 the driver error code in errVal. This is because the number may be positive, and all errors in

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

303 T_L2P_STATUS are negative.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

304

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

305 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

306 T_L2P_STATUS L2P_Send(U8 batId, U8 muxId, U32 dataTag, void *dataBuf, U16 dataLen, int *errVal)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

307 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

308 T_L2P_CONTROL_BLOCK *curr_l2p_cntrl_block;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

309 T_L2P_FRAME_CONTROL_BYTES frameCntrlBytes;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

310 U16 bytesRemainingToBeSent;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

311 U16 frameCntrlBytesToBeWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

312 U16 bytesToBeWritten = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

313 U16 bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

314 U16 frameSizeReq;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

315 U16 totalBufSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

316 U16 segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

317 U16 remainingSegSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

318 U16 totalSegSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

319 char *curTxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

320 char *dataToBeWritten = NULL;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

321 char *frameCntrlDataToBeWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

322 void *seg_hdr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

323 char *txWritePtr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

324 char cmdTagWritten = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

325 int drvRetVal = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

326

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

327 TRACE_EVENT("L2P_Send()");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

328

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

329 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

330 ** Check that the Bat Id is valid

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

331 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

332

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

333 curr_l2p_cntrl_block = l2p_control_block_list;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

334

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

335 while ((curr_l2p_cntrl_block != (T_L2P_CONTROL_BLOCK *)0) &&

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

336 (curr_l2p_cntrl_block->batId != batId))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

337 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

338 curr_l2p_cntrl_block = curr_l2p_cntrl_block->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

339 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

340

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

341 if (curr_l2p_cntrl_block == (T_L2P_CONTROL_BLOCK *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

342 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

343 return L2P_STAT_NO_SUCH_BAT_ID;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

344 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

345

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

346 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

347 ** Check the rest of the parameters

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

348 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

349 if ((dataBuf == (void *)0) && (dataLen != 0))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

350 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

351 TRACE_EVENT("L2P_Send() - Invalid Data Buffer Pointer");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

352 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

353 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

354

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

355 if (errVal == (int *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

356 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

357 TRACE_EVENT("L2P_Send() - Invalid Error Return Pointer");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

358 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

359 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

360

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

361 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

362 ** The format of an L2 frame for BAT will be as follows :

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

363 **

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

364 ** For the first frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

365 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

366 ** | L2 Control Bytes | BAT Cmd TAG | BAT Command Data |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

367 ** | (n Bytes) | 4 Bytes | (Remaining Bytes) |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

368 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

369 **

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

370 ** For any subsequent frames

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

371 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

372 ** | L2 Control Bytes | BAT Command Data |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

373 ** | (n Bytes) | (Remaining Bytes) |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

374 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

375 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

376

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

377 bytesRemainingToBeSent = dataLen + sizeof(int);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

378

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

379 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

380 ** Fill in the Frame Control Bytes

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

381 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

382 frameCntrlBytes.dataLen = dataLen;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

383 frameCntrlBytes.frame_id = 0; /* Each new packet will start with a frame Id of 0 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

384 frameCntrlBytes.frame_type = L2P_FT_UNKNOWN_FRAME_TYPE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

385 frameCntrlBytes.mux_id = muxId;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

386 frameCntrlBytes.protocol_id = (U8)curr_l2p_cntrl_block->protocolId;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

387

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

388 while (bytesRemainingToBeSent >0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

389 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

390 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

391 ** Calculate the required size of Transmit buffer and how many frames will be required

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

392 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

393 if ((bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE) > curr_l2p_cntrl_block->maxMTU)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

394 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

395 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

396 ** Data will not fit in a single frame, so will need to be fragmented and reassembled

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

397 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

398 frameSizeReq = curr_l2p_cntrl_block->maxMTU;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

399 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

400 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

401 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

402 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

403 ** Data will fit in a single frame, so will be sent complete

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

404 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

405 frameSizeReq = bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

406 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

407

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

408 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

409 ** Request the Transmit frame from the buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

410 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

411 curTxSeg = (char *)curr_l2p_cntrl_block->callbacks.Get_TxBuf_Cb(batId, frameSizeReq,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

412 &seg_hdr, &totalBufSize, &segSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

413

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

414 if (curTxSeg == (char *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

415 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

416 return L2P_STAT_UNABLE_TO_GET_BUFFER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

417 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

418

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

419 totalSegSize = remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

420

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

421 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

422 ** Now we know the size of buffer given so we can tell whether the entire message will fit in a single frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

423 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

424 if (totalBufSize >= (bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

425 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

426 if (frameCntrlBytes.frame_type == L2P_FT_UNKNOWN_FRAME_TYPE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

427 frameCntrlBytes.frame_type = (U8)L2P_FT_COMPLETE_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

428 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

429 frameCntrlBytes.frame_type = (U8)L2P_FT_END_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

430

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

431 frameCntrlBytes.frameLen = bytesRemainingToBeSent + L2P_FRAME_CONTROL_SIZE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

432 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

433 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

434 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

435 if (frameCntrlBytes.frame_type == L2P_FT_UNKNOWN_FRAME_TYPE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

436 frameCntrlBytes.frame_type = (U8)L2P_FT_START_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

437 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

438 frameCntrlBytes.frame_type = L2P_FT_CONTINUATION_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

439

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

440 frameCntrlBytes.frameLen = totalBufSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

441 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

442

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

443 txWritePtr = curTxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

444

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

445 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

446 ** We can assume that the buffer will be at least big enough for the L2 Frame Header plus some data

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

447 **

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

448 ** Write the L2 Frames Control Bytes

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

449 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

450 frameCntrlBytesToBeWritten = L2P_FRAME_CONTROL_SIZE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

451 frameCntrlDataToBeWritten = (char *)&frameCntrlBytes;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

452

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

453 while (frameCntrlBytesToBeWritten > 0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

454 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

455 txWritePtr = L2P_write_data_to_seg(txWritePtr, frameCntrlDataToBeWritten, frameCntrlBytesToBeWritten,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

456 remainingSegSize, &bytesWritten);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

457 frameCntrlBytesToBeWritten -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

458 remainingSegSize -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

459 frameCntrlDataToBeWritten += bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

460

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

461 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

462 ** Frame Control Bytes are NOT included in the bytesRemainingToBeSent count so do not decrease the size!

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

463 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

464

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

465 if (txWritePtr == (char *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

466 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

467 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

468 ** We have reached the end of the current Segment, so get the next.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

469 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

470 curTxSeg = curr_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb(batId, seg_hdr, &seg_hdr, &segSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

471 txWritePtr = curTxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

472 totalSegSize +=segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

473 remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

474 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

475 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

476

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

477 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

478 ** if necessary, write the cmd Tag into the Buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

479 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

480 if ((frameCntrlBytes.frame_type == L2P_FT_COMPLETE_FRAME) ||

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

481 (frameCntrlBytes.frame_type == L2P_FT_START_FRAME))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

482 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

483 bytesToBeWritten = sizeof(dataTag);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

484 dataToBeWritten = (char *)&dataTag;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

485

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

486 while ((txWritePtr != (char *)0) && /* There is still space in the buffer segement */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

487 (!cmdTagWritten)) /* The command Tag has not completed */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

488 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

489 txWritePtr = L2P_write_data_to_seg(txWritePtr, dataToBeWritten, bytesToBeWritten,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

490 remainingSegSize, &bytesWritten);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

491 bytesToBeWritten -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

492 remainingSegSize -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

493 dataToBeWritten += bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

494

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

495 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

496 ** Decrement the bytesRemainingToBeSent counter

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

497 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

498 bytesRemainingToBeSent -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

499

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

500 if ((txWritePtr == (char *)0) && (totalSegSize < totalBufSize))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

501 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

502 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

503 ** We have reached the end of the current Segment, so get the next.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

504 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

505 curTxSeg = curr_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb(batId, seg_hdr, &seg_hdr, &segSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

506 txWritePtr = curTxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

507 totalSegSize +=segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

508 remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

509 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

510

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

511 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

512 ** If the Command Tag has been completed set a flag

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

513 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

514 if (bytesToBeWritten == (U16)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

515 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

516 cmdTagWritten = 1;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

517 dataToBeWritten = (char *)dataBuf; /* Next Write the AT Command Data */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

518 bytesToBeWritten = dataLen;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

519 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

520 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

521 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

522

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

523 if (dataToBeWritten EQ NULL)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

524 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

525 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

526 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

527 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

528 ** if txWritePtr is NULL at this point it is because a buffer has been completed ... drop out and perform

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

529 ** the next loop of the while statement to create the next L2 Frame in an new buffer.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

530 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

531 while ((bytesToBeWritten > 0) && /* There is still data to write */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

532 (txWritePtr != (char *)0)) /* There is still space in the buffer segement */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

533 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

534 txWritePtr = L2P_write_data_to_seg(txWritePtr, dataToBeWritten, bytesToBeWritten,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

535 remainingSegSize, &bytesWritten);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

536 bytesToBeWritten -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

537 remainingSegSize -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

538 dataToBeWritten += bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

539

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

540 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

541 ** Decrement the bytesRemainingToBeSent counter

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

542 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

543 bytesRemainingToBeSent -= bytesWritten;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

544

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

545 if ((txWritePtr == (char *)0) && (totalSegSize < totalBufSize))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

546 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

547 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

548 ** We have reached the end of the current Segment, so get the next.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

549 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

550 curTxSeg = curr_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb(batId, seg_hdr, &seg_hdr, &segSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

551 txWritePtr = curTxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

552 totalSegSize +=segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

553 remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

554 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

555

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

556 if ((bytesToBeWritten == (U16)0) && /* We've finished writing the data */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

557 (!cmdTagWritten)) /* but that data was the Command Tag */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

558 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

559 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

560 ** now we have to write the AT Command Data

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

561 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

562 cmdTagWritten = 1;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

563 dataToBeWritten = (char *)dataBuf;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

564 bytesToBeWritten = dataLen;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

565 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

566 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

567

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

568 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

569 ** We have built a complete L2 Frame ... that it may or may not include the complete packet it isn't important

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

570 ** but we need to send it ...

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

571 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

572 drvRetVal = curr_l2p_cntrl_block->callbacks.Send_Frame_Cb(batId);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

573 frameCntrlBytes.frame_id ++;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

574

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

575 if (drvRetVal != 0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

576 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

577 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

578 ** There was an error sending the frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

579 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

580 *errVal = drvRetVal;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

581 return L2P_STAT_UNKNOWN_ERROR;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

582 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

583 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

584

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

585 return L2P_STAT_SUCCESS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

586 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

587

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

588 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

589 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

590 | PROJECT: BAT L2P MODULE: L2P |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

591 | STATE : code ROUTINE: L2P_Receive |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

592 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

593

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

594 PURPOSE : L2P_Receive is called on receipt of data by the BAT, BAT Command Tag is extracted and the rest

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

595 of the L2 frames are combined into a buffer and passed, complete, to the BAT. The following is a

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

596 list of the parameters, and their uses:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

597

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

598 batId : A identifer to uniquely identify each instance of BAT using this L2P

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

599 inBuf : pointer to the received buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

600 dataLen : length of the data in the 'inBuf'

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

601

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

602 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

603 T_L2P_STATUS L2P_Receive(U8 batId, void *dataBuf, void *seg_hdr_ptr, U16 totalsize, U16 segSize)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

604 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

605 T_L2P_CONTROL_BLOCK *curr_l2p_cntrl_block;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

606 T_L2P_FRAME_CONTROL_BYTES frameCntrlBytes;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

607 U16 frameCntrlBytesToBeRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

608 U16 bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

609 U16 remainingSegSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

610 U16 totalSegSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

611 char *curRxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

612 char *rxReadPtr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

613 char *frameCntrlDataToBeRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

614

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

615 TRACE_EVENT("L2P_Receive()");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

616

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

617 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

618 ** Check that the Bat Id is valid

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

619 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

620 curr_l2p_cntrl_block = l2p_control_block_list;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

621

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

622 while ((curr_l2p_cntrl_block != (T_L2P_CONTROL_BLOCK *)0) &&

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

623 (curr_l2p_cntrl_block->batId != batId))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

624 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

625 curr_l2p_cntrl_block = curr_l2p_cntrl_block->next;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

626 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

627

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

628 if (curr_l2p_cntrl_block == (T_L2P_CONTROL_BLOCK *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

629 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

630 return L2P_STAT_NO_SUCH_BAT_ID;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

631 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

632

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

633 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

634 ** Check the rest of the parameters

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

635 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

636 if (dataBuf == (void *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

637 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

638 TRACE_EVENT("L2P_Receive() - Invalid Data Buffer Pointer");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

639 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

640 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

641

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

642 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

643 ** Don't check the Segment Header Pointer, it is User Data and down to the

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

644 ** BAT Lib or BAT Module which pointer they pass :

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

645 ** pointer to current segment - never NULL

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

646 ** pointer to the next segment - may be NULL

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

647 **

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

648 if (seg_hdr_ptr == (void *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

649 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

650 TRACE_EVENT("L2P_Receive() - Invalid Segment Header Pointer");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

651 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

652 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

653 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

654

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

655 if (totalsize <= (U16)L2P_FRAME_CONTROL_SIZE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

656 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

657 TRACE_EVENT("L2P_Receive() - Invalid Buffer Length");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

658 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

659 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

660

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

661 if (segSize == (U16)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

662 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

663 TRACE_EVENT("L2P_Receive() - Invalid Segment Size");

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

664 return L2P_STAT_INVALID_PARAMETER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

665 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

666

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

667 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

668 ** The format of an L2 frame for BAT will be as follows :

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

669 **

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

670 ** For the first frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

671 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

672 ** | L2 Control Bytes | BAT Cmd TAG | BAT Command Data |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

673 ** | (n Bytes) | 4 Bytes | (Remaining Bytes) |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

674 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

675 **

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

676 ** For any subsequent frames

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

677 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

678 ** | L2 Control Bytes | BAT Command Data |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

679 ** | (n Bytes) | (Remaining Bytes) |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

680 ** ----------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

681 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

682

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

683 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

684 ** Read the L2 Frames Control Bytes

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

685 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

686 curRxSeg = (char *)dataBuf;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

687 frameCntrlBytesToBeRead = L2P_FRAME_CONTROL_SIZE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

688 frameCntrlDataToBeRead = (char *)&frameCntrlBytes;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

689 totalSegSize = remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

690 rxReadPtr = dataBuf;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

691

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

692 while (frameCntrlBytesToBeRead > 0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

693 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

694 rxReadPtr = L2P_read_data_from_seg(rxReadPtr, frameCntrlDataToBeRead, frameCntrlBytesToBeRead,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

695 remainingSegSize, &bytesRead);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

696 frameCntrlBytesToBeRead-= bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

697 remainingSegSize -= bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

698 frameCntrlDataToBeRead += bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

699

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

700 if (rxReadPtr == (char *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

701 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

702 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

703 ** We have reached the end of the current Segment, so get the next.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

704 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

705 curRxSeg = curr_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb(batId, seg_hdr_ptr, &seg_hdr_ptr,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

706 &segSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

707 rxReadPtr = curRxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

708 totalSegSize +=segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

709 remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

710 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

711 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

712

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

713 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

714 ** Now we have the frame Control Bytes ... so we need to determine whether we need a

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

715 ** new Rx Buffer from the user

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

716 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

717

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

718 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

719 ** If the frame Id is zero, this is a new message

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

720 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

721 if ((frameCntrlBytes.frame_id == (U8)0) &&

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

722 ((frameCntrlBytes.frame_type == L2P_FT_START_FRAME) ||

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

723 (frameCntrlBytes.frame_type == L2P_FT_COMPLETE_FRAME)))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

724 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

725 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

726 ** Do we already have an Rx Buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

727 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

728 if (curr_l2p_cntrl_block->rxBuf == (char *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

729 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

730 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

731 ** No -- Use the callback function to get an Rx Buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

732 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

733 curr_l2p_cntrl_block->rxBuf = (char *)curr_l2p_cntrl_block->callbacks.Get_RxBuf_Cb(batId);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

734

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

735 if (curr_l2p_cntrl_block->rxBuf == (char *)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

736 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

737 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

738 ** Failed to allocate a Rx Buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

739 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

740 return L2P_STAT_UNABLE_TO_GET_BUFFER;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

741 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

742 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

743 /* comment out the 'else block' because there is no functionality to go inside it

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

744 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

745 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

746 ** Yes -- We will overwrite it automatically ... the previous message was lost!

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

747 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

748 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

749

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

750 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

751 ** Pull the necessary data from the Frame Control Bytes

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

752 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

753 curr_l2p_cntrl_block->dataSize = frameCntrlBytes.dataLen; /* length of the Command Data (excl the CmdTag) */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

754 curr_l2p_cntrl_block->muxId = frameCntrlBytes.mux_id; /* Sender or receipient of the message */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

755 curr_l2p_cntrl_block->cmdTagReceived = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

756 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

757

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

758 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

759 ** if necessary, read the cmd Tag from the Buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

760 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

761 if ((frameCntrlBytes.frame_type == L2P_FT_COMPLETE_FRAME) ||

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

762 (frameCntrlBytes.frame_type == L2P_FT_START_FRAME))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

763 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

764 curr_l2p_cntrl_block->bytesToBeRead = sizeof(curr_l2p_cntrl_block->receivedCmdTag);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

765 curr_l2p_cntrl_block->dataToBeRead = (char *)&curr_l2p_cntrl_block->receivedCmdTag;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

766

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

767 while ((rxReadPtr != (char *)0) && /* There is still data in the buffer segement */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

768 (!curr_l2p_cntrl_block->cmdTagReceived)) /* The command Tag has not completed */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

769 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

770 rxReadPtr = L2P_read_data_from_seg(rxReadPtr, curr_l2p_cntrl_block->dataToBeRead,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

771 curr_l2p_cntrl_block->bytesToBeRead,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

772 remainingSegSize, &bytesRead);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

773 curr_l2p_cntrl_block->bytesToBeRead -= bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

774 remainingSegSize -= bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

775 curr_l2p_cntrl_block->dataToBeRead += bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

776

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

777 if ((rxReadPtr == (char *)0) && (totalSegSize < totalsize) && (curr_l2p_cntrl_block->bytesToBeRead != (U16)0))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

778 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

779 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

780 ** We have reached the end of the current Segment, so get the next.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

781 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

782 curRxSeg = curr_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb(batId, seg_hdr_ptr, &seg_hdr_ptr, &segSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

783 rxReadPtr = curRxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

784 totalSegSize +=segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

785 remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

786 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

787

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

788 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

789 ** If the Command Tag has been completed set a flag

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

790 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

791 if (curr_l2p_cntrl_block->bytesToBeRead == (U16)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

792 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

793 curr_l2p_cntrl_block->cmdTagReceived = 1;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

794 curr_l2p_cntrl_block->dataToBeRead = (char *)curr_l2p_cntrl_block->rxBuf; /* Next Write the AT Command Data */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

795 curr_l2p_cntrl_block->bytesToBeRead = curr_l2p_cntrl_block->dataSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

796 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

797 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

798 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

799

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

800 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

801 ** if txWritePtr is NULL at this point it is because a buffer has been completed ... drop out and

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

802 ** wait for the next buffer which will contain the next frame.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

803 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

804 while ((curr_l2p_cntrl_block->bytesToBeRead > 0) && /* There is still data to read */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

805 (rxReadPtr != (char *)0)) /* There is still data in the buffer segement */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

806 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

807 rxReadPtr = L2P_read_data_from_seg(rxReadPtr, curr_l2p_cntrl_block->dataToBeRead,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

808 curr_l2p_cntrl_block->bytesToBeRead,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

809 remainingSegSize, &bytesRead);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

810 curr_l2p_cntrl_block->bytesToBeRead -= bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

811 remainingSegSize -= bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

812 curr_l2p_cntrl_block->dataToBeRead += bytesRead;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

813

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

814 if ((rxReadPtr == (char *)0) && (totalSegSize < totalsize) && (curr_l2p_cntrl_block->bytesToBeRead != (U16)0))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

815

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

816 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

817 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

818 ** We have reached the end of the current Segment, so get the next.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

819 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

820 curRxSeg = curr_l2p_cntrl_block->callbacks.Get_Next_Seg_Cb(batId, seg_hdr_ptr, &seg_hdr_ptr, &segSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

821 rxReadPtr = curRxSeg;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

822 totalSegSize +=segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

823 remainingSegSize = segSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

824 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

825

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

826 if ((curr_l2p_cntrl_block->bytesToBeRead == (U16)0) && /* We've finished writing the data */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

827 (!curr_l2p_cntrl_block->cmdTagReceived)) /* but that data was the Command Tag */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

828 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

829 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

830 ** now we have to write the AT Command Data

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

831 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

832 curr_l2p_cntrl_block->cmdTagReceived = 1;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

833 curr_l2p_cntrl_block->dataToBeRead = (char *)curr_l2p_cntrl_block->rxBuf; /* Next Write the AT Command Data */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

834 curr_l2p_cntrl_block->bytesToBeRead = curr_l2p_cntrl_block->dataSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

835 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

836 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

837

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

838 if (curr_l2p_cntrl_block->bytesToBeRead == (U16)0)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

839 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

840 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

841 ** We have built a complete message ... send it to the user ..

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

842 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

843 curr_l2p_cntrl_block->callbacks.Msg_Rxd_Cb(batId, curr_l2p_cntrl_block->muxId,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

844 curr_l2p_cntrl_block->receivedCmdTag,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

845 curr_l2p_cntrl_block->rxBuf,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

846 curr_l2p_cntrl_block->dataSize);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

847

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

848 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

849 ** reset the Rx values

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

850 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

851 curr_l2p_cntrl_block->rxBuf = (char *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

852 curr_l2p_cntrl_block->muxId = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

853 curr_l2p_cntrl_block->cmdTagReceived = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

854 curr_l2p_cntrl_block->receivedCmdTag = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

855 curr_l2p_cntrl_block->dataSize = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

856 curr_l2p_cntrl_block->dataToBeRead = (char *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

857 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

858

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

859 return L2P_STAT_SUCCESS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

860 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

861

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

862

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

863 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

864 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

865 | PROJECT: BAT L2P MODULE: L2P |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

866 | STATE : code ROUTINE: L2P_write_data_to_seg |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

867 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

868

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

869 PURPOSE : L2P_write_data_to_seg is a local function to write a piece of data into a buffer segment. The buffer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

870 segment may, or may not be big enough to hold the entire piece of data. If the segment is full when

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

871 the data has been written then the function will return a NULL pointer, otherwise it will return a pointer

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

872 to the next location to receive data.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

873 The following is a list of the parameters, and their uses:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

874

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

875 writePtr : pointer to the start location to write the data to

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

876 dataPtr : pointer to the data to be written

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

877 dataSize : length of the data in dataPtr

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

878 remain_seg_size : The size of remaining space in the buffer segment

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

879 bytesWritten : output parameter in order to return the actual number of bytes written into the segment.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

880

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

881 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

882 static char *L2P_write_data_to_seg(char *writePtr, char *dataPtr, U16 dataSize, U16 remain_seg_size,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

883 U16 *bytesWritten)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

884 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

885 char *retPtr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

886

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

887 if (remain_seg_size <= dataSize)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

888 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

889 retPtr = (char *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

890 *bytesWritten = remain_seg_size;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

891 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

892 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

893 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

894 retPtr = writePtr + dataSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

895 *bytesWritten = dataSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

896 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

897

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

898 memcpy(writePtr, dataPtr, *bytesWritten);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

899

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

900 return retPtr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

901 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

902

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

903

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

904 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

905 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

906 | PROJECT: BAT L2P MODULE: L2P |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

907 | STATE : code ROUTINE: L2P_write_data_to_seg |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

908 +--------------------------------------------------------------------+

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

909

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

910 PURPOSE : L2P_read_data_from_seg is a local function to read a piece of data from a buffer segment, and write

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

911 it into a data structure (pointed to by writePtr). The buffer segment may, or may not be big enough to

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

912 hold the entire piece of data. If the end of the segment is reached when the data has been read then

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

913 the function will return a NULL pointer, otherwise it will return a pointer to the next location to read data

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

914 from. The following is a list of the parameters, and their uses:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

915

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

916 readPtr : pointer to the position in the segment to read from

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

917 writePtr : pointer to the start location to write the data to

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

918 dataSize : length of the data to be read from the segment

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

919 remain_seg_size : The size of remaining space in the buffer segment

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

920 bytesWritten : output parameter in order to return the actual number of bytes written.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

921

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

922 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

923 static char *L2P_read_data_from_seg(char *readPtr, char *writePtr, U16 dataSize, U16 remain_seg_size,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

924 U16 *bytesWritten)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

925 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

926 char *retPtr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

927

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

928 if (remain_seg_size <= dataSize)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

929 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

930 retPtr = (char *)0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

931 *bytesWritten = remain_seg_size;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

932 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

933 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

934 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

935 retPtr = readPtr + dataSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

936 *bytesWritten = dataSize;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

937 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

938

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

939 memcpy(writePtr, readPtr, *bytesWritten);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

940

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

941 return retPtr;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

942 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

943

FreeCalypso > hg > fc-magnetite

annotate src/g23m-aci/l2p/l2p.c @ 162:53929b40109c