tcs211-l1-reconst: gpf/tst/DRV/tr2.c annotate

annotate gpf/tst/DRV/tr2.c @ 249:b5f180a36b22

g23m/copyblobs.sh: l1tm_cust.obj deblobbed

author	Mychaela Falconia <falcon@freecalypso.org>
date	Mon, 16 Jan 2017 03:18:08 +0000
parents	509db1a7b7b8
children

rev	line source
0 509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	1 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	2 +------------------------------------------------------------------------------
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	3 \| File: tr.c
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	4 +------------------------------------------------------------------------------
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	5 \| Copyright 2004 Texas Instruments Deutschland, AG
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	6 \| All rights reserved.
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	7 \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	8 \| This file is confidential and a trade secret of Texas
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	9 \| Instruments Berlin, AG
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	10 \| The receipt of or possession of this file does not convey
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	11 \| any rights to reproduce or disclose its contents or to
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	12 \| manufacture, use, or sell anything it may describe, in
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	13 \| whole, or in part, without the specific written consent of
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	14 \| Texas Instruments Deutschland, AG.
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	15 +-----------------------------------------------------------------------------
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	16 \| Purpose : This Modul contains the TR driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	17 +-----------------------------------------------------------------------------
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	18 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	19
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	20 #ifndef __TR_C__
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	21 #define __TR_C__
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	22 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	23
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	24 #include "string.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	25 #include "typedefs.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	26 #include "gdi.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	27 #include "vsi.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	28 #include "os.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	29 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	30 #include <stdio.h>
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	31 #include "glob_defs.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	32 #include "tstdriver.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	33 #include "frame.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	34 #include "frame_const.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	35 #include "printtofile.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	36 #endif /* _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	37 #include "tstheader.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	38 #include "tst_mux.h"
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	39
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	40
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	41 /==== TYPES ======================================================/
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	42
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	43 typedef struct
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	44 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	45 T_VOID_STRUCT *RcvBuffer;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	46 USHORT Handle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	47 USHORT EnabledSignalType;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	48 T_DRV_CB_FUNC Callback;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	49 USHORT config;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	50 UBYTE rcv_state;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	51 UBYTE idle_state;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	52 } T_TR_DATA;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	53
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	54
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	55 /==== CONSTANTS ==================================================/
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	56
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	57 #define ALLOWED_TR_SIGNALS (DRV_SIGTYPE_READ\|DRV_SIGTYPE_CONNECT\|DRV_SIGTYPE_DISCONNECT)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	58
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	59 #define STX 0x02
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	60 #define TI_RIV_ID 0x11
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	61 #define TI_L1_ID 0x12
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	62 #define TI_L23_ID 0x13
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	63 #define TI_STX 0x02
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	64 #define TI_ESC 0x10
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	65 #define CHAR_ABORT 'A'
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	66
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	67 #define DATA_SEGMENT_SIZE 223
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	68
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	69 #define WAIT_FOR_STX 0
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	70 #define WAIT_FOR_IDENT 1
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	71 #define WAIT_FOR_TIMESTAMP 2
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	72 #define WAIT_FOR_LENGTH 3
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	73 #define WAIT_FOR_SND 4
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	74 #define WAIT_FOR_RCV 5
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	75 #define WAIT_FOR_DATA 6
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	76 #define WAIT_FOR_CR 7
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	77 #define WAIT_FOR_TI_ID 8
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	78 #define WAIT_FOR_TI_LEN_0 9
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	79 #define WAIT_FOR_TI_LEN_1 10
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	80 #define WAIT_FOR_TI_LEN_2 11
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	81 #define WAIT_FOR_LENGTH1 12
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	82 #define WAIT_FOR_LENGTH2 13
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	83 #define WAIT_FOR_RAW_TI_S 14
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	84 #define WAIT_FOR_RAW_TI_ID 15
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	85 #define WAIT_FOR_RAW_TI_E 16
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	86
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	87 #define WAIT_FOR_MUX_START_STX 1
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	88 #define WAIT_FOR_MUX_CHAN_ID 2
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	89 #define WAIT_FOR_MUX_END_STX 3
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	90
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	91 #define STX_LF_MODE 0x0001
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	92 #define TI_TRC_MODE 0x0002
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	93 #define TI_RAW_TRC_MODE 0x0004
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	94
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	95 /==== EXTERNALS ==================================================/
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	96
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	97 extern ULONG TR_RcvBufferSize;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	98 extern ULONG TR_MaxInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	99 extern USHORT ext_data_pool_handle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	100 extern T_TST_MUX_CHANNEL tst_mux_chan_struct[];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	101
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	102 /==== VARIABLES ==================================================/
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	103
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	104 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	105 #ifndef _TARGET_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	106 long int accessNum = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	107 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	108 T_TR_DATA TR_Data;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	109 static char *TR_RcvBuffer;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	110 static ULONG TR_EndInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	111 static ULONG TR_WrInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	112 static ULONG TR_RdInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	113 static ULONG MessageLength;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	114 static union {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	115 unsigned short int val;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	116 char part[2];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	117 }tst_trailer_size;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	118 #else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	119 extern T_TR_DATA TR_Data;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	120 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	121
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	122 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	123 static int ti_id_not_found;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	124 static int ti_esc_skipped;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	125 extern int tst_message_received;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	126 #else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	127 extern ULONG MaxPrimPartSize;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	128 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	129
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	130 /==== FUNCTIONS ==================================================/
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	131
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	132 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	133 USHORT TR_Write ( void Buffer, ULONG BytesToWrite );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	134 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	135
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	136 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	137 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	138 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	139 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	140 \| STATE : code ROUTINE : TR_Exit \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	141 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	142
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	143 PURPOSE : exit a driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	144
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	145 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	146 LOCAL void TR_Exit ( void )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	147 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	148 os_DeallocateMemory ( 0, TR_Data.RcvBuffer );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	149 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	150 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	151
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	152 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	153 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	154 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	155 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	156 \| STATE : code ROUTINE : TR_Read \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	157 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	158
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	159 PURPOSE : read data from driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	160
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	161 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	162 LOCAL USHORT TR_Read ( void Buffer, ULONG BytesToRead )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	163 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	164 ULONG Space = TR_EndInd - (TR_RdInd & TR_MaxInd);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	165 static ULONG bytes_read;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	166
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	167 if ( *BytesToRead == 0 )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	168 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	169 *BytesToRead = MessageLength;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	170 bytes_read = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	171 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	172 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	173 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	174 if ( Space > *BytesToRead )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	175 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	176 memcpy ( Buffer, &TR_RcvBuffer[TR_RdInd&TR_MaxInd], *BytesToRead );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	177 bytes_read += *BytesToRead;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	178 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	179 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	180 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	181 memcpy ( Buffer, &TR_RcvBuffer[TR_RdInd&TR_MaxInd], (unsigned int)Space );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	182 *BytesToRead = Space;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	183 bytes_read += Space;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	184 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	185 TR_RdInd += *BytesToRead;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	186 if ( TR_Data.config & STX_LF_MODE )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	187 if ( bytes_read == MessageLength )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	188 TR_RdInd++; /* skip th LF, its not read by the TIF driver */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	189 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	190 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	191 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	192 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	193
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	194 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	195 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	196 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	197 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	198 \| STATE : code ROUTINE : TR_Write \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	199 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	200
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	201 PURPOSE : write data to driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	202
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	203 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	204 USHORT TR_Write ( void Buffer, ULONG BytesToWrite )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	205 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	206 char snd_ptr = (char)Buffer;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	207 ULONG btw;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	208 char ti_mode_header[2];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	209
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	210 ti_mode_header[0] = TI_STX;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	211 ti_mode_header[1] = TI_L23_ID;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	212
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	213 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	214 btw=(*BytesToWrite) & ~PRIM_FLAG_MASK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	215 #else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	216 btw=(*BytesToWrite);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	217 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	218
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	219 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	220 if (TR_Data.config & TI_RAW_TRC_MODE)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	221 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	222 ULONG full_btw, segment_size;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	223 /lint -e813, suppress Info 813: auto variable 'osver' has size '148' /
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	224 char segment[DATA_SEGMENT_SIZE*2+3];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	225 /lint +e813 /
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	226 ULONG q;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	227
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	228 full_btw=btw;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	229 while (full_btw)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	230 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	231 btw= (full_btw>DATA_SEGMENT_SIZE) ? DATA_SEGMENT_SIZE : full_btw;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	232
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	233 /* fill in leading bytes */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	234 segment_size=0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	235 segment[segment_size++]=TI_STX;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	236 segment[segment_size++]=TI_L23_ID;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	237
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	238 /* fill in payload bytes */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	239 for (q=0; q<btw; q++)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	240 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	241 /* evtl insert TI_ESC characters */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	242 if (snd_ptr[q]==TI_STX \|\| snd_ptr[q]==TI_ESC)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	243 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	244 segment[segment_size++]=TI_ESC;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	245 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	246 segment[segment_size++]=snd_ptr[q];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	247 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	248
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	249 /* fill in trailing bytes */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	250 segment[segment_size++]=TI_STX;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	251
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	252 /* write segment */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	253 if ( vsi_d_write ( TR_Data.Handle, 0, (void*)segment, segment_size) != VSI_OK )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	254 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	255 return DRV_INTERNAL_ERROR;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	256 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	257
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	258 full_btw=full_btw-btw;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	259 if (full_btw)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	260 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	261 snd_ptr=snd_ptr+btw;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	262
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	263 /* let the ti driver on target handle the byte-block */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	264 vsi_t_sleep ( 0, 100 );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	265 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	266 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	267
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	268 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	269 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	270 #endif /* _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	271
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	272 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	273 * To avoid reallocation and memcpy() the STX is written in front of the passed
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	274 * data. This works as long as the sizeof(T_SYST_HEADER) is bigger than the header
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	275 * sent via the test interface.
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	276 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	277 if ( TR_Data.config & STX_LF_MODE )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	278 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	279 btw=(BytesToWrite) & ~PRIM_FLAG_MASK; / not really generic, but we need to mask here */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	280 /* we assume that the TITRC driver is not below */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	281 if ( BytesToWrite & PRIM_DATA_FLAG ) / primitive data -> LF at the end */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	282 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	283 *(snd_ptr+btw) = '\n';
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	284 btw = btw + 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	285 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	286 else if ( BytesToWrite & PRIM_HEADER_FLAG ) / primitive header -> add STX in front */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	287 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	288 snd_ptr--; /* it is posible to add STX because the first */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	289 snd_ptr = STX; / byte of TST_SMALL_HEADER/TST_BIG_HEADER in unused */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	290 btw = btw + 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	291 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	292 else /* trace -> STX in front, LF at the end */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	293 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	294 *(snd_ptr+btw) = '\n';
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	295 snd_ptr--;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	296 *snd_ptr = STX;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	297 btw = btw + 2;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	298 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	299 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	300
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	301 /* Add mux STX and channel id if not already in */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	302 if (TR_Data.config & TI_RAW_TRC_MODE && *snd_ptr != TI_STX )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	303 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	304 if ( vsi_d_write ( TR_Data.Handle, 0, (void*)ti_mode_header, 2) != VSI_OK )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	305 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	306 return DRV_INTERNAL_ERROR;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	307 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	308 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	309
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	310 if ( vsi_d_write ( TR_Data.Handle, 0, (void*)snd_ptr, btw) != VSI_OK )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	311 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	312 return DRV_INTERNAL_ERROR;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	313 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	314
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	315 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	316 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	317 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	318
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	319 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	320 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	321 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	322 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	323 \| STATE : code ROUTINE : TR_SetSignal \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	324 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	325
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	326 PURPOSE : enable signal for the driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	327
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	328 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	329 LOCAL USHORT TR_SetSignal ( USHORT SignalType )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	330 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	331 if ( !(SignalType & ALLOWED_TR_SIGNALS) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	332 return DRV_INVALID_PARAMS;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	333 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	334 TR_Data.EnabledSignalType \|= SignalType;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	335
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	336 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	337 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	338 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	339
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	340 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	341 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	342 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	343 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	344 \| STATE : code ROUTINE : TR_ResetSignal \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	345 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	346
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	347 PURPOSE : disable signal for the driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	348
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	349 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	350 LOCAL USHORT TR_ResetSignal ( USHORT SignalType )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	351 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	352 if ( !(SignalType & ALLOWED_TR_SIGNALS) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	353 return DRV_INVALID_PARAMS;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	354 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	355 TR_Data.EnabledSignalType &= ~SignalType;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	356
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	357 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	358 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	359 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	360
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	361 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	362 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	363 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	364 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	365 \| STATE : code ROUTINE : TR_SetConfig \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	366 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	367
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	368 PURPOSE : set configuration for the driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	369
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	370 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	371 LOCAL USHORT TR_SetConfig ( char *Buffer )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	372 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	373 if ( !strcmp ( TR_STX_LF, Buffer ) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	374 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	375 TR_Data.config = STX_LF_MODE;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	376 TR_Data.rcv_state = WAIT_FOR_STX;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	377 TR_Data.idle_state = WAIT_FOR_STX;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	378 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	379 printf ("TR: STX mode enabled\n");
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	380 #endif /* _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	381 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	382 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	383 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	384 else if ( !strcmp ( DRV_TI_MODE, Buffer ) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	385 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	386 TR_Data.config = TI_TRC_MODE;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	387 TR_Data.rcv_state = WAIT_FOR_TI_ID;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	388 TR_Data.idle_state = WAIT_FOR_TI_ID;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	389 printf ("TR: TI mode enabled\n");
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	390 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	391 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	392 #endif /* _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	393 else if ( !strcmp ( DRV_RAW_TI_MODE, Buffer ) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	394 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	395 TR_Data.config = TI_RAW_TRC_MODE;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	396 TR_Data.rcv_state = WAIT_FOR_RAW_TI_S;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	397 TR_Data.idle_state = WAIT_FOR_RAW_TI_S;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	398 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	399 printf ("TR: raw TI mode enabled\n");
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	400 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	401 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	402 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	403 else if ( !strcmp ( DRV_DEFAULT, Buffer ) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	404 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	405 TR_Data.config = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	406 TR_Data.rcv_state = WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	407 TR_Data.idle_state = WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	408 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	409 accessNum++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	410 PrintToFile("TR: default mode selected __________________________ (%d)\n", accessNum);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	411 #endif /* _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	412 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	413 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	414 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	415 return DRV_INVALID_PARAMS;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	416 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	417 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	418
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	419 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	420 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	421 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	422 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	423 \| STATE : code ROUTINE : Callback \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	424 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	425
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	426 PURPOSE : callback function of the driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	427
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	428 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	429 /lint -esym(644,infoByteAddr) suppress warning -- Symbol 'infoByteAddr' may not have been initialized /
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	430 LOCAL void TR_Callback ( T_DRV_SIGNAL *Signal )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	431 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	432 static T_DRV_SIGNAL TR_Signal;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	433 static USHORT counter = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	434 static char* infoByteAddr;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	435 int tr_abort_discard;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	436 int tr_abort;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	437 unsigned char c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	438 ULONG i;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	439 ULONG BytesToRead;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	440 ULONG BytesRead = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	441 ULONG TR_WorkInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	442 ULONG Bytes = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	443 USHORT continue_read;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	444 //#ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	445 static unsigned int ti_len = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	446 static char ti_id = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	447 static int sigtype = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	448 static int lf_found;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	449 static int crlf_found;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	450 static U8 mux_chan_id;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	451 static U8 mux_chan = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	452 static U8 mux_status = WAIT_FOR_MUX_CHAN_ID;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	453 static int stuffed_byte;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	454 //#endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	455
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	456 tr_abort_discard = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	457 tr_abort = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	458 TR_Signal.SignalType = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	459 switch ( Signal->SignalType )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	460 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	461 case DRV_SIGTYPE_READ:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	462 BytesToRead = TR_EndInd - TR_WrInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	463 TR_WorkInd = TR_WrInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	464
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	465 do
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	466 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	467 Bytes = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	468 do
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	469 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	470 continue_read = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	471 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	472 * write counter must not overtake the read counter. If more bytes to be read
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	473 * than space available, then process the bytes in the buffer first and then
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	474 * continue to store new data in the TR_RcvBuffer.
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	475 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	476 if ( TR_WrInd >= (TR_RdInd&TR_MaxInd) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	477 BytesToRead = TR_EndInd - TR_WrInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	478 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	479 BytesToRead = (TR_RdInd&TR_MaxInd) - TR_WrInd;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	480 BytesRead = BytesToRead;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	481 vsi_d_read ( TR_Data.Handle, 0, (void*)&TR_RcvBuffer[TR_WrInd], &BytesRead );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	482 Bytes += BytesRead;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	483 if ( BytesRead < BytesToRead )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	484 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	485 TR_WrInd += BytesRead;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	486 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	487 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	488 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	489 if ( TR_WrInd >= (TR_RdInd&TR_MaxInd) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	490 TR_WrInd = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	491 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	492 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	493 TR_WrInd += BytesRead;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	494 continue_read = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	495 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	496 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	497 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	498 } while ( BytesRead != TR_RcvBufferSize && BytesRead == BytesToRead );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	499
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	500 if ( Bytes )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	501 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	502 UBYTE cMasked;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	503
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	504 i=0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	505
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	506 while (i++ < Bytes)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	507 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	508 c = TR_RcvBuffer[(TR_WorkInd++) & TR_MaxInd];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	509
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	510 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	511 if (TR_Data.config & TI_RAW_TRC_MODE) /* we are receiving rawly in TI mode */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	512 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	513 if (!ti_esc_skipped && c==TI_ESC)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	514 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	515 /* the TI driver has inserted an TI_ESC -> skip it */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	516 ULONG q;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	517 for (q=TR_WorkInd-1; q>TR_RdInd; q--)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	518 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	519 TR_RcvBuffer[q & TR_MaxInd]=TR_RcvBuffer[(q-1) & TR_MaxInd];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	520 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	521 TR_RdInd++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	522 ti_esc_skipped=1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	523 continue;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	524 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	525 ti_esc_skipped=0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	526 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	527 #endif /* _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	528
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	529 if ( tr_abort_discard == 1 )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	530 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	531 TR_RdInd++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	532 continue;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	533 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	534 switch (TR_Data.rcv_state)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	535 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	536 case WAIT_FOR_STX:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	537 if (c == STX)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	538 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	539 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	540 ti_len=0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	541 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	542 TR_Data.rcv_state = WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	543 TR_RdInd = TR_WorkInd; /* do not pass the STX to TIF */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	544 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	545 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	546 TR_RdInd++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	547 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	548 //#ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	549 case WAIT_FOR_RAW_TI_S:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	550 if (c==TI_STX)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	551 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	552 TR_Data.rcv_state=WAIT_FOR_RAW_TI_ID;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	553 TR_RdInd = TR_WorkInd; /* do not read TI_STX */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	554 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	555 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	556 case WAIT_FOR_RAW_TI_ID:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	557 if (c==TI_STX)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	558 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	559 // last TI_STX was end ID -> ignore this start ID
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	560 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	561 else if (c==TI_L23_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	562 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	563 ti_len = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	564 ti_id = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	565 TR_Data.rcv_state=WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	566 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	567 else if (c == TI_L1_ID \|\| c == TI_RIV_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	568 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	569 ti_len = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	570 ti_id = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	571
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	572 if (ti_id == TI_L1_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	573 sigtype = DRV_SIGTYPE_READ_L1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	574 if (ti_id == TI_RIV_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	575 sigtype = DRV_SIGTYPE_READ_RIV;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	576
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	577 counter = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	578 TR_RdInd = TR_WorkInd; /* do not read ti_id */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	579 crlf_found = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	580 lf_found = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	581 TR_Data.rcv_state=WAIT_FOR_RAW_TI_E;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	582 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	583 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	584 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	585 mux_chan_id = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	586 if ( mux_status == WAIT_FOR_MUX_CHAN_ID )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	587 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	588 for ( mux_chan = 0; mux_chan < MAX_TST_CHANNEL; mux_chan++ )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	589 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	590 if ( tst_mux_chan_struct[mux_chan].channel_id == c )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	591 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	592 mux_status = WAIT_FOR_MUX_END_STX;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	593 tst_mux_chan_struct[mux_chan].rcv_data_ptr = &TR_RcvBuffer[(TR_WorkInd) & TR_MaxInd];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	594 tst_mux_chan_struct[mux_chan].rcv_data_size = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	595 stuffed_byte = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	596 TR_RdInd = TR_WorkInd; /* do not read id */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	597 TR_Data.rcv_state=WAIT_FOR_RAW_TI_E;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	598 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	599 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	600 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	601 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	602 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	603 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	604 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	605 case WAIT_FOR_TI_ID:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	606 /* skip TI ID byte */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	607 if (c == TI_L23_ID \|\| c == TI_L1_ID \|\| c == TI_RIV_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	608 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	609 ti_len = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	610 ti_id = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	611 TR_Data.rcv_state = WAIT_FOR_TI_LEN_0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	612 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	613 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	614 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	615 ti_id_not_found = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	616 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	617 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	618 case WAIT_FOR_TI_LEN_0:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	619 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	620 * skip length
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	621 * if length byte == 0 then the next 2 bytes are the length
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	622 * (patch to handle messages longer than 255 bytes)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	623 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	624 if ( c != 0 )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	625 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	626 if (ti_id == TI_L23_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	627 TR_Data.rcv_state = WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	628
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	629 if (ti_id == TI_L1_ID \|\| ti_id == TI_RIV_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	630 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	631 if (ti_id == TI_L1_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	632 sigtype = DRV_SIGTYPE_READ_L1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	633 if (ti_id == TI_RIV_ID)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	634 sigtype = DRV_SIGTYPE_READ_RIV;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	635
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	636 TR_Data.rcv_state = WAIT_FOR_DATA;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	637 counter = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	638 TR_RdInd += 2; /* do not read ti_id and length */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	639 crlf_found = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	640 lf_found = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	641 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	642 ti_len = c & 0xff;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	643 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	644 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	645 TR_Data.rcv_state = WAIT_FOR_TI_LEN_1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	646
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	647 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	648 case WAIT_FOR_TI_LEN_1:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	649 ti_len = c ;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	650 TR_Data.rcv_state = WAIT_FOR_TI_LEN_2;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	651 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	652 case WAIT_FOR_TI_LEN_2:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	653 ti_len \|= c << 8;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	654 TR_Data.rcv_state = WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	655 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	656 #endif /* ifdef _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	657
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	658 case WAIT_FOR_IDENT:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	659 infoByteAddr = &TR_RcvBuffer[(TR_WorkInd - 1) & TR_MaxInd];
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	660 /* analyze INFO Byte */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	661 cMasked = (c & HDR_VERSION_MASK);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	662 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	663 if (cMasked == HDR_VALID_VERSION_0)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	664 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	665 i--; TR_WorkInd--;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	666 printf ("TR: changed to OLD header format automatically\n");
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	667 // tst_drv_write ( NO_TASK, SYS_MASK, FRM_TST_NAME, (char*)SYSPRIM_GET_STACK_TIME );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	668 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	669 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	670 /* check for lost bytes on interface */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	671 if (TR_Data.config & TI_TRC_MODE \|\|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	672 TR_Data.config & TI_RAW_TRC_MODE) /* we are receiving from a arm 7 TARGET */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	673 { /* TR_WorkInd refs position of first size byte now */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	674 if (ti_id_not_found)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	675 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	676 infoByteAddr = (( infoByteAddr & ~HDR_IDENT_MASK) \| IDENT_ABORT); /* mark as bad */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	677 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	678 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	679 #endif /* ifdef _TOOLS_ */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	680 cMasked = (c & HDR_IDENT_MASK);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	681 if (((cMasked == IDENT_PS_PRIM) \|\| (cMasked == IDENT_SYS_PRIM) \|\|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	682 (cMasked == IDENT_ABORT) \|\| (cMasked == IDENT_TRACE))
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	683 &&
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	684 ((c != PROT_PRIM_ID) && (c != PROT_PRIM_ID_32BIT) &&
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	685 (c != SYS_PRIM_ID) && (c != TRACE_ID))
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	686 )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	687 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	688 /* Hey fine, everything went OK! */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	689 TR_Data.rcv_state = WAIT_FOR_LENGTH1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	690 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	691 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	692 { /* we have to fake a length for abort trace */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	693 tst_trailer_size.part[0] = TST_HEADER_LEADING_FIELDS;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	694 tst_trailer_size.part[1] = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	695 MessageLength = tst_trailer_size.val + TST_HEADER_TRAILING_FIELDS;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	696
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	697 infoByteAddr = (( infoByteAddr & ~HDR_IDENT_MASK) \| IDENT_ABORT); /* mark as bad */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	698 counter = tst_trailer_size.val; /* don't let us read all the following bytes before let TIF tracing ABORT */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	699 TR_Data.rcv_state = WAIT_FOR_DATA;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	700 tr_abort = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	701 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	702 TR_RdInd = TR_WorkInd - 1; /* skip all preceeding interface sync bytes before triggering TIF */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	703 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	704 case WAIT_FOR_LENGTH1:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	705 /* the use of the union does rely on identical byte sex! */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	706 #ifdef _SOLARIS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	707 /* temporary hack */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	708 tst_trailer_size.part[1] = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	709 #else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	710 tst_trailer_size.part[0] = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	711 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	712 TR_Data.rcv_state = WAIT_FOR_LENGTH2;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	713 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	714 case WAIT_FOR_LENGTH2:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	715 #ifdef _SOLARIS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	716 /* temporary hack */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	717 tst_trailer_size.part[0] = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	718 #else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	719 tst_trailer_size.part[1] = c;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	720 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	721 /* Bytes after size + bytes till size (inclusive) */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	722 MessageLength = tst_trailer_size.val + TST_HEADER_LEADING_FIELDS;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	723 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	724 /* In case of a lost character the two length information elements mismatch. */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	725 if ( (ti_len != 0) && (tst_trailer_size.val != (ti_len - 3)) )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	726 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	727 tst_trailer_size.val = ti_len - 3;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	728 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	729 ti_len = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	730 if ((tst_trailer_size.val - TST_HEADER_TRAILING_FIELDS) > (unsigned short int)(MAX_PRIM_PARTITION_SIZE - sizeof(T_PRIM_HEADER) - sizeof(T_S_HEADER)))
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	731 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	732 infoByteAddr = (( infoByteAddr & ~HDR_IDENT_MASK) \| IDENT_ABORT); /* mark as bad */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	733 tst_trailer_size.val = (MAX_PRIM_PARTITION_SIZE - sizeof(T_PRIM_HEADER) - sizeof(T_S_HEADER) -TST_HEADER_TRAILING_FIELDS);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	734 counter = tst_trailer_size.val; /* don't let us read all the following bytes before let TIF tracing ABORT */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	735 tr_abort = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	736 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	737 #else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	738 if ((tst_trailer_size.val - TST_HEADER_TRAILING_FIELDS) > (unsigned short int)(MaxPrimPartSize - sizeof(T_PRIM_HEADER) - sizeof(T_S_HEADER)))
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	739 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	740 infoByteAddr = (( infoByteAddr & ~HDR_IDENT_MASK) \| IDENT_ABORT); /* mark as bad */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	741 tst_trailer_size.val = (USHORT)(MaxPrimPartSize - sizeof(T_PRIM_HEADER) - sizeof(T_S_HEADER) -TST_HEADER_TRAILING_FIELDS);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	742 counter = tst_trailer_size.val; /* don't let us read all the following bytes before let TIF tracing ABORT */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	743 tr_abort = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	744 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	745 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	746 TR_Data.rcv_state = WAIT_FOR_DATA;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	747 counter = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	748 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	749 case WAIT_FOR_RAW_TI_E:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	750 if ( mux_status == WAIT_FOR_MUX_END_STX )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	751 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	752 if ( stuffed_byte )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	753 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	754 stuffed_byte = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	755 tst_mux_chan_struct[mux_chan].rcv_data_size++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	756 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	757 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	758 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	759 if ( c != TI_STX )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	760 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	761 if ( c == 0x10 )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	762 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	763 stuffed_byte = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	764 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	765 tst_mux_chan_struct[mux_chan].rcv_data_size++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	766 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	767 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	768 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	769 tst_mux_callback (mux_chan,tst_mux_chan_struct[mux_chan].rcv_data_ptr, tst_mux_chan_struct[mux_chan].rcv_data_size);
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	770 mux_status = WAIT_FOR_MUX_CHAN_ID;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	771 MessageLength = tst_mux_chan_struct[mux_chan].rcv_data_size;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	772 TR_Data.rcv_state = WAIT_FOR_RAW_TI_S;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	773 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	774 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	775 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	776 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	777 if (c!=TI_STX)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	778 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	779 if ( counter == 0 && c == 0x0a )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	780 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	781 lf_found = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	782 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	783 if ( lf_found && counter == 1 && c == 0x0d)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	784 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	785 crlf_found = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	786 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	787 counter++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	788 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	789 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	790 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	791 if ( TR_Data.EnabledSignalType & DRV_SIGTYPE_READ )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	792 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	793 ti_len=counter;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	794 if ( crlf_found == 1 )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	795 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	796 ti_len -= 2;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	797 TR_RdInd += 2; /* do not read CR and LF at the beginning */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	798 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	799 MessageLength = ti_len;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	800 TR_Signal.SignalType = sigtype;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	801 TR_Signal.DrvHandle = TR_Data.Handle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	802 (TR_Data.Callback)( &TR_Signal );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	803 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	804 TR_Data.rcv_state = TR_Data.idle_state;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	805 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	806 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	807 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	808 case WAIT_FOR_DATA:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	809 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	810 if ( ti_len )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	811 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	812 if ( counter == 0 && c == 0x0a )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	813 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	814 lf_found = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	815 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	816 if ( lf_found && counter == 1 && c == 0x0d)
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	817 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	818 crlf_found = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	819 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	820 if ( ++counter >= ti_len )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	821 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	822 if ( TR_Data.EnabledSignalType & DRV_SIGTYPE_READ )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	823 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	824 if ( crlf_found == 1 )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	825 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	826 ti_len -= 2;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	827 TR_RdInd += 2; /* do not read CR and LF at the beginning */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	828 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	829 MessageLength = ti_len;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	830 TR_Signal.SignalType = sigtype;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	831 TR_Signal.DrvHandle = TR_Data.Handle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	832 (TR_Data.Callback)( &TR_Signal );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	833 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	834 TR_Data.rcv_state = TR_Data.idle_state;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	835 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	836 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	837 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	838 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	839 if (++counter >= tst_trailer_size.val) /* If all went OK up to now we have to read all remaining bytes from the buffer each for each */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	840 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	841 if (TR_Data.config & STX_LF_MODE )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	842 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	843 TR_Data.rcv_state = WAIT_FOR_CR;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	844 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	845 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	846 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	847 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	848 if ( TR_Data.EnabledSignalType & DRV_SIGTYPE_READ )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	849 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	850 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	851 tst_message_received = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	852 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	853 TR_Signal.SignalType = DRV_SIGTYPE_READ;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	854 TR_Signal.DrvHandle = TR_Data.Handle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	855 (TR_Data.Callback)( &TR_Signal );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	856 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	857 TR_Data.rcv_state = TR_Data.idle_state;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	858 tst_trailer_size.val = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	859 if ( tr_abort == 1 ) /* marked as bad */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	860 tr_abort_discard = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	861 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	862 ti_id_not_found = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	863 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	864 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	865 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	866 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	867 case WAIT_FOR_CR:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	868 #ifdef _TOOLS_ /* check for lost bytes on interface */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	869 if (TR_Data.config & STX_LF_MODE ) /* we are receiving from a arm 9 TARGET or Windows stack configured stx */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	870 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	871 if (c != '\n')
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	872 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	873 infoByteAddr = (( infoByteAddr & ~HDR_IDENT_MASK) \| IDENT_ABORT); /* mark as bad */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	874 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	875 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	876 #endif /* _TOOLS_ check for lost bytes on interface */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	877 if ( TR_Data.EnabledSignalType & DRV_SIGTYPE_READ )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	878 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	879 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	880 tst_message_received = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	881 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	882 TR_Signal.SignalType = DRV_SIGTYPE_READ;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	883 TR_Signal.DrvHandle = TR_Data.Handle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	884 (TR_Data.Callback)( &TR_Signal );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	885 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	886 TR_Data.rcv_state = TR_Data.idle_state;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	887 tst_trailer_size.val = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	888 if ( tr_abort == 1 ) /* marked as bad */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	889 tr_abort_discard = 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	890 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	891 default:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	892 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	893 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	894 } /* while (i++ < Bytes) */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	895 } /* if Bytes loop */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	896 } while ( continue_read == 1 );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	897 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	898 case DRV_SIGTYPE_CONNECT:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	899 case DRV_SIGTYPE_DISCONNECT:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	900 if ( TR_Data.EnabledSignalType & Signal->SignalType )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	901 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	902 TR_Signal.SignalType = Signal->SignalType;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	903 TR_Signal.DrvHandle = TR_Data.Handle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	904 (TR_Data.Callback)( &TR_Signal );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	905 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	906 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	907 default:
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	908 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	909 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	910 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	911 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	912
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	913 #ifndef RUN_INT_RAM
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	914 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	915 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	916 \| PROJECT : GSM-Frame (8415) MODULE : TR \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	917 \| STATE : code ROUTINE : TR_Init \|
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	918 +--------------------------------------------------------------------+
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	919
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	920 PURPOSE : initialize driver
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	921
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	922 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	923 USHORT TR_Init ( USHORT DrvHandle, T_DRV_CB_FUNC CallbackFunc, T_DRV_EXPORT const **DrvInfo )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	924 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	925 USHORT j;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	926 ULONG size = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	927 static const T_DRV_EXPORT TR_Info =
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	928 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	929 "TR",
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	930 0,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	931 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	932 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	933 TR_Init,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	934 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	935 TR_Exit,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	936 TR_Read,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	937 TR_Write,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	938 NULL,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	939 NULL,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	940 NULL,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	941 TR_SetSignal,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	942 TR_ResetSignal,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	943 TR_SetConfig,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	944 NULL,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	945 TR_Callback,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	946 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	947 };
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	948
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	949 TR_Data.Handle = DrvHandle;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	950
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	951 TR_Data.EnabledSignalType = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	952
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	953 TR_Data.config = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	954
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	955 TR_Data.rcv_state = WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	956
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	957 TR_Data.idle_state = WAIT_FOR_IDENT;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	958
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	959 TR_Data.Callback = CallbackFunc;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	960
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	961 *DrvInfo = &TR_Info;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	962
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	963 /*
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	964 * TR_RcvBufferSize must be a power of 2 for proper wrap-around
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	965 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	966 #ifndef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	967 TR_RcvBufferSize = MaxPrimPartSize;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	968 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	969 j = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	970 do
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	971 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	972 if ( (ULONG)(1 << j) >= TR_RcvBufferSize ) /* Size must be a power of 2 */
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	973 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	974 size = 1 << j;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	975 break;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	976 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	977 else
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	978 j++;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	979 } while ( size < 0xffff );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	980
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	981 TR_RcvBufferSize = size;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	982 TR_MaxInd = TR_RcvBufferSize - 1;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	983
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	984 if ( os_AllocateMemory ( NO_TASK, &TR_Data.RcvBuffer, (ULONG)TR_RcvBufferSize,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	985 OS_NO_SUSPEND, ext_data_pool_handle ) != OS_OK )
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	986 {
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	987 vsi_o_assert ( NO_TASK, OS_SYST_ERR_NO_MEMORY, __FILE__, __LINE__,
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	988 "No memory available in TR driver, TR_RcvBufferSize = %d",
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	989 TR_RcvBufferSize );
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	990 return DRV_INITFAILURE;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	991 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	992
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	993 TR_RcvBuffer = (char*)TR_Data.RcvBuffer;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	994 TR_EndInd = TR_RcvBufferSize;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	995 TR_WrInd = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	996 TR_RdInd = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	997 tst_trailer_size.val = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	998 #ifdef _TOOLS_
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	999 ti_id_not_found = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	1000 ti_esc_skipped = 0;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	1001 #endif
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	1002
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	1003 return DRV_OK;
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	1004 }
509db1a7b7b8 initial import: leo2moko-r1 Space Falcon <falcon@ivan.Harhan.ORG> parents: diff changeset	1005 #endif

FreeCalypso > hg > tcs211-l1-reconst

annotate gpf/tst/DRV/tr2.c @ 249:b5f180a36b22