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

annotate src/g23m-aci/uart/uart_txf.c @ 293:5b2ebc94cae4

aci3: integrated all Openmoko AT commands except AT@BAND

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sat, 02 Sep 2017 17:37:06 +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 (TX-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_TXF_C
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #define UART_TXF_C
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #endif /* !UART_TXF_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 #ifndef FF_MULTI_PORT
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 /==== INCLUDES =============================================================/
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 #ifdef WIN32
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "nucleus.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #endif /* WIN32 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #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	36 #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	37 #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	38 #include "custom.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #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	40 #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	41 #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	42 #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	43 #ifdef DTILIB
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #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	45 #endif /* DTILIB */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #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	47 #ifdef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include "uart/serialswitch.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #include "uart/traceswitch.h"
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 #else /* _TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 #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	52 #endif /* _TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #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	54
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #ifdef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #include <stdio.h> /* to get sprintf */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 #endif /* _SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 #include <string.h> /* JK, delete warnings: to get memcpy */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 /==== CONST ================================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 /==== LOCAL VARS ===========================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 /==== PRIVATE FUNCTIONS ====================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 /==== PUBLIC FUNCTIONS =====================================================/
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 \| Function : tx_proc_output
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 \| Description : The function tx_proc_output() is the actual callback function
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 \| to write data into the send buffer.
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 \| Parameters : uart_device - database for the affected UART device
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 +------------------------------------------------------------------------------
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 LOCAL void tx_proc_output(T_UART_DATA* uart_device)
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 USHORT i, len, pos;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 T_DLC dlc; / used Data Link Connection */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 UBYTE transmit_state; /* state of transmission */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 T_desc2* cur_desc; /* currently used descriptor */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 UBYTE temp_field; /* multi purpose value */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 UBYTE frame_size; /* numbr of octets in Information field */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 UBYTE fcs; /* Frame Check Sequence */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 SHORT error_code; /* Error code returned from a function */
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 TRACE_FUNCTION( "tx_proc_output" );
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 if(uart_device->tx.dlc_instance EQ UART_EMPTY_INSTANCE)
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 * Raw Data
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 * use entry 0 for raw data
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 dlc = &uart_device->dlc_table[UART_CONTROL_INSTANCE];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 cur_desc = dlc->transmit_data;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 * search next descriptor that includes data
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 while((cur_desc) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 (dlc->transmit_pos >= cur_desc->len))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 cur_desc = (T_desc2*)cur_desc->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 dlc->transmit_pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 * for each ring buffer segment
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 for (i=0; i < uart_device->tx.ndest; i++)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 * while ring buffer segment is not yet full and
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 * there are still data to send
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 while((uart_device->tx.size[i] > 0) && (cur_desc))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 * determine length to copy
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 len = cur_desc->len - dlc->transmit_pos;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 if(len > uart_device->tx.size[i])
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 len = uart_device->tx.size[i];
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 * copy data
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 memcpy((char*) &uart_device->tx.dest[i][pos],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 (char*) &cur_desc->buffer[dlc->transmit_pos],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 len);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 * updata values
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 uart_device->tx.size[i]-= len;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 dlc->transmit_pos += len;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 pos += len;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 * if current descriptor completly send
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 * then move to next descriptor
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 while((cur_desc) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 (dlc->transmit_pos >= cur_desc->len))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 cur_desc = (T_desc2*)cur_desc->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 dlc->transmit_pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 }
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 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 * Multiplexer Data
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 dlc = &uart_device->dlc_table[uart_device->tx.dlc_instance];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 cur_desc = dlc->transmit_data;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 temp_field = 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 * search next descriptor that includes data
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 while((cur_desc) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 (dlc->transmit_pos >= cur_desc->len))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 cur_desc = (T_desc2*)cur_desc->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 dlc->transmit_pos = 0;
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 if(cur_desc)
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 * initiailze destination values
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 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 while((i < uart_device->tx.ndest) && (uart_device->tx.size[i] EQ 0))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 i++;
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 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 * send start HDLC Flag
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 uart_device->tx.dest[i][pos] = UART_HDLC_FLAG;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 fcs = UART_INITFCS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 transmit_state = UART_TX_ADDRESS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 frame_size = 0;
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 * increase destination position
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 pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 uart_device->tx.size[i]--;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 while((i < uart_device->tx.ndest) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 (uart_device->tx.size[i] EQ 0))
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 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 i++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 while(transmit_state NEQ UART_TX_END)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 switch(transmit_state)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 case UART_TX_ADDRESS:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 * send Address field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 if(uart_device->tx.dlc_instance EQ UART_CONTROL_INSTANCE)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 * at Control Channel the address field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 * is included in source data
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 temp_field = cur_desc->buffer[dlc->transmit_pos];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 * if current descriptor completly send
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 * then move to next descriptor
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 dlc->transmit_pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 while((cur_desc) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 (dlc->transmit_pos >= cur_desc->len))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 cur_desc = (T_desc2*)cur_desc->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 dlc->transmit_pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 else
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 * at Data Channel the address field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 * is calculated with the DLCI
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 temp_field = (dlc->dlci << UART_DLCI_POS) \| UART_EA;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 * calculate FCS
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 fcs = uart_device->fcstab[fcs ^ temp_field];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 * next field is Control field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 transmit_state = UART_TX_CONTROL;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 break;
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 case UART_TX_CONTROL:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 * send Control field
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 if(uart_device->tx.dlc_instance EQ UART_CONTROL_INSTANCE)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 * at Control Channel the control field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 * is included in source data
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 temp_field = cur_desc->buffer[dlc->transmit_pos];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 * if current descriptor completly send
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 * then move to next descriptor
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 dlc->transmit_pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 while((cur_desc) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 (dlc->transmit_pos >= cur_desc->len))
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 cur_desc = (T_desc2*)cur_desc->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 dlc->transmit_pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 * at Data Channel the control field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 * is always an UIH frame with P/F bit set to 0
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 temp_field = UART_UIH_DATA_FRAME;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 * calculate FCS
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 fcs = uart_device->fcstab[fcs ^ temp_field];
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 there are still data to send the
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 * next field is Information field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 * otherwise next field is FCS field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 if(cur_desc)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 transmit_state = UART_TX_INFORMATION;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 transmit_state = UART_TX_FCS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 case UART_TX_INFORMATION:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 * send Information field
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 temp_field = cur_desc->buffer[dlc->transmit_pos];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 * check if there is still data in the current descriptor and
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 * the maximum frame size is not yet reached
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 dlc->transmit_pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 frame_size++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 if((frame_size >= uart_device->n1) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 (dlc->transmit_pos >= cur_desc->len))
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 * if current descriptor completly send
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 * then move to next descriptor
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 while((cur_desc) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 (dlc->transmit_pos >= cur_desc->len))
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 cur_desc = (T_desc2*)cur_desc->next;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 dlc->transmit_pos = 0;
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 * if no more data to send available or
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 * maximum frame size is reached then
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 * the next field is FCS field
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 if((frame_size >= uart_device->n1) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 (cur_desc EQ NULL))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 transmit_state = UART_TX_FCS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 break;
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 case UART_TX_FCS:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 * send FCS field
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 #ifdef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 * clear FCS field in simulation mode
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 temp_field = UART_GOODFCS;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 #else /* _SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 temp_field = (0xff - fcs);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 #endif /* _SIMULATION_ */
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 * frame complete
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 transmit_state = UART_TX_END;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 default:
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 TRACE_EVENT_P1("Warning: Unexpected TX ISR state %d", transmit_state);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 break;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 if((temp_field EQ UART_HDLC_FLAG) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 (temp_field EQ UART_HDLC_ESCAPE) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 (temp_field EQ uart_device->xon) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 (temp_field EQ uart_device->xoff))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 * send Control Escape and map character
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 /lint -e661 (Warning -- access of out-of-bounds pointer) /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 uart_device->tx.dest[i][pos] = UART_HDLC_ESCAPE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 /lint +e661 (Warning -- access of out-of-bounds pointer) /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 temp_field ^= 0x20;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 * increase destination position
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 uart_device->tx.size[i]--;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 while((i < uart_device->tx.ndest) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 (uart_device->tx.size[i] EQ 0))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 i++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 * send character
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 /lint -e661 -e662 (Warning -- access/creation of out-of-bounds pointer) /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 uart_device->tx.dest[i][pos] = temp_field;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 /lint +e661 +e662 (Warning -- access/creation of out-of-bounds pointer) /
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 * increase destination position
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 uart_device->tx.size[i]--;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 while((i < uart_device->tx.ndest) &&
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 (uart_device->tx.size[i] EQ 0))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 i++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 * send stop HDLC Flag
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 /lint -e661 -e662 (Warning -- access/creation of out-of-bounds pointer) /
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 uart_device->tx.dest[i][pos] = UART_HDLC_FLAG;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 /lint +e661 +e662 (Warning -- access/creation of out-of-bounds pointer) /
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 * update size value
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 uart_device->tx.size[i]--;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 * write current descriptor back to table
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 dlc->transmit_data = cur_desc;
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 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 PSIGNAL(hCommUART, UART_DRIVER_SENT_IND, uart_device);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 *uart_device->tx.reInstall = rm_noInstall;
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 * update pointer in UART driver
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 if((error_code = UF_OutpAvail (uart_device->device)) < 0)
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 TRACE_ERROR_P2("UF Driver: data pointer update failed, [%d], uart_txf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 error_code, __LINE__);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 } /* tx_proc_output() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424
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 /*
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 \| Function : tx_init
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 \| Description : The function tx_init() initializes the TX service.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 \| Parameters : no parameters
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 GLOBAL void tx_init ()
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 #ifdef WIN32
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 char buf[80];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 #endif /* !_TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 STATUS sts;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 #endif /* WIN32 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 TRACE_FUNCTION( "tx_init" );
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 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 #ifdef WIN32
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 sts = NU_Create_HISR (&uart_data->tx.tx_HISR,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 "TX_HISR",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 tx_proc_output,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 2,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 uart_data->HISR_stack,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 HISR_STACK_SIZE);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 sprintf (buf, "NU_Create_HISR(TX) = %d", sts);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 TRACE_EVENT (buf);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 #endif /* !_TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 #endif /* WIN32 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 uart_data->tx.lines = 0x80000000; /* invalid */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 uart_data->tx.dlc_instance = UART_EMPTY_INSTANCE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 uart_data->tx.p_zero = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 uart_data->tx.send_state = UART_TX_NOT_SENDING;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 INIT_STATE( UART_SERVICE_TX , TX_DEAD );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 } /* tx_init() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 \| Function : tx_flushUart
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 \| Description : The function tx_flushUart() flush the output buffer of the
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 \| UART driver.
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 \| Parameters : no parameters
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 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 GLOBAL void tx_flushUart ()
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 USHORT oa; /* output available */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 #endif /* !_TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 #ifndef ALR
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 T_UFRET mt;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 #endif /* ALR */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 USHORT counter;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 TRACE_FUNCTION( "tx_flushUart" );
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 counter = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 while(
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 #ifndef ALR
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 ((mt = UF_CheckXEmpty(uart_data->device)) == UF_NOT_READY) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 #endif /* !ALR */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 (UF_OutpAvail (uart_data->device) < UF_MAX_BUFFER_SIZE))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 oa = UF_OutpAvail (uart_data->device);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 TRACE_EVENT_P1("waiting - output not flushed oa:%d",oa);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 #endif /* !_TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 * poll permanent in the first 500ms
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 * after that poll 1 minute only every second
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 * after that give up
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 if(counter < 50)
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 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	516 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 TRACE_ERROR_P1("VSI entity: Can't suspend thread, uart_txf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 __LINE__);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 else if(counter < 110)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 if(vsi_t_sleep (VSI_CALLER 1000) NEQ VSI_OK)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 TRACE_ERROR_P1("VSI entity: Can't suspend thread, uart_txf.c(%d)",
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526 __LINE__);
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 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 else
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 break;
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 counter++;
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 } /* tx_flushUart() */
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
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 \| Function : tx_next_send_allowed
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 \| Description : The function tx_next_send_allowed() determines which dlc is the
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 \| next dlc allow to send. The result of the calculation is stored
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545 \| in dlc_instance.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 \| Parameters : no parameters
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 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 GLOBAL void tx_next_send_allowed ()
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 UBYTE diff;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 UBYTE inst;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 UBYTE next_inst;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556 T_DLC* dlc;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 TRACE_FUNCTION( "tx_next_send_allowed" );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 diff = 255;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 next_inst = UART_EMPTY_INSTANCE;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 for(inst = 0; inst <= UART_MAX_NUMBER_OF_CHANNELS; inst++)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 dlc = &uart_data->dlc_table[inst];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 if(dlc->transmit_data)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 if(dlc->p_counter EQ uart_data->tx.p_zero)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 uart_data->tx.dlc_instance = inst;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 return;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 if(diff > (dlc->p_counter - uart_data->tx.p_zero))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 diff = dlc->p_counter - uart_data->tx.p_zero;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 next_inst = inst;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 uart_data->tx.p_zero+= diff;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 uart_data->tx.dlc_instance = next_inst;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 } /* tx_next_send_allowed() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 /*
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 \| Function : tx_writeInFunc_0
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 \| Description : The function tx_writeInFunc_0() is the official callback
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 \| function to write data into the send buffer of UART device 0.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 \| It just copies the parameters and calls then the actual
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 \| function.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 \| Parameters : cldFromIrq - called from interrupt
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 \| reInstall - reinstallation mode
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596 \| ndest - number of destination pointers
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 \| dest - array of destination pointers
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 \| size - array of sizes for every destinition pointer
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600 +------------------------------------------------------------------------------
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 GLOBAL void tx_writeInFunc_0 (BOOL cldFromIrq,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 T_reInstMode *reInstall,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604 UBYTE ndest,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 UBYTE *dest[],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 USHORT *size)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 char buf[40];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 #endif /* !_TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 T_UART_DATA* uart_device;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 TRACE_FUNCTION( "tx_writeInFunc_0" );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618 * select UART device 0
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 uart_device = &(uart_data_base[0]);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 * store parameters
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 uart_device->tx.cldFromIrq = cldFromIrq;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 uart_device->tx.ndest = ndest;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 uart_device->tx.dest[0] = dest[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 uart_device->tx.dest[1] = dest[1];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 uart_device->tx.size = size;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 uart_device->tx.reInstall = reInstall;
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 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 #ifdef WIN32
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634 if (cldFromIrq)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636 STATUS sts;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638 * interrupt context of the UART driver -> activate the HISR
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 sts = NU_Activate_HISR (&uart_device->tx.tx_HISR);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 sprintf (buf, "NU_Activate_HISR(TX) = %d", sts);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 TRACE_EVENT (buf);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644 #endif /* !_TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647 #endif /* WIN32 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 #endif /* !_SIMULATION_ */
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 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 * normal callback from UF_WriteData
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 tx_proc_output(uart_device);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 #ifdef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 * trace output
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 UBYTE* trace_dest[2];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 USHORT trace_size[2];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662 USHORT i;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663 USHORT pos;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 char buf[90];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 trace_dest[0] = dest[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668 trace_dest[1] = dest[1];
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 trace_size[0] = size[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 trace_size[1] = size[1];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673 trace_size[0]-= uart_device->tx.size[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 trace_size[1]-= uart_device->tx.size[1];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676 if((trace_size[0]) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677 (trace_size[1]))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 TRACE_EVENT("=== OUTRAW");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 while(pos < trace_size[0])
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685 i+= sprintf(&buf[i], "0x%02x, ", trace_dest[0][pos]);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 if(i > 80)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 TRACE_EVENT( buf );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692 else if(pos >= trace_size[0])
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694 TRACE_EVENT( buf );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 while(pos < trace_size[1])
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 i+= sprintf(&buf[i], "0x%02x, ", trace_dest[1][pos]);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 if(i > 80)
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 TRACE_EVENT( buf );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708 else if(pos >= trace_size[1])
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 TRACE_EVENT( buf );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715 #endif /* _SIMULATION_ */
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 } /* tx_writeInFunc_0() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721 #ifdef FF_TWO_UART_PORTS
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 \| Function : tx_writeInFunc_1
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 \| Description : The function tx_writeInFunc_1() is the official callback
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 \| function to write data into the send buffer of UART device 0.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 \| It just copies the parameters and calls then the actual
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729 \| function.
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 \| Parameters : cldFromIrq - called from interrupt
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 \| reInstall - reinstallation mode
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 \| ndest - number of destination pointers
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734 \| dest - array of destination pointers
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735 \| size - array of sizes for every destinition pointer
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736 \|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737 +------------------------------------------------------------------------------
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 GLOBAL void tx_writeInFunc_1 (BOOL cldFromIrq,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 T_reInstMode *reInstall,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 UBYTE ndest,
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 UBYTE *dest[],
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 USHORT *size)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747 char buf[40];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748 #endif /* !_TARGET_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 T_UART_DATA* uart_device;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752 TRACE_FUNCTION( "tx_writeInFunc_1" );
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 * select UART device 1
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757 uart_device = &(uart_data_base[1]);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 * store parameters
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 uart_device->tx.cldFromIrq = cldFromIrq;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 uart_device->tx.ndest = ndest;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 uart_device->tx.dest[0] = dest[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765 uart_device->tx.dest[1] = dest[1];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 uart_device->tx.size = size;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 uart_device->tx.reInstall = reInstall;
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 #ifndef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 #ifdef WIN32
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 if (cldFromIrq)
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 STATUS sts;
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 * interrupt context of the UART driver -> activate the HISR
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 sts = NU_Activate_HISR (&uart_device->tx.tx_HISR);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 #ifndef _TARGET_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 sprintf (buf, "NU_Activate_HISR(TX) = %d", sts);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 TRACE_EVENT (buf);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781 #endif /* !_TARGET_ */
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 else
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 #endif /* WIN32 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 #endif /* !_SIMULATION_ */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 * normal callback from UF_WriteData
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 tx_proc_output(uart_device);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792 #ifdef _SIMULATION_
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 /*
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795 * trace output
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796 */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797 UBYTE* trace_dest[2];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 USHORT trace_size[2];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799 USHORT i;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 USHORT pos;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 char buf[90];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802
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 trace_dest[0] = dest[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805 trace_dest[1] = dest[1];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807 trace_size[0] = size[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 trace_size[1] = size[1];
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 trace_size[0]-= uart_device->tx.size[0];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811 trace_size[1]-= uart_device->tx.size[1];
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 if((trace_size[0]) \|\|
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 (trace_size[1]))
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 TRACE_EVENT("=== OUTRAW");
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820 while(pos < trace_size[0])
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 i+= sprintf(&buf[i], "0x%02x, ", trace_dest[0][pos]);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823 pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824 if(i > 80)
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 TRACE_EVENT( buf );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827 i = 0;
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 else if(pos >= trace_size[0])
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831 TRACE_EVENT( buf );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 }
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 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 pos = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 while(pos < trace_size[1])
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838 i+= sprintf(&buf[i], "0x%02x, ", trace_dest[1][pos]);
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 pos++;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 if(i > 80)
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 {
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842 TRACE_EVENT( buf );
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843 i = 0;
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	844 }
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	845 else if(pos >= trace_size[1])
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 TRACE_EVENT( buf );
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 }
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 #endif /* _SIMULATION_ */
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 } /* tx_writeInFunc_1() */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	855 #endif /* FF_TWO_UART_PORTS */
53929b40109c src/g23m-aci: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 #endif /* !FF_MULTI_PORT */

FreeCalypso > hg > fc-magnetite

annotate src/g23m-aci/uart/uart_txf.c @ 293:5b2ebc94cae4