fc-magnetite: src/g23m-aci/uart/uart

author	Mychaela Falconia <falcon@freecalypso.org>
date	Wed, 27 Mar 2019 23:44:35 +0000 (2019-03-27)
parents	53929b40109c
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 :
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 \| Modul :
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 2002 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 : This modul is part of the entity UART and implements all
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 \| procedures and functions as described in the
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 \| SDL-documentation (KER-statemachine)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 +-----------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #ifndef UART_KERF_C
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #define UART_KERF_C
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #endif /* !UART_KERF_C */
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 #define ENTITY_UART
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 * Turn off spurious LINT warnings
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 /lint -e415 access of out-of-bounds pointer /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 /lint -e416 creation of out-of-bounds pointer /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 /lint -e661 possible access of out-of-bounds pointer /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 /lint -e662 possible craetion of out-of-bounds pointer /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36
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 /==== INCLUDES =============================================================/
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 #ifdef WIN32
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #include "nucleus.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #endif /* WIN32 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #include "typedefs.h" /* to get Condat data types */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #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	45 #include "macdef.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	46 #include "custom.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #include "gsm.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	48 #include "cnf_uart.h" /* to get cnf-definitions */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #include "mon_uart.h" /* to get mon-definitions */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 #include "prim.h" /* to get the definitions of used SAP and directions */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 #include "dti.h" /* to get dti lib */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #include "pei.h" /* to get PEI interface */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #ifdef FF_MULTI_PORT
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 #include "gsi.h" /* to get definitions of serial driver */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #else /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #ifdef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 #include "uart/serialswitch.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 #include "uart/traceswitch.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 #else /* _TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 #include "serial_dat.h" /* to get definitions of serial driver */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 #endif /* _TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 #endif /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 #include "uart.h" /* to get the global entity definitions */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 #include "uart_kerf.h" /* to get KER function definitions */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 #include "uart_drxs.h" /* to get signal definitions for service DRX */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 #include "uart_dtxs.h" /* to get signal definitions for service DTX */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #ifdef FF_MULTI_PORT
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 #include "uart_ptxs.h" /* to get signal definitions for service TX */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 #else /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 #include "uart_txs.h" /* to get signal definitions for service TX */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 #endif /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 #include "uart_rts.h" /* to get signal definitions for service RT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 #include <string.h> /* JK, delete warnings: to get memmove */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 /==== CONST ================================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 /==== LOCAL VARS ===========================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 /==== PRIVATE FUNCTIONS ====================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 /==== PUBLIC FUNCTIONS =====================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83
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 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 \| Function : ker_setupUart
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 \| Description : The function ker_setupUart() sets the communication parameters
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 \| of UART
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 \| Parameters : no parameter
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 \|
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 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 GLOBAL void ker_setupUart(void)
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 T_UFRET ret; /* Error code returned from a function */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 TRACE_FUNCTION( "ker_setupUart" );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 #ifdef FF_MULTI_PORT
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 * set new XON / XOFF character
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 uart_data->xon = uart_data->ker.act_dcb.XON;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 uart_data->xoff = uart_data->ker.act_dcb.XOFF;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 * set new parameters
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 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 if((ret = GSI_SetConfig(uart_data->device, &uart_data->ker.act_dcb))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 NEQ DRV_OK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 TRACE_ERROR_P2
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 ("GSI driver: Serial devise configuration failed; [%d], uart_kerf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 ret, __LINE__);
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 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 #else /* FF_MULTI_PORT */
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 * set new XON / XOFF character
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 uart_data->xon = uart_data->ker.act_xon;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 uart_data->xoff = uart_data->ker.act_xoff;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 * set new escape sequence parameters
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 uart_data->act_ec = uart_data->ker.act_ec;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 uart_data->act_gp = uart_data->ker.act_gp;
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 * set new parameters
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 * set up the escape sequence
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 ret = UF_SetEscape (uart_data->device,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 uart_data->act_ec,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 uart_data->act_gp);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 #ifdef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 TRACE_EVENT_P1 ("UF_SetEscape() = %x", (USHORT) ret);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 #endif /* _SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 while ((ret = UF_SetComPar (uart_data->device,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 uart_data->ker.act_br,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 uart_data->ker.act_bpc,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 uart_data->ker.act_sb,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 uart_data->ker.act_par)) EQ UF_NOT_READY)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 if(vsi_t_sleep (VSI_CALLER ONE_FRAME) NEQ VSI_OK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 TRACE_ERROR_P1("VSI entity: Can't suspend thread, uart_kerf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 __LINE__);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 }
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
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 * set new flow control
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 if (ret EQ UF_OK)
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 if((ret = UF_SetFlowCtrl (uart_data->device, uart_data->ker.act_fc_rx,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 uart_data->xon, uart_data->xoff) NEQ UF_OK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 AND (uart_data->device NEQ 0))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 TRACE_ERROR_P2("UF driver: Can't set new flow control, [%d], uart_kerf(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 ret, __LINE__);
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 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 #endif /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 } /* ker_setupUart() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172
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 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 \| Function : ker_init
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 \| Description : The function ker_init() initializes the UART
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 \| Parameters : no parameter
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 \|
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 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 GLOBAL void ker_init ()
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 #ifdef FF_MULTI_PORT
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 T_DRV_EXPORT* drv_export;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 #endif /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 T_UFRET ret; /* Error code returned from a function */
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 TRACE_FUNCTION( "ker_init" );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195
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 * initialize values
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 #ifdef FF_MULTI_PORT
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 uart_data->ker.act_dcb.Baud = GSI_BAUD_9600;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 uart_data->ker.act_dcb.DataBits = GSI_CHAR8;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 uart_data->ker.act_dcb.StopBits = GSI_STOP1;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 uart_data->ker.act_dcb.Parity = GSI_PARITYNO;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 uart_data->ker.act_dcb.RxFlowControl = GSI_FLOWHW;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 uart_data->ker.act_dcb.TxFlowControl = GSI_FLOWHW;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 uart_data->ker.act_dcb.RxBufferSize = GSI_MAX_BUFFER_SIZE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 uart_data->ker.act_dcb.TxBufferSize = GSI_MAX_BUFFER_SIZE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 uart_data->ker.act_dcb.RxThreshold = 1;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 uart_data->ker.act_dcb.TxThreshold = 1;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 uart_data->ker.act_dcb.XON = UART_IO_XON_DEFAULT;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 uart_data->ker.act_dcb.XOFF = UART_IO_XOFF_DEFAULT;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 uart_data->ker.act_dcb.EscChar = UART_ESC_CHARACTER_DEFAULT;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 uart_data->ker.act_dcb.GuardPeriod = UART_GUARD_PERIOD_DEFAULT;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 #else /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 uart_data->ker.act_br = UF_BAUD_9600; /* 9600 baud */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 uart_data->ker.act_bpc = bpc_8; /* 8 bits per character */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 uart_data->ker.act_sb = sb_1; /* 1 stop bit */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 uart_data->ker.act_par = pa_none; /* no parity no space */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 uart_data->ker.act_fc_rx = fc_rts; /* Hardware flow control */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 uart_data->ker.act_fc_tx = fc_rts; /* Hardware flow control */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 uart_data->ker.act_xon = UART_IO_XON_DEFAULT; /* XOn character */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 uart_data->ker.act_xoff = UART_IO_XOFF_DEFAULT; /* XOff character */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 uart_data->ker.act_ec = UART_IO_ESC_CHAR_DEFAULT; /* escape character */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 uart_data->ker.act_gp = UART_IO_ESC_GP_DEFAULT; /* guard period */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 #endif /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 /* bitfield of received UART primitives */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 uart_data->ker.received_prim = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 uart_data->ker.flush_state = UART_KER_NOT_FLUSHING;
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 uart_data->ker.rx_data_desc = NULL; /* data received from peer */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 uart_data->ker.receiving_state = UART_KER_NOT_RECEIVING;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 uart_data->ker.tx_data_desc = NULL; /* data to be sent to peer */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 /* data waiting for access to tx_data_desc */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 uart_data->ker.tx_data_waiting = NULL;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 uart_data->ker.sending_state = UART_KER_NOT_SENDING;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 uart_data->ker.data_flow_tx = UART_FLOW_ENABLED;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 uart_data->ker.nr_t1 = 0; /* nr running T1 timers yet */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 uart_data->ker.nr_t2 = 0; /* nr running T2 timers yet */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 uart_data->ker.n2 = 0; /* max nr of retransmissions */
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 #ifdef FF_MULTI_PORT
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 * initialize driver
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 if((ret=GSI_Init(uart_data->device, uart_data->device,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 pei_uart_driver_signal, &drv_export)) NEQ DRV_OK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 TRACE_ERROR_P2("GSI driver: InitSerialDevice failed, [%d], uart_kerf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 ret, __LINE__);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 #endif /* _SIMULATION_ */
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 * set driver signals
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 if((ret = GSI_SetSignal(uart_data->device, DRV_SIGTYPE_READ \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 DRV_SIGTYPE_WRITE \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 DRV_SIGTYPE_FLUSH) NEQ DRV_OK)
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 TRACE_ERROR_P2("GSI entity: SetSignals failed, [%d], uart_kerf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 ret, __LINE__);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 #endif /* _SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 #else /* FF_MULTI_PORT */
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 * initialize driver
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 if((ret = UF_Init (uart_data->device)) NEQ UF_OK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 TRACE_ERROR_P2("UF driver: InitSerialDevice failed, [%d], uart_kerf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 ret, __LINE__);
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 #ifdef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 TRACE_EVENT_P1 ("UF_Init() = %x", (USHORT) ret);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 #endif /* _SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
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 * disable UART
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 if((ret = UF_Enable (uart_data->device, FALSE)) NEQ UF_OK)
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 TRACE_ERROR_P2("UF driver: DisableDriver failed, [%d], uart_kerf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 ret, __LINE__);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 * set buffer size
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 if((ret = UF_SetBuffer (uart_data->device, UF_MAX_BUFFER_SIZE, 1, 1))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 NEQ UF_OK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 TRACE_ERROR_P2("UF driver: SetBufferSize failed, [%d], uart_kerf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 ret, __LINE__);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 #ifdef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 TRACE_EVENT_P1 ("UF_SetBuffer() = %x", (USHORT) ret);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 TRACE_EVENT_P1 ("Buffer avail = %d",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 (USHORT) UF_OutpAvail (uart_data->device));
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 #endif /* _SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 #endif /* FF_MULTI_PORT */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303
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 * set communication parameters
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 ker_setupUart();
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 INIT_STATE( UART_SERVICE_KER , KER_DEAD );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 } /* ker_init() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 \| Function : ker_analyze_frame_info_command
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 \| Description : The function ker_analyze_frame_info_command() analyzes the
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 \| information field of incoming frames.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 \| The appropriate internal signals are triggered and a response
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 \| frame information field is generated.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 \| Precondition is that the frame check sequence has been
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 \| verified, the flags have been removed from the frame and
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 \| message resonses have been removed from the frame.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 \| Parameters : forward - result of analysis
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 \| frame - descriptor which includes frame type
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 \|
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 GLOBAL void ker_analyze_frame_info_command (ULONG* forward, T_desc2* frame)
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 T_DLC* dlc;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 UBYTE dlci;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 USHORT i;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 USHORT pos;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 USHORT len;
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 TRACE_FUNCTION( "ker_analyze_frame_info_command" );
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 pos = UART_OFFSET_INFO;
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 * parse frame info field until last octet is reached
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 * (minimal message has 2 bytes: type + value)
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 while(pos < frame->len)
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 len = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 while(!(frame->buffer[pos + len] & UART_EA))
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 len++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 len+= (frame->buffer[pos + 1] >> UART_MSG_LENGTH_POS) + 2;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 switch(frame->buffer[pos])
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 case UART_MSG_TYPE_CLD_C:
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 * Close Down
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 *forward\|= UART_FORWARD_CLD;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 frame->buffer[pos] = UART_MSG_TYPE_CLD_R;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 case UART_MSG_TYPE_FCON_C:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 * Flow Control On
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 * inform all DRX instances except Control channel
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 uart_data->ker.data_flow_tx = UART_FLOW_ENABLED;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 *forward\|= UART_FORWARD_FCON;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 frame->buffer[pos] = UART_MSG_TYPE_FCON_R;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 case UART_MSG_TYPE_FCOFF_C:
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 * Flow Control Off
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 * inform all DRX instances except Control channel
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 uart_data->ker.data_flow_tx = UART_FLOW_DISABLED;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 *forward\|= UART_FORWARD_FCOFF;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 frame->buffer[pos] = UART_MSG_TYPE_FCOFF_R;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 case UART_MSG_TYPE_MSC_C:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 * Modem Status Command
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 * can be 2 or 3 octets
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 * (depends if break signal is included or not)
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 dlci = frame->buffer[pos+2] >> UART_DLCI_POS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 if((dlci NEQ UART_DLCI_CONTROL) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 (uart_data->dlc_instance[dlci] NEQ UART_EMPTY_INSTANCE))
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 dlc = &uart_data->dlc_table[uart_data->dlc_instance[dlci]];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396
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 * set flow control
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 if(frame->buffer[pos+3] & UART_MSC_FC_MASK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 dlc->lines\|= UART_FC_RX_MASK;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 dlc->lines&= ~UART_FC_RX_MASK;
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 * set line states
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 if(frame->buffer[pos+3] & UART_MSC_RTR_MASK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 dlc->lines&= ~UART_RTS_MASK;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 dlc->lines\|= UART_RTS_MASK;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 if(frame->buffer[pos+3] & UART_MSC_RTC_MASK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 dlc->lines&= ~UART_DTR_MASK;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 dlc->lines\|= UART_DTR_MASK;
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 if((len > 4) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 (frame->buffer[pos+4] & UART_MSC_BRK_MASK))
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 dlc->lines\|= UART_BRK_RX_MASK;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 dlc->lines\|= ((ULONG)(frame->buffer[pos+4] & UART_MSC_BRKLEN_MASK) >>
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 UART_MSC_BRKLEN_POS) <<
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 UART_BRKLEN_RX_POS;
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 *forward\|= UART_FORWARD_MSC;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 }
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 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 TRACE_EVENT( "sig_ker_ker_MSC_C: MSC for control channel or \
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 not established DLC" );
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 frame->buffer[pos] = UART_MSG_TYPE_MSC_R;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 default:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 TRACE_EVENT( "ker_analyze_frame_info_command: received \
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 unsupported message type" );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 * create Non Supported Command response
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 while(!(frame->buffer[pos + i] & UART_EA))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 i++;
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 if(frame->len < uart_data->n1)
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 * move commands behind current command
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 if(frame->len > (pos + len))
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 if(len NEQ (i + 3))
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 memmove(&frame->buffer[pos + i + 3],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 &frame->buffer[pos + len],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 frame->len - pos - len)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 ;/lint !e797 Conceivable creation of out-of-bounds pointer/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 frame->len = frame->len - len + i + 3;
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 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 frame->len = pos + i + 3;
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 * insert Non Supported Command
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 len = i + 3;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 /lint -e669 -e670 (Warning -- data overrun/access beyond array) /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 memmove(&frame->buffer[pos + 2], &frame->buffer[pos], i + 1)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 ;/lint !e803 !e804 Conceivable data overrun and access beyond array/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 /lint +e669 +e670 (Warning -- data overrun/access beyond array) /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 frame->buffer[pos + 1] = (((UBYTE)i + 1) << UART_MSG_LENGTH_POS) \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 UART_EA;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 frame->buffer[pos] = UART_MSG_TYPE_NSC_R;
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 else
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 * remove command
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 if(frame->len > (pos + len))
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 memmove(&frame->buffer[pos],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 &frame->buffer[pos + len],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 frame->len - pos - len);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 frame->len-= len;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 frame->len = pos;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 len = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 pos+= len;
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
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 } /* ker_analyze_frame_info_command() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498
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

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 :

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

4 | Modul :

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 : This modul is part of the entity UART and implements all

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

18 | procedures and functions as described in the

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

19 | SDL-documentation (KER-statemachine)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

20 +-----------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

21 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

22

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

23 #ifndef UART_KERF_C

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

24 #define UART_KERF_C

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

25 #endif /* !UART_KERF_C */

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 #define ENTITY_UART

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 * Turn off spurious LINT warnings

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 /*lint -e415 access of out-of-bounds pointer */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

33 /*lint -e416 creation of out-of-bounds pointer */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

34 /*lint -e661 possible access of out-of-bounds pointer */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

35 /*lint -e662 possible craetion of out-of-bounds pointer */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

36

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 /*==== INCLUDES =============================================================*/

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 #ifdef WIN32

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

41 #include "nucleus.h"

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

42 #endif /* WIN32 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

43 #include "typedefs.h" /* to get Condat data types */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

44 #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

45 #include "macdef.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

46 #include "custom.h"

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

47 #include "gsm.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

48 #include "cnf_uart.h" /* to get cnf-definitions */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

49 #include "mon_uart.h" /* to get mon-definitions */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

50 #include "prim.h" /* to get the definitions of used SAP and directions */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

51 #include "dti.h" /* to get dti lib */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

52 #include "pei.h" /* to get PEI interface */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

53 #ifdef FF_MULTI_PORT

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

54 #include "gsi.h" /* to get definitions of serial driver */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

55 #else /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

56 #ifdef _TARGET_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

57 #include "uart/serialswitch.h"

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

58 #include "uart/traceswitch.h"

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

59 #else /* _TARGET_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

60 #include "serial_dat.h" /* to get definitions of serial driver */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

61 #endif /* _TARGET_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

62 #endif /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

63 #include "uart.h" /* to get the global entity definitions */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

64

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

65 #include "uart_kerf.h" /* to get KER function definitions */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

66 #include "uart_drxs.h" /* to get signal definitions for service DRX */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

67 #include "uart_dtxs.h" /* to get signal definitions for service DTX */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

68 #ifdef FF_MULTI_PORT

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

69 #include "uart_ptxs.h" /* to get signal definitions for service TX */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

70 #else /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

71 #include "uart_txs.h" /* to get signal definitions for service TX */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

72 #endif /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

73 #include "uart_rts.h" /* to get signal definitions for service RT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

74 #include <string.h> /* JK, delete warnings: to get memmove */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

75 /*==== CONST ================================================================*/

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

76

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

77 /*==== LOCAL VARS ===========================================================*/

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

78

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

79 /*==== PRIVATE FUNCTIONS ====================================================*/

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

80

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

81 /*==== PUBLIC FUNCTIONS =====================================================*/

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

82

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

83

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 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

87 | Function : ker_setupUart

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 | Description : The function ker_setupUart() sets the communication parameters

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

90 | of UART

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 | Parameters : no parameter

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

93 |

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 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

96 GLOBAL void ker_setupUart(void)

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 T_UFRET ret; /* Error code returned from a function */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

99

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

100 TRACE_FUNCTION( "ker_setupUart" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

101

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

102 #ifdef FF_MULTI_PORT

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 * set new XON / XOFF character

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

105 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

106 uart_data->xon = uart_data->ker.act_dcb.XON;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

107 uart_data->xoff = uart_data->ker.act_dcb.XOFF;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

108 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

109 * set new parameters

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 #ifndef _SIMULATION_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

112 if((ret = GSI_SetConfig(uart_data->device, &uart_data->ker.act_dcb))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

113 NEQ DRV_OK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

114 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

115 TRACE_ERROR_P2

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

116 ("GSI driver: Serial devise configuration failed; [%d], uart_kerf.c(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

117 ret, __LINE__);

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 #endif /* !_SIMULATION_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

120 #else /* FF_MULTI_PORT */

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 * set new XON / XOFF character

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

123 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

124 uart_data->xon = uart_data->ker.act_xon;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

125 uart_data->xoff = uart_data->ker.act_xoff;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

126 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

127 * set new escape sequence parameters

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 uart_data->act_ec = uart_data->ker.act_ec;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

130 uart_data->act_gp = uart_data->ker.act_gp;

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 * set new parameters

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

133 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

134 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

135 * set up the escape sequence

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

136 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

137 ret = UF_SetEscape (uart_data->device,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

138 uart_data->act_ec,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

139 uart_data->act_gp);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

140 #ifdef _SIMULATION_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

141 TRACE_EVENT_P1 ("UF_SetEscape() = %x", (USHORT) ret);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

142 #endif /* _SIMULATION_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

143 while ((ret = UF_SetComPar (uart_data->device,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

144 uart_data->ker.act_br,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

145 uart_data->ker.act_bpc,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

146 uart_data->ker.act_sb,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

147 uart_data->ker.act_par)) EQ UF_NOT_READY)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

148 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

149 if(vsi_t_sleep (VSI_CALLER ONE_FRAME) NEQ VSI_OK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

150 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

151 TRACE_ERROR_P1("VSI entity: Can't suspend thread, uart_kerf.c(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

152 __LINE__);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

153 }

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

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 * set new flow control

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

158 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

159 if (ret EQ UF_OK)

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 if((ret = UF_SetFlowCtrl (uart_data->device, uart_data->ker.act_fc_rx,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

162 uart_data->xon, uart_data->xoff) NEQ UF_OK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

163 AND (uart_data->device NEQ 0))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

164 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

165 TRACE_ERROR_P2("UF driver: Can't set new flow control, [%d], uart_kerf(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

166 ret, __LINE__);

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 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

169 #endif /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

170 } /* ker_setupUart() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

171

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

172

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 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

176 | Function : ker_init

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 | Description : The function ker_init() initializes the UART

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

179 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

180 | Parameters : no parameter

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

181 |

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 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

184 GLOBAL void ker_init ()

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 #ifdef FF_MULTI_PORT

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

187 #ifndef _SIMULATION_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

188 T_DRV_EXPORT* drv_export;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

189 #endif /* !_SIMULATION_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

190 #endif /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

191

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

192 T_UFRET ret; /* Error code returned from a function */

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 TRACE_FUNCTION( "ker_init" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

195

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 * initialize values

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

198 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

199 #ifdef FF_MULTI_PORT

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

200 uart_data->ker.act_dcb.Baud = GSI_BAUD_9600;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

201 uart_data->ker.act_dcb.DataBits = GSI_CHAR8;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

202 uart_data->ker.act_dcb.StopBits = GSI_STOP1;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

203 uart_data->ker.act_dcb.Parity = GSI_PARITYNO;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

204 uart_data->ker.act_dcb.RxFlowControl = GSI_FLOWHW;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

205 uart_data->ker.act_dcb.TxFlowControl = GSI_FLOWHW;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

206 uart_data->ker.act_dcb.RxBufferSize = GSI_MAX_BUFFER_SIZE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

207 uart_data->ker.act_dcb.TxBufferSize = GSI_MAX_BUFFER_SIZE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

208 uart_data->ker.act_dcb.RxThreshold = 1;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

209 uart_data->ker.act_dcb.TxThreshold = 1;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

210 uart_data->ker.act_dcb.XON = UART_IO_XON_DEFAULT;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

211 uart_data->ker.act_dcb.XOFF = UART_IO_XOFF_DEFAULT;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

212 uart_data->ker.act_dcb.EscChar = UART_ESC_CHARACTER_DEFAULT;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

213 uart_data->ker.act_dcb.GuardPeriod = UART_GUARD_PERIOD_DEFAULT;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

214 #else /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

215 uart_data->ker.act_br = UF_BAUD_9600; /* 9600 baud */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

216 uart_data->ker.act_bpc = bpc_8; /* 8 bits per character */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

217 uart_data->ker.act_sb = sb_1; /* 1 stop bit */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

218 uart_data->ker.act_par = pa_none; /* no parity no space */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

219 uart_data->ker.act_fc_rx = fc_rts; /* Hardware flow control */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

220 uart_data->ker.act_fc_tx = fc_rts; /* Hardware flow control */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

221 uart_data->ker.act_xon = UART_IO_XON_DEFAULT; /* XOn character */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

222 uart_data->ker.act_xoff = UART_IO_XOFF_DEFAULT; /* XOff character */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

223 uart_data->ker.act_ec = UART_IO_ESC_CHAR_DEFAULT; /* escape character */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

224 uart_data->ker.act_gp = UART_IO_ESC_GP_DEFAULT; /* guard period */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

225 #endif /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

226

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

227 /* bitfield of received UART primitives */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

228 uart_data->ker.received_prim = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

229 uart_data->ker.flush_state = UART_KER_NOT_FLUSHING;

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 uart_data->ker.rx_data_desc = NULL; /* data received from peer */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

232 uart_data->ker.receiving_state = UART_KER_NOT_RECEIVING;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

233

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

234 uart_data->ker.tx_data_desc = NULL; /* data to be sent to peer */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

235 /* data waiting for access to tx_data_desc */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

236 uart_data->ker.tx_data_waiting = NULL;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

237 uart_data->ker.sending_state = UART_KER_NOT_SENDING;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

238 uart_data->ker.data_flow_tx = UART_FLOW_ENABLED;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

239 uart_data->ker.nr_t1 = 0; /* nr running T1 timers yet */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

240 uart_data->ker.nr_t2 = 0; /* nr running T2 timers yet */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

241 uart_data->ker.n2 = 0; /* max nr of retransmissions */

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 #ifdef FF_MULTI_PORT

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

244 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

245 * initialize driver

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

246 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

247 #ifndef _SIMULATION_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

248 if((ret=GSI_Init(uart_data->device, uart_data->device,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

249 pei_uart_driver_signal, &drv_export)) NEQ DRV_OK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

250 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

251 TRACE_ERROR_P2("GSI driver: InitSerialDevice failed, [%d], uart_kerf.c(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

252 ret, __LINE__);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

253 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

254 #endif /* _SIMULATION_ */

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 * set driver signals

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

257 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

258 #ifndef _SIMULATION_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

259 if((ret = GSI_SetSignal(uart_data->device, DRV_SIGTYPE_READ |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

260 DRV_SIGTYPE_WRITE |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

261 DRV_SIGTYPE_FLUSH) NEQ DRV_OK)

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 TRACE_ERROR_P2("GSI entity: SetSignals failed, [%d], uart_kerf.c(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

264 ret, __LINE__);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

265 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

266 #endif /* _SIMULATION_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

267 #else /* FF_MULTI_PORT */

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 * initialize driver

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

270 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

271 if((ret = UF_Init (uart_data->device)) NEQ UF_OK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

272 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

273 TRACE_ERROR_P2("UF driver: InitSerialDevice failed, [%d], uart_kerf.c(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

274 ret, __LINE__);

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 #ifdef _SIMULATION_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

277 TRACE_EVENT_P1 ("UF_Init() = %x", (USHORT) ret);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

278 #endif /* _SIMULATION_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

279

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 * disable UART

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

282 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

283 if((ret = UF_Enable (uart_data->device, FALSE)) NEQ UF_OK)

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 TRACE_ERROR_P2("UF driver: DisableDriver failed, [%d], uart_kerf.c(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

286 ret, __LINE__);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

287 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

288 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

289 * set buffer size

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 if((ret = UF_SetBuffer (uart_data->device, UF_MAX_BUFFER_SIZE, 1, 1))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

292 NEQ UF_OK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

293 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

294 TRACE_ERROR_P2("UF driver: SetBufferSize failed, [%d], uart_kerf.c(%d)",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

295 ret, __LINE__);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

296 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

297 #ifdef _SIMULATION_

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

298 TRACE_EVENT_P1 ("UF_SetBuffer() = %x", (USHORT) ret);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

299 TRACE_EVENT_P1 ("Buffer avail = %d",

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

300 (USHORT) UF_OutpAvail (uart_data->device));

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

301 #endif /* _SIMULATION_ */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

302 #endif /* FF_MULTI_PORT */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

303

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 * set communication parameters

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

306 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

307 ker_setupUart();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

308

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

309 INIT_STATE( UART_SERVICE_KER , KER_DEAD );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

310

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

311 } /* ker_init() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

312

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

313

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

314

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

315 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

316 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

317 | Function : ker_analyze_frame_info_command

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

318 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

319 | Description : The function ker_analyze_frame_info_command() analyzes the

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

320 | information field of incoming frames.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

321 | The appropriate internal signals are triggered and a response

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

322 | frame information field is generated.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

323 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

324 | Precondition is that the frame check sequence has been

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

325 | verified, the flags have been removed from the frame and

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

326 | message resonses have been removed from the frame.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

327 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

328 | Parameters : forward - result of analysis

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

329 | frame - descriptor which includes frame type

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

330 |

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 GLOBAL void ker_analyze_frame_info_command (ULONG* forward, T_desc2* frame)

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 T_DLC* dlc;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

336 UBYTE dlci;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

337 USHORT i;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

338 USHORT pos;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

339 USHORT len;

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 TRACE_FUNCTION( "ker_analyze_frame_info_command" );

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 pos = UART_OFFSET_INFO;

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 * parse frame info field until last octet is reached

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

347 * (minimal message has 2 bytes: type + value)

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 while(pos < frame->len)

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 len = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

352 while(!(frame->buffer[pos + len] & UART_EA))

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 len++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

355 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

356 len+= (frame->buffer[pos + 1] >> UART_MSG_LENGTH_POS) + 2;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

357 switch(frame->buffer[pos])

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

358 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

359 case UART_MSG_TYPE_CLD_C:

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 * Close Down

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

362 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

363 *forward|= UART_FORWARD_CLD;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

364 frame->buffer[pos] = UART_MSG_TYPE_CLD_R;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

365 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

366 case UART_MSG_TYPE_FCON_C:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

367 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

368 * Flow Control On

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

369 * inform all DRX instances except Control channel

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

370 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

371 uart_data->ker.data_flow_tx = UART_FLOW_ENABLED;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

372 *forward|= UART_FORWARD_FCON;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

373 frame->buffer[pos] = UART_MSG_TYPE_FCON_R;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

374 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

375 case UART_MSG_TYPE_FCOFF_C:

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 * Flow Control Off

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

378 * inform all DRX instances except Control channel

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 uart_data->ker.data_flow_tx = UART_FLOW_DISABLED;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

381 *forward|= UART_FORWARD_FCOFF;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

382 frame->buffer[pos] = UART_MSG_TYPE_FCOFF_R;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

383 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

384 case UART_MSG_TYPE_MSC_C:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

385 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

386 * Modem Status Command

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

387 * can be 2 or 3 octets

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

388 * (depends if break signal is included or not)

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 dlci = frame->buffer[pos+2] >> UART_DLCI_POS;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

391

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

392 if((dlci NEQ UART_DLCI_CONTROL) &&

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

393 (uart_data->dlc_instance[dlci] NEQ UART_EMPTY_INSTANCE))

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 dlc = &uart_data->dlc_table[uart_data->dlc_instance[dlci]];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

396

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 * set flow control

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 if(frame->buffer[pos+3] & UART_MSC_FC_MASK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

401 dlc->lines|= UART_FC_RX_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

402 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

403 dlc->lines&= ~UART_FC_RX_MASK;

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

406 * set line states

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 if(frame->buffer[pos+3] & UART_MSC_RTR_MASK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

409 dlc->lines&= ~UART_RTS_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

410 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

411 dlc->lines|= UART_RTS_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

412

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

413 if(frame->buffer[pos+3] & UART_MSC_RTC_MASK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

414 dlc->lines&= ~UART_DTR_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

415 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

416 dlc->lines|= UART_DTR_MASK;

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 if((len > 4) &&

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

419 (frame->buffer[pos+4] & UART_MSC_BRK_MASK))

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 dlc->lines|= UART_BRK_RX_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

422 dlc->lines|= ((ULONG)(frame->buffer[pos+4] & UART_MSC_BRKLEN_MASK) >>

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

423 UART_MSC_BRKLEN_POS) <<

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

424 UART_BRKLEN_RX_POS;

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 *forward|= UART_FORWARD_MSC;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

427 }

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 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

430 TRACE_EVENT( "sig_ker_ker_MSC_C: MSC for control channel or \

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

431 not established DLC" );

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 frame->buffer[pos] = UART_MSG_TYPE_MSC_R;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

434 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

435 default:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

436 TRACE_EVENT( "ker_analyze_frame_info_command: received \

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

437 unsupported message type" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

438 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

439 * create Non Supported Command response

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

440 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

441 i = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

442 while(!(frame->buffer[pos + i] & UART_EA))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

443 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

444 i++;

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 if(frame->len < uart_data->n1)

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

449 * move commands behind current command

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

450 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

451 if(frame->len > (pos + len))

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 if(len NEQ (i + 3))

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 memmove(&frame->buffer[pos + i + 3],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

456 &frame->buffer[pos + len],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

457 frame->len - pos - len)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

458 ;/*lint !e797 Conceivable creation of out-of-bounds pointer*/

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

459 frame->len = frame->len - len + i + 3;

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 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

463 frame->len = pos + i + 3;

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 * insert Non Supported Command

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 len = i + 3;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

468 /*lint -e669 -e670 (Warning -- data overrun/access beyond array) */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

469 memmove(&frame->buffer[pos + 2], &frame->buffer[pos], i + 1)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

470 ;/*lint !e803 !e804 Conceivable data overrun and access beyond array*/

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

471 /*lint +e669 +e670 (Warning -- data overrun/access beyond array) */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

472 frame->buffer[pos + 1] = (((UBYTE)i + 1) << UART_MSG_LENGTH_POS) |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

473 UART_EA;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

474 frame->buffer[pos] = UART_MSG_TYPE_NSC_R;

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 else

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

479 * remove command

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

480 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

481 if(frame->len > (pos + len))

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 memmove(&frame->buffer[pos],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

484 &frame->buffer[pos + len],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

485 frame->len - pos - len);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

486 frame->len-= len;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

487 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

488 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

489 frame->len = pos;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

490 len = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

491 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

492 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

493 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

494 pos+= len;

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

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

497 } /* ker_analyze_frame_info_command() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

498

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

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 | Function : ker_search_msg_type

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 | Description : The function ker_search_msg_type() searches for a message type

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

506 | in a frame.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

507 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

508 | Parameters : frame - descriptor which includes message type

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

509 | pos - position to start searching

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

510 | type - message type to search for

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 | Return : indicator whether message type was found

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 +------------------------------------------------------------------------------

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 LOCAL BOOL ker_search_msg_type (T_desc2* frame, USHORT* pos, UBYTE type)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

517 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

518 TRACE_FUNCTION( "ker_search_msg_type" );

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 while(*pos < frame->len)

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 if(frame->buffer[*pos] EQ type)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

523 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

524 return TRUE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

525 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

526 *pos+= (frame->buffer[*pos + 1] >> UART_MSG_LENGTH_POS) + 2;

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 return FALSE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

529 } /* ker_search_msg_type() */

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

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

532

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 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

535 | Function : ker_analyze_frame_info_resonse

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

536 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

537 | Description : The function ker_analyze_frame_info_response() analyzes the

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

538 | information field of incoming frames.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

539 | The appropriate internal signals are triggered and the

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

540 | responses are removed from the information field.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

541 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

542 | Precondition is that the frame check sequence has been verified

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

543 | and that the flags have been removed from the frame.

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 | Parameters : forward - result of analysis

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

546 | frame - descriptor which includes frame type

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 +------------------------------------------------------------------------------

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 GLOBAL void ker_analyze_frame_info_response (ULONG* forward, T_desc2* frame)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

551 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

552 USHORT pos;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

553 USHORT len;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

554 T_DLC* dlc;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

555 ULONG forward_value;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

556 USHORT search_pos;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

557 USHORT search_len;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

558 UBYTE search_command;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

559 BOOL search_found;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

560 BOOL search_whole_msg;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

561 USHORT i;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

562

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

563 TRACE_FUNCTION( "ker_analyze_frame_info_response" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

564

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 * check for correct message structure:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

567 * - minimal message length == 2 octets

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

568 * - frame must end with the last message

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

569 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

570 pos = UART_OFFSET_INFO;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

571 while(pos < frame->len)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

572 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

573 len = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

574 if(!(frame->buffer[pos] & UART_EA))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

575 {

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 * Type field greater than one octet

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

578 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

579 do

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

580 len++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

581 while(((pos + len) < frame->len) &&

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

582 (!(frame->buffer[pos + len] & UART_EA)));

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 if(((pos + len + 1) < frame->len) &&

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

585 (frame->buffer[pos + len + 1] & UART_EA))

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 len+= (frame->buffer[pos + 1] >> UART_MSG_LENGTH_POS) + 2;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

588 if((pos + len) > frame->len)

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 * given length in length field to long

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

591 * remove information field

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 frame->len = UART_OFFSET_INFO;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

594 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

595 pos += len;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

596 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

597 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

598 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

599 * one octet length field expected, but not found

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

600 * remove information field

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 frame->len = UART_OFFSET_INFO;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

603 }

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 * parse frame info field until last octet is reached

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

606 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

607 pos = UART_OFFSET_INFO;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

608 while(pos < frame->len)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

609 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

610 len = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

611 while(!(frame->buffer[pos + len] & UART_EA))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

612 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

613 len++;

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 len+= (frame->buffer[pos + 1] >> UART_MSG_LENGTH_POS) + 2;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

616 if(frame->buffer[pos] & UART_CR)

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

619 * command detected move to next message

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

620 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

621 pos+= len;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

622 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

623 else

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

626 * analyze response message

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 switch( frame->buffer[pos] )

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 case UART_MSG_TYPE_CLD_R:

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 * Close Down

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 dlc = &uart_data->dlc_table[UART_CONTROL_INSTANCE];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

635 search_command = UART_MSG_TYPE_CLD_C;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

636 forward_value = UART_FORWARD_CLD;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

637 search_whole_msg = TRUE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

638 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

639

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

640 case UART_MSG_TYPE_FCON_R:

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 * Flow Control On

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

643 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

644 dlc = &uart_data->dlc_table[UART_CONTROL_INSTANCE];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

645 search_command = UART_MSG_TYPE_FCON_C;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

646 forward_value = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

647 search_whole_msg = TRUE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

648 break;

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 case UART_MSG_TYPE_FCOFF_R:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

651 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

652 * Flow Control Off

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 dlc = &uart_data->dlc_table[UART_CONTROL_INSTANCE];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

655 search_command = UART_MSG_TYPE_FCOFF_C;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

656 forward_value = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

657 search_whole_msg = TRUE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

658 break;

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 case UART_MSG_TYPE_MSC_R:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

661 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

662 * Modem Status Command

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

663 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

664 dlc = &uart_data->dlc_table[UART_CONTROL_INSTANCE];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

665 search_command = UART_MSG_TYPE_MSC_C;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

666 forward_value = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

667 search_whole_msg = TRUE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

668 break;

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 case UART_MSG_TYPE_NSC_R:

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 * not supported command,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

673 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

674 dlc = &uart_data->dlc_table[UART_CONTROL_INSTANCE];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

675 if(len > 2)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

676 search_command = frame->buffer[pos + 2];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

677 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

678 search_command = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

679 switch(search_command)

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 case UART_MSG_TYPE_CLD_C:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

682 forward_value = UART_FORWARD_CLD;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

683 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

684 default:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

685 forward_value = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

686 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

687 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

688 search_whole_msg = FALSE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

689 break;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

690

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

691 default:

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

692 TRACE_ERROR( "Error in ker_analyze_frame_info_response: \

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

693 Unsupported message type received");

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

694 dlc = &uart_data->dlc_table[UART_CONTROL_INSTANCE];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

695 search_command = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

696 forward_value = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

697 search_whole_msg = TRUE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

698 break;

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

701 * search and remove command message

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 if(dlc->last_command NEQ NULL)

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 search_pos = UART_OFFSET_INFO;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

706 search_found = FALSE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

707 while((search_found EQ FALSE) &&

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

708 (ker_search_msg_type(dlc->last_command,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

709 &search_pos,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

710 search_command) EQ TRUE))

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 search_len = (dlc->last_command->buffer[search_pos + 1] >>

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

713 UART_MSG_LENGTH_POS) + 2;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

714 search_found = TRUE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

715 if(search_whole_msg EQ TRUE)

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 * check whole message

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

719 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

720 for(i=1; i < search_len; i++)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

721 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

722 if(dlc->last_command->buffer[search_pos + i] NEQ

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

723 frame->buffer[pos + i])

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

724 search_found = FALSE;

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 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

727 if(search_found EQ TRUE)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

728 {

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 * corresponding command message found

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

731 * remove it

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 if(dlc->last_command->len > (search_pos + search_len))

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 memmove(&dlc->last_command->buffer[search_pos],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

736 &dlc->last_command->buffer[search_pos + search_len],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

737 dlc->last_command->len - search_pos - search_len);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

738 dlc->last_command->len-= search_len;

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 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

741 dlc->last_command->len = search_pos;

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 * set retransmissions to zero and

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

744 * set forward parameter

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 dlc->retransmissions = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

747 *forward |= forward_value;

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 else

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 search_pos+= search_len;

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 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

754 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

755 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

756 * remove resonse message

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 if(frame->len > (pos + len))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

759 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

760 memmove(&frame->buffer[pos],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

761 &frame->buffer[pos + len],

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

762 frame->len - pos - len);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

763 frame->len-= len;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

764 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

765 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

766 frame->len = pos;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

767 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

768 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

769 } /* ker_analyze_frame_info_response() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

770

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

771

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

772

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

773 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

774 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

775 | Function : ker_mux_dlc_release

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 | Description : This function closes one open multiplexer channel

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 | Parameters : dlc_instance - instance of dlc to release

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

780 |

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 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

783 GLOBAL void ker_mux_dlc_release (UBYTE dlc_instance)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

784 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

785 T_DLC* dlc;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

786 UBYTE dlci;

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 TRACE_FUNCTION( "ker_mux_dlc_release" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

789

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 * set dlc values

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 dlc = &uart_data->dlc_table[dlc_instance];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

794 dlci = dlc->dlci;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

795 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

796 * stop timer if this was the last running,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

797 * free copy of last command frame

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 if(dlc->last_command NEQ NULL)

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(dlc->last_command->buffer[UART_OFFSET_CONTROL] EQ

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

802 UART_UIH_CONTROL_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 uart_data->ker.nr_t2--;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

805 if( uart_data->ker.nr_t2 EQ 0 )

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

806 sig_ker_rt_stop_t2_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

807 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

808 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

809 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

810 uart_data->ker.nr_t1--;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

811 if( uart_data->ker.nr_t1 EQ 0 )

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

812 sig_ker_rt_stop_t1_req();

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 MFREE_DESC2(dlc->last_command);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

815 dlc->last_command = NULL;

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 * set connection state

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 dlc->connection_state = UART_CONNECTION_DEAD;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

821 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

822 * remove DLC instance

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

823 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

824 if(dlc->next_command NEQ NULL)

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 MFREE_DESC2(dlc->next_command);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

827 dlc->next_command = NULL;

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 uart_data->dlc_instance[dlci] = UART_EMPTY_INSTANCE;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

830 dlc->dlci = UART_DLCI_INVALID;

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 * close DTI connection

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

833 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

834 uart_data->drx = dlc->drx;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

835 uart_data->dtx = dlc->dtx;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

836 sig_ker_drx_dead_mode_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

837 sig_ker_dtx_dead_mode_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

838 if(dlc->dti_state NEQ DTI_CLOSED)

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 dti_close(uart_hDTI, uart_data->device,

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

841 UART_DTI_UP_INTERFACE, dlc_instance, FALSE);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

842 dlc->dti_state = DTI_CLOSED;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

843 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

844 } /* ker_mux_dlc_release() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

845

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

846

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 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

850 | Function : ker_mux_close_down

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

851 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

852 | Description : This function closes all currently open multiplexer channels.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

853 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

854 | Parameters : no parameter

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

855 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

856 +------------------------------------------------------------------------------

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 GLOBAL void ker_mux_close_down ()

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

859 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

860 UBYTE i;

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 TRACE_FUNCTION( "ker_mux_close_down" );

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 * close all channels

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

866 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

867 for(i = 0; i <= UART_MAX_NUMBER_OF_CHANNELS; i++)

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

870 * set dlc values

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

871 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

872 if(uart_data->dlc_table[i].dlci NEQ UART_DLCI_INVALID)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

873 ker_mux_dlc_release(i);

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 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

876 * stop timers

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

877 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

878 uart_data->ker.nr_t1 = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

879 sig_ker_rt_stop_t1_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

880 uart_data->ker.nr_t2 = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

881 sig_ker_rt_stop_t2_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

882 sig_ker_rt_stop_t3_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

883

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

884 } /* ker_mux_close_down() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

885

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 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

888 | Function : ker_mux_send_frame

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

889 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

890 | Description : This function is used to send out a frame in multiplexer mode.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

891 | It checks if the KER service is currently sending. If not, the

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

892 | descriptor is put in the output queue for the TX service and

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

893 | the service is notified that data is available. If the KER

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

894 | service is in state sending, the descriptor is put in a second

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

895 | queue for later processing.

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 | Parameters : frame - descriptor with frame to send

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

898 |

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 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

901 GLOBAL void ker_mux_send_frame (T_desc2* frame)

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 T_desc2* desc;

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 TRACE_FUNCTION( "ker_mux_send_frame" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

906

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

907 if(uart_data->ker.tx_data_desc)

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 * currently sending, put frame in waiting queue

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

911 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

912 desc = uart_data->ker.tx_data_waiting;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

913 if(desc)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

914 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

915 while(desc->next NEQ (ULONG)NULL)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

916 desc = (T_desc2*)desc->next;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

917 desc->next = (ULONG)frame;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

918 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

919 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

920 uart_data->ker.tx_data_waiting = frame;

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 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

923 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

924 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

925 * send frame immediately

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

926 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

927 uart_data->ker.tx_data_desc = frame;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

928 sig_ker_tx_data_available_req(uart_data->ker.tx_data_desc, 0);

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 } /* ker_mux_send_frame() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

931

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

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 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

936 | Function : ker_mux_send_command_frame

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 | Description : This function is used to send out a command frame in

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

939 | multiplexer mode.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

940 | It enables the response timer and saves a copy of the

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

941 | command frame in the DLC's last_command variable so the

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

942 | frame can be retransmitted if the timer expires.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

943 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

944 | Parameters : dlc_instance - dlc instance the command frame belongs to

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

945 | frame - descriptor with command frame to send

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

946 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

947 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

948 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

949 GLOBAL void ker_mux_send_command_frame (UBYTE dlc_instance, T_desc2* frame)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

950 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

951 T_DLC* dlc;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

952 T_desc2* desc;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

953

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

954 TRACE_FUNCTION( "ker_mux_send_command_frame" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

955

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

956 dlc = &uart_data->dlc_table[dlc_instance];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

957 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

958 * copy frame

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

959 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

960 if(dlc->last_command NEQ NULL)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

961 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

962 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

963 * currently sending, put command frame in waiting queue

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

964 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

965 desc = dlc->next_command;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

966 if(desc)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

967 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

968 while(desc->next NEQ (ULONG)NULL)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

969 desc = (T_desc2*)desc->next;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

970 desc->next = (ULONG)frame;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

971 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

972 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

973 dlc->next_command = frame;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

974 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

975 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

976 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

977 MALLOC(dlc->last_command, (USHORT)(sizeof( T_desc2 ) - 1 +

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

978 frame->len));

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

979

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

980 dlc->last_command->next = (ULONG)NULL;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

981 dlc->last_command->len = frame->len;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

982 memcpy(dlc->last_command->buffer, frame->buffer, frame->len);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

983

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

984 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

985 * set response timer and counter

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

986 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

987 dlc->retransmissions = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

988 if(frame->buffer[UART_OFFSET_CONTROL] EQ UART_UIH_CONTROL_FRAME)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

989 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

990 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

991 * usual UIH Command frame

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

992 * use T2 timer

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

993 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

994 uart_data->ker.nr_t2++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

995 sig_ker_rt_start_t2_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

996 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

997 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

998 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

999 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1000 * DISC frame

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1001 * use T1 timer

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1002 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1003 uart_data->ker.nr_t1++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1004 sig_ker_rt_start_t1_req();

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1005 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1006

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1007 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1008 * use the usual frame send function to transmit the frame

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1009 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1010 ker_mux_send_frame( frame );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1011 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1012 } /* ker_mux_send_command_frame() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1013

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1014

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1015

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1016 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1017 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1018 | Function : ker_mux_send_line_states

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1019 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1020 | Description : This function is used to send out a frame in multiplexer mode.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1021 | It creates an UIH frame with MSC command and includes new line

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1022 | states.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1023 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1024 | Parameters : dlc_instance - instance of DLC

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1025 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1026 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1027 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1028 GLOBAL void ker_mux_send_line_states(UBYTE dlc_instance)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1029 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1030 T_DLC* dlc;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1031 T_desc2* frame;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1032 USHORT pos;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1033 ULONG line_states;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1034

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1035 TRACE_FUNCTION( "ker_mux_send_line_states" );

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1036

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1037 dlc = &uart_data->dlc_table[dlc_instance];

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1038 line_states = dlc->lines;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1039 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1040 * allocate memory

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1041 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1042 MALLOC(frame, (USHORT)(sizeof( T_desc2 ) - 1 + uart_data->n1 + 2));

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1043 frame->next = (ULONG)NULL;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1044

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1045 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1046 * fill frame

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1047 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1048 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1049 * address field

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1050 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1051 pos = 0;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1052 frame->buffer[pos] = (UART_DLCI_CONTROL << UART_DLCI_POS) | UART_EA;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1053 pos++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1054 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1055 * control field

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1056 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1057 frame->buffer[pos] = UART_UIH_CONTROL_FRAME;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1058 pos++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1059 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1060 * type field

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1061 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1062 frame->buffer[pos] = UART_MSG_TYPE_MSC_C;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1063 pos++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1064 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1065 * length field

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1066 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1067 if(line_states & UART_BRK_TX_MASK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1068 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1069 * length 3 with break field

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1070 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1071 frame->buffer[pos] = (3 << UART_MSG_LENGTH_POS) | UART_EA;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1072 else

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1073 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1074 * length 2 without break field

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1075 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1076 frame->buffer[pos] = (2 << UART_MSG_LENGTH_POS) | UART_EA;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1077 pos++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1078 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1079 * DLCI field

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1080 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1081 frame->buffer[pos] = (dlc->dlci << UART_DLCI_POS) | UART_CR | UART_EA;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1082 pos++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1083 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1084 * V.24 signals

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1085 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1086 frame->buffer[pos] = UART_EA;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1087 if(!(line_states & UART_DCD_MASK))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1088 frame->buffer[pos] |= UART_MSC_DV_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1089

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1090 if(line_states & UART_RI_MASK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1091 frame->buffer[pos] |= UART_MSC_IC_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1092

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1093 if(!(line_states & UART_CTS_MASK))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1094 frame->buffer[pos] |= UART_MSC_RTR_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1095

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1096 if(!(line_states & UART_DSR_MASK))

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1097 frame->buffer[pos] |= UART_MSC_RTC_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1098

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1099 if(line_states & UART_FC_TX_MASK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1100 frame->buffer[pos] |= UART_MSC_FC_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1101

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1102 pos++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1103

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1104 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1105 * break signal

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1106 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1107 if(line_states & UART_BRK_TX_MASK)

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1108 {

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1109 frame->buffer[pos] = (((UBYTE)((line_states & UART_BRKLEN_TX_MASK) >>

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1110 UART_BRKLEN_TX_POS)) <<

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1111 UART_MSC_BRKLEN_POS) |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1112 UART_MSC_BRK_MASK |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1113 UART_EA;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1114 pos++;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1115 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1116 * break sent, so clear break flag

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1117 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1118 dlc->lines&= ~UART_BRK_TX_MASK;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1119 }

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1120

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1121

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1122 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1123 * send frame

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1124 */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1125 frame->len = pos;

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1126 ker_mux_send_command_frame(UART_CONTROL_INSTANCE, frame);

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1127

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1128 } /* ker_mux_send_line_states() */

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1129

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1130

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1131

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1132 /*

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1133 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1134 | Function : ker_mux_send_close_down

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1135 +------------------------------------------------------------------------------

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1136 | Description : This function is used to send out a frame in multiplexer mode.

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1137 | It creates an UIH frame with CLD command

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1138 |

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

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1139 | Parameters : no parameters

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1140 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1141 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1142 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1143 GLOBAL void ker_mux_send_close_down()

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1144 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1145 T_desc2* frame;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1146 USHORT pos;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1147

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1148 TRACE_FUNCTION( "ker_mux_send_close_down" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1149

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1150 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1151 * allocate memory

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1152 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1153 MALLOC(frame, (USHORT)(sizeof( T_desc2 ) - 1 + uart_data->n1 + 2));

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1154 frame->next = (ULONG)NULL;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1155

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1156 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1157 * fill frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1158 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1159 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1160 * address field

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1161 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1162 pos = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1163 frame->buffer[pos] = (UART_DLCI_CONTROL << UART_DLCI_POS) | UART_EA;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1164 pos++;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1165 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1166 * control field

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1167 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1168 frame->buffer[pos] = UART_UIH_CONTROL_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1169 pos++;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1170 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1171 * type field

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1172 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1173 frame->buffer[pos] = UART_MSG_TYPE_CLD_C;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1174 pos++;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1175 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1176 * length field

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1177 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1178 frame->buffer[pos] = UART_EA;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1179 pos++;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1180

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1181 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1182 * send frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1183 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1184 frame->len = pos;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1185 frame->size = pos;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1186 frame->offset = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1187 ker_mux_send_command_frame(UART_CONTROL_INSTANCE, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1188 } /* ker_mux_send_close_down() */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1189

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1190

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1191

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1192 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1193 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1194 | Function : ker_send_disc_frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1195 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1196 | Description : This function is used to send out a frame in multiplexer mode.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1197 | It creates an DISC frame and sends it.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1198 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1199 | Parameters : none

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1200 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1201 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1202 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1203 GLOBAL void ker_send_disc_frame(UBYTE dlci)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1204 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1205 T_desc2* frame;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1206 USHORT pos;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1207

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1208 TRACE_FUNCTION( "ker_send_disc_frame" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1209

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1210 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1211 * allocate memory

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1212 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1213 MALLOC(frame, (USHORT)(sizeof(T_desc2) - 1 + 2));

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1214 frame->next = (ULONG)NULL;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1215

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1216 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1217 * fill frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1218 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1219 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1220 * address field

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1221 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1222 pos = 0;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1223 frame->buffer[pos] = (dlci << UART_DLCI_POS) | UART_EA;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1224 pos++;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1225 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1226 * control field

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1227 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1228 frame->buffer[pos] = UART_DISC_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1229 pos++;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1230

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1231 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1232 * send frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1233 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1234 frame->len = pos;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1235 ker_mux_send_command_frame(uart_data->dlc_instance[dlci], frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1236

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1237 } /* ker_send_disc_frame */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1238

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1239

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1240

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1241 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1242 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1243 | Function : ker_receive_sabm_frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1244 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1245 | Description : This function analyzes received SABM frames.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1246 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1247 | Parameters : forward - result of analysis

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1248 | frame - frame to analyze

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1249 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1250 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1251 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1252 GLOBAL void ker_receive_sabm_frame(ULONG* forward, T_desc2* frame)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1253 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1254 T_DLC* dlc;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1255 UBYTE dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1256 UBYTE dlc_instance;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1257 UBYTE i;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1258

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1259 TRACE_FUNCTION( "ker_receive_sabm_frame" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1260

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1261 dlci = frame->buffer[UART_OFFSET_ADDRESS] >> UART_DLCI_POS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1262 dlc_instance = uart_data->dlc_instance[dlci];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1263

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1264 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1265 * analyze message responses

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1266 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1267 ker_analyze_frame_info_response(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1268 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1269 * check whether frame for an existing channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1270 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1271 if(dlc_instance != UART_EMPTY_INSTANCE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1272 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1273 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1274 * set DLC to this channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1275 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1276 dlc = &uart_data->dlc_table[dlc_instance];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1277 switch(dlc->connection_state)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1278 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1279 case UART_CONNECTION_OPEN:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1280 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1281 * send UA frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1282 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1283 ker_analyze_frame_info_command(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1284 frame->buffer[UART_OFFSET_CONTROL] = UART_UA_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1285 *forward |= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1286 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1287

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1288 case UART_CONNECTION_DISC_SENT:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1289 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1290 * send DM frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1291 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1292 ker_analyze_frame_info_command(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1293 frame->buffer[UART_OFFSET_CONTROL] = UART_DM_CONTROL_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1294 *forward |= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1295 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1296

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1297 case UART_CONNECTION_SABM_RCVD:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1298 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1299

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1300 default:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1301 TRACE_ERROR( "DLC CONNECTION_STATE unexpected" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1302 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1303 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1304 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1305 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1306 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1307 ker_analyze_frame_info_command(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1308 if( dlci EQ UART_DLCI_CONTROL )

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1309 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1310 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1311 * this is a SABM frame for the control channel,

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1312 * therefore the appropriate instance is UART_CONTROL_INSTANCE

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1313 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1314 dlc = &uart_data->dlc_table[UART_CONTROL_INSTANCE];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1315 if(dlc->dlci EQ UART_DLCI_INVALID)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1316 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1317 i = UART_CONTROL_INSTANCE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1318 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1319 * mark DLC as opened

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1320 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1321 dlc->connection_state = UART_CONNECTION_SABM_RCVD;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1322 dlc->dlci = dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1323

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1324 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1325 * create UA response frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1326 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1327 frame->buffer[UART_OFFSET_CONTROL] = UART_UA_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1328 *forward |= UART_FORWARD_SABM;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1329 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1330 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1331 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1332 i = UART_MAX_NUMBER_OF_CHANNELS + 1;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1333 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1334 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1335 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1336 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1337 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1338 * if new, check whether there is a free channel left

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1339 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1340 for(i=0; i <= UART_MAX_NUMBER_OF_CHANNELS; i++ )

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1341 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1342 if(uart_data->dlc_table[i].dlci EQ UART_DLCI_INVALID)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1343 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1344 dlc = &uart_data->dlc_table[i];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1345 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1346 * mark DLC as opened

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1347 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1348 dlc->connection_state = UART_CONNECTION_SABM_RCVD;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1349 dlc->dlci = dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1350

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1351 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1352 * create UA response frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1353 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1354 frame->buffer[UART_OFFSET_CONTROL] = UART_UA_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1355 *forward |= UART_FORWARD_SABM;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1356 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1357 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1358 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1359 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1360 if( i > UART_MAX_NUMBER_OF_CHANNELS )

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1361 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1362 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1363 * no free channel found, return DM frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1364 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1365 frame->buffer[UART_OFFSET_CONTROL] = UART_DM_CONTROL_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1366 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1367 *forward|= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1368 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1369 } /* ker_receive_sabm_frame */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1370

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1371

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1372

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1373 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1374 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1375 | Function : ker_receive_ua_frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1376 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1377 | Description : This function analyzes received UA frames.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1378 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1379 | Parameters : forward - result of analysis

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1380 | frame - frame to analyze

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1381 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1382 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1383 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1384 GLOBAL void ker_receive_ua_frame(ULONG* forward, T_desc2* frame)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1385 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1386 T_DLC* dlc;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1387 UBYTE dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1388 UBYTE dlc_instance;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1389

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1390 TRACE_FUNCTION( "ker_receive_ua_frame" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1391

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1392 dlci = frame->buffer[UART_OFFSET_ADDRESS] >> UART_DLCI_POS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1393 dlc_instance = uart_data->dlc_instance[dlci];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1394

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1395 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1396 * analyze message responses

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1397 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1398 ker_analyze_frame_info_response(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1399 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1400 * check whether frame for an existing channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1401 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1402 if(dlc_instance != UART_EMPTY_INSTANCE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1403 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1404 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1405 * set DLC to this channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1406 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1407 dlc = &uart_data->dlc_table[dlc_instance];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1408 switch(dlc->connection_state)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1409 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1410 case UART_CONNECTION_DISC_SENT:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1411 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1412 * remove DISC frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1413 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1414 MFREE_DESC2(dlc->last_command);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1415 dlc->last_command = NULL;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1416 uart_data->ker.nr_t1--;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1417 if( uart_data->ker.nr_t1 EQ 0 )

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1418 sig_ker_rt_stop_t1_req();

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1419 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1420 * mark channel as closed

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1421 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1422 dlc->connection_state = UART_CONNECTION_DEAD;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1423 *forward |= UART_FORWARD_DLC_RELEASE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1424 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1425

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1426 case UART_CONNECTION_SABM_RCVD:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1427 case UART_CONNECTION_OPEN:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1428 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1429

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1430 default:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1431 TRACE_ERROR( "DLC CONNECTION_STATE unexpected" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1432 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1433 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1434 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1435 } /* ker_receive_ua_frame */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1436

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1437

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1438

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1439 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1440 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1441 | Function : ker_receive_dm_frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1442 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1443 | Description : This function analyzes received DM frames.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1444 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1445 | Parameters : forward - result of analysis

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1446 | frame - frame to analyze

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1447 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1448 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1449 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1450 GLOBAL void ker_receive_dm_frame(ULONG* forward, T_desc2* frame)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1451 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1452 T_DLC* dlc;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1453 UBYTE dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1454 UBYTE dlc_instance;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1455

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1456 TRACE_FUNCTION( "ker_receive_dm_frame" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1457

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1458 dlci = frame->buffer[UART_OFFSET_ADDRESS] >> UART_DLCI_POS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1459 dlc_instance = uart_data->dlc_instance[dlci];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1460

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1461 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1462 * analyze message responses

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1463 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1464 ker_analyze_frame_info_response(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1465 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1466 * check whether frame for an existing channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1467 * and not for Control channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1468 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1469 if((dlc_instance NEQ UART_EMPTY_INSTANCE) &&

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1470 (dlci NEQ UART_DLCI_CONTROL))

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1471 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1472 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1473 * set DLC to this channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1474 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1475 dlc = &uart_data->dlc_table[dlc_instance];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1476 switch(dlc->connection_state)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1477 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1478 case UART_CONNECTION_DISC_SENT:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1479 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1480 * remove DISC frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1481 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1482 MFREE_DESC2(dlc->last_command);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1483 dlc->last_command = NULL;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1484 uart_data->ker.nr_t1--;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1485 if( uart_data->ker.nr_t1 EQ 0 )

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1486 sig_ker_rt_stop_t1_req();

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1487 /* fall through */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1488 case UART_CONNECTION_OPEN:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1489 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1490 * mark channel as closed

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1491 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1492 dlc->connection_state = UART_CONNECTION_DEAD;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1493 *forward |= UART_FORWARD_DLC_RELEASE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1494 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1495

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1496 case UART_CONNECTION_SABM_RCVD:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1497 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1498

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1499 default:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1500 TRACE_ERROR( "DLC CONNECTION_STATE unexpected" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1501 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1502 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1503 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1504 } /* ker_receive_dm_frame */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1505

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1506

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1507

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1508 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1509 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1510 | Function : ker_receive_disc_frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1511 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1512 | Description : This function analyzes received DISC frames.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1513 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1514 | Parameters : forward - result of analysis

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1515 | frame - frame to analyze

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1516 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1517 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1518 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1519 GLOBAL void ker_receive_disc_frame(ULONG* forward, T_desc2* frame)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1520 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1521 T_DLC* dlc;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1522 UBYTE dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1523 UBYTE dlc_instance;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1524

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1525 TRACE_FUNCTION( "ker_receive_disc_frame" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1526

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1527 dlci = frame->buffer[UART_OFFSET_ADDRESS] >> UART_DLCI_POS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1528 dlc_instance = uart_data->dlc_instance[dlci];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1529

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1530 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1531 * analyze messages

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1532 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1533 ker_analyze_frame_info_response(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1534 ker_analyze_frame_info_command(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1535 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1536 * check whether frame for an existing channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1537 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1538 if(dlc_instance NEQ UART_EMPTY_INSTANCE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1539 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1540 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1541 * set DLC to this channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1542 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1543 dlc = &uart_data->dlc_table[dlc_instance];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1544 if(dlci EQ UART_DLCI_CONTROL)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1545 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1546 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1547 * send UA frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1548 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1549 frame->buffer[UART_OFFSET_CONTROL] = UART_UA_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1550 *forward |= UART_FORWARD_CLD;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1551 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1552 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1553 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1554 switch(dlc->connection_state)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1555 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1556 case UART_CONNECTION_DISC_SENT:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1557 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1558 * remove DISC frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1559 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1560 MFREE_DESC2(dlc->last_command);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1561 dlc->last_command = NULL;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1562 uart_data->ker.nr_t1--;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1563 if( uart_data->ker.nr_t1 EQ 0 )

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1564 sig_ker_rt_stop_t1_req();

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1565 /* fall through */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1566 case UART_CONNECTION_SABM_RCVD:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1567 case UART_CONNECTION_OPEN:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1568 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1569 * mark channel as closed

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1570 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1571 dlc->connection_state = UART_CONNECTION_DEAD;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1572 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1573 * send UA frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1574 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1575 frame->buffer[UART_OFFSET_CONTROL] = UART_UA_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1576 *forward |= UART_FORWARD_DLC_RELEASE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1577 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1578

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1579 default:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1580 TRACE_ERROR( "DLC CONNECTION_STATE unexpected" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1581 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1582 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1583 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1584 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1585 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1586 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1587 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1588 * send DM frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1589 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1590 frame->buffer[UART_OFFSET_CONTROL] = UART_DM_CONTROL_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1591 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1592 *forward|= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1593 } /* ker_receive_disc_frame */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1594

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1595

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1596

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1597 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1598 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1599 | Function : ker_receive_uih_control_frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1600 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1601 | Description : This function analyzes received UIH Control frames.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1602 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1603 | Parameters : forward - result of analysis

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1604 | frame - frame to analyze

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1605 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1606 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1607 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1608 GLOBAL void ker_receive_uih_control_frame(ULONG* forward, T_desc2* frame)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1609 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1610 T_DLC* dlc;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1611 UBYTE dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1612 UBYTE dlc_instance;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1613

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1614 TRACE_FUNCTION( "ker_receive_uih_control_frame" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1615

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1616 dlci = frame->buffer[UART_OFFSET_ADDRESS] >> UART_DLCI_POS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1617 dlc_instance = uart_data->dlc_instance[dlci];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1618

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1619 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1620 * analyze message responses

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1621 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1622 ker_analyze_frame_info_response(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1623 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1624 * check whether frame for an existing channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1625 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1626 if(dlc_instance NEQ UART_EMPTY_INSTANCE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1627 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1628 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1629 * set DLC to this channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1630 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1631 dlc = &uart_data->dlc_table[dlc_instance];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1632 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1633 * check whether it is an command frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1634 * discard frame if it is a response frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1635 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1636 if(frame->buffer[UART_OFFSET_ADDRESS] & UART_CR)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1637 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1638 switch(dlc->connection_state)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1639 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1640 case UART_CONNECTION_OPEN:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1641 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1642 * send UIH response frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1643 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1644 ker_analyze_frame_info_command(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1645 *forward|= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1646 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1647

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1648 case UART_CONNECTION_DISC_SENT:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1649 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1650 * send DM frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1651 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1652 ker_analyze_frame_info_command(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1653 frame->buffer[UART_OFFSET_CONTROL] = UART_DM_CONTROL_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1654 *forward |= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1655 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1656

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1657 case UART_CONNECTION_SABM_RCVD:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1658 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1659

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1660 default:

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1661 TRACE_ERROR( "DLC CONNECTION_STATE unexpected" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1662 break;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1663 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1664 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1665 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1666 else

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1667 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1668 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1669 * send DM frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1670 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1671 ker_analyze_frame_info_command(forward, frame);

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1672 frame->buffer[UART_OFFSET_CONTROL] = UART_DM_CONTROL_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1673 *forward |= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1674 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1675 } /* ker_receive_uih_control_frame */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1676

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1677

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1678

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1679 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1680 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1681 | Function : ker_receive_uih_data_frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1682 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1683 | Description : This function analyzes received UIH Data frames.

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1684 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1685 | Parameters : forward - result of analysis

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1686 | frame - frame to analyze

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1687 |

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1688 +------------------------------------------------------------------------------

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1689 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1690 GLOBAL void ker_receive_uih_data_frame(ULONG* forward, T_desc2* frame)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1691 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1692 UBYTE dlci;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1693 UBYTE dlc_instance;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1694

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1695 TRACE_FUNCTION( "ker_receive_uih_data_frame" );

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1696

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1697 dlci = frame->buffer[UART_OFFSET_ADDRESS] >> UART_DLCI_POS;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1698 dlc_instance = uart_data->dlc_instance[dlci];

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1699

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1700 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1701 * check whether frame for a not existing channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1702 * discard packet if it is for an extisting channel

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1703 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1704 if(dlc_instance EQ UART_EMPTY_INSTANCE)

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1705 {

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1706 /*

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1707 * send DM frame

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1708 * shorten information field

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1709 */

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1710 frame->buffer[UART_OFFSET_CONTROL] = UART_DM_DATA_FRAME;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1711 frame->len = UART_OFFSET_INFO;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1712 *forward |= UART_FORWARD_RESPONSE;

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1713 }

53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1714 } /* ker_receive_uih_data_frame */

FreeCalypso > hg > fc-magnetite

annotate src/g23m-aci/uart/uart_kerf.c @ 598:717ed17d82c6