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

annotate src/g23m-aci/uart/uart_kerf.c @ 598:717ed17d82c6

aci3 vocoder control revamped, AT@VSEL now works as it should The vocoder control code (hl_audio_drv.c) that came with the TCS3 version of ACI was totally broken in the Calypso config (VOCODER_FUNC_INTERFACE) and worked in the standard analog voice environment only by luck. This code has now been rewritten to work correctly with our Calypso platform and TCS211 L1, and our new AT@VSEL mechanism (automatic enabling and disabling of MCSI voice path as the modem enters and exits the voice call state) now also works as designed.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Wed, 27 Mar 2019 23:44:35 +0000
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
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