freecalypso-sw: gsm-fw/gpf/tst

annotate gsm-fw/gpf/tst_drv/tr2.c @ 900:2caa749fae34

gsm-fw: DSP patch codes added, extracted from TCS211 with tiobjd chararray

author	Space Falcon <falcon@ivan.Harhan.ORG>
date	Sun, 05 Jul 2015 03:05:13 +0000
parents	ffb0442ffccf
children

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

FreeCalypso > hg > freecalypso-sw

annotate gsm-fw/gpf/tst_drv/tr2.c @ 900:2caa749fae34