--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/gpf/tst/drv/titrc.c	Fri Oct 16 06:23:26 2020 +0000
@@ -0,0 +1,321 @@
+/* 
++------------------------------------------------------------------------------
+|  File:       titrc.c
++------------------------------------------------------------------------------
+|  Copyright 2004 Texas Instruments Deutschland, AG 
+|                 All rights reserved. 
+| 
+|                 This file is confidential and a trade secret of Texas 
+|                 Instruments Berlin, AG 
+|                 The receipt of or possession of this file does not convey 
+|                 any rights to reproduce or disclose its contents or to 
+|                 manufacture, use, or sell anything it may describe, in 
+|                 whole, or in part, without the specific written consent of 
+|                 Texas Instruments Deutschland, AG. 
++----------------------------------------------------------------------------- 
+|  Purpose :  This Module defines the functionality of the TITRC driver
+|             to communicate with the TI trace task.
++----------------------------------------------------------------------------- 
+*/ 
+
+
+#ifndef __TITRC_C__
+#define __TITRC_C__
+#endif
+
+#include "typedefs.h"
+#include "string.h"
+#include "tstheader.h"
+#include "rvt_gen.h"
+#include "gdi.h"
+#include "serialswitch.h"
+
+/*==== TYPES ======================================================*/
+
+typedef struct
+{
+  USHORT Handle;
+  USHORT EnabledSignalType;
+  T_DRV_CB_FUNC Callback;
+  T_RVT_USER_ID trc_id;
+  unsigned char connected;
+  T_RVT_BUFFER read_ptr;
+  unsigned int read_len;
+} T_TITRC_DATA;
+
+/*==== CONSTANTS ==================================================*/
+
+#define ALLOWED_TITRC_SIGNALS   (DRV_SIGTYPE_READ|DRV_SIGTYPE_CONNECT) 
+
+
+/*==== EXTERNALS ==================================================*/
+
+extern USHORT emergeny_trace;
+
+/*==== VARIABLES ==================================================*/
+
+#ifndef RUN_INT_RAM
+T_TITRC_DATA TITRC_Data;
+T_DRV_SIGNAL Signal;
+#else
+extern T_TITRC_DATA TITRC_Data;
+#endif
+
+#ifndef RUN_FLASH
+char header_buffer[TST_BIG_HEADER_SIZE];
+#endif
+
+/*==== FUNCTIONS ==================================================*/
+
+#ifndef RUN_INT_RAM
+extern USHORT TITRC_Write ( void *Buffer, ULONG *BytesToWrite ) ;
+#endif
+
+#ifndef RUN_INT_RAM
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-Frame (8415)           MODULE  : TITRC               |
+| STATE   : code                       ROUTINE : TITRC_Read          |
++--------------------------------------------------------------------+
+
+  PURPOSE : read data from driver
+
+*/
+USHORT TITRC_Read ( void *Buffer, ULONG *BytesToRead )
+{
+
+  if ( TITRC_Data.read_ptr )
+  {
+    if ( *BytesToRead != 0 )
+    {
+      if ( *BytesToRead > TITRC_Data.read_len )
+        *BytesToRead = TITRC_Data.read_len;
+
+      memcpy ( Buffer, TITRC_Data.read_ptr, *BytesToRead );
+
+      if ( *BytesToRead < TITRC_Data.read_len )
+      {
+        TITRC_Data.read_ptr += *BytesToRead;
+        TITRC_Data.read_len -= *BytesToRead;
+      }
+      else
+        TITRC_Data.read_ptr = NULL;
+    }
+    else
+    {
+      *BytesToRead = TITRC_Data.read_len;
+    }
+  }
+  else
+  {
+    *BytesToRead = 0;
+  }
+
+  return DRV_OK;
+}
+#endif
+
+#ifndef RUN_FLASH
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-Frame (8415)           MODULE  : TITRC               |
+| STATE   : code                       ROUTINE : TITRC_Write         |
++--------------------------------------------------------------------+
+
+  PURPOSE : write data to driver
+
+*/
+USHORT TITRC_Write ( void *Buffer, ULONG *BytesToWrite )
+{
+T_RVT_FORMAT msg_format;
+char *ptr = (char*)Buffer;
+ULONG BytesWritten;
+ULONG ToWrite;
+T_RVT_BUFFER rvt_buffer;
+
+  msg_format = RVT_BINARY_FORMAT;
+
+  if ( emergeny_trace )
+  {
+    ptr--;
+    *ptr = 0x13;
+    ToWrite = (ULONG)*BytesToWrite;
+    ToWrite += 1;
+    BytesWritten = (ULONG)SER_tr_WriteNBytes (1, (SYS_UWORD8*)ptr, (SYS_UWORD32)ToWrite);
+    *BytesToWrite = BytesWritten;
+  }
+  else
+  {
+    if ( *BytesToWrite & PRIM_HEADER_FLAG )
+    {
+      memcpy ( header_buffer, (char*)Buffer, TST_BIG_HEADER_SIZE );
+      return DRV_OK;
+    }
+    if ( *BytesToWrite & PRIM_DATA_FLAG )
+    {
+      ToWrite = *BytesToWrite & ~PRIM_DATA_FLAG;
+      if ( rvt_mem_alloc(TITRC_Data.trc_id, ToWrite+TST_BIG_HEADER_SIZE, &rvt_buffer) != RVT_OK )
+        return DRV_BUFFER_FULL;
+      if ( rvt_buffer != NULL )
+      {
+        memcpy ( (char*)rvt_buffer, header_buffer, TST_BIG_HEADER_SIZE );
+        memcpy ( (char*)rvt_buffer+TST_BIG_HEADER_SIZE, (char*)Buffer, ToWrite );
+        if ( rvt_send_trace_no_cpy ( rvt_buffer, TITRC_Data.trc_id, (T_RVT_MSG_LG)ToWrite+TST_BIG_HEADER_SIZE, msg_format ) != RVT_OK )
+          return DRV_BUFFER_FULL;
+        else
+          return DRV_OK;
+      }
+    }
+    if ( rvt_send_trace_cpy ( (T_RVT_BUFFER)Buffer, TITRC_Data.trc_id, (T_RVT_MSG_LG)*BytesToWrite, msg_format ) != RVT_OK )
+      return DRV_BUFFER_FULL;
+  }
+  return DRV_OK;
+}
+#endif
+
+#ifndef RUN_INT_RAM
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-Frame (8415)           MODULE  : TITRC               |
+| STATE   : code                       ROUTINE : TITRC_SetSignal     |
++--------------------------------------------------------------------+
+
+  PURPOSE : enable signal for the driver
+
+*/
+USHORT TITRC_SetSignal ( USHORT SignalType )
+{
+	if ( !(SignalType & ALLOWED_TITRC_SIGNALS) )
+    return DRV_INVALID_PARAMS;
+  else
+    TITRC_Data.EnabledSignalType |= SignalType;
+  
+  return DRV_OK;
+}
+#endif
+
+#ifndef RUN_INT_RAM
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-Frame (8415)           MODULE  : TITRC               |
+| STATE   : code                       ROUTINE : TITRC_ResetSignal   |
++--------------------------------------------------------------------+
+
+  PURPOSE : disable signal for the driver
+
+*/
+USHORT TITRC_ResetSignal ( USHORT SignalType )
+{
+	if ( !(SignalType & ALLOWED_TITRC_SIGNALS) )
+    return DRV_INVALID_PARAMS;
+  else
+    TITRC_Data.EnabledSignalType &= ~SignalType;
+  
+  return DRV_OK;
+}
+#endif
+
+#ifndef RUN_INT_RAM
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-Frame (8415)           MODULE  : TITRC               |
+| STATE   : code                       ROUTINE : TITRC_SetConfig     |
++--------------------------------------------------------------------+
+
+  PURPOSE : set configuration for the driver
+
+*/
+USHORT TITRC_SetConfig ( char *Buffer )
+{
+
+  if ( TITRC_Data.connected == FALSE )
+  {
+    Signal.SignalType = DRV_SIGTYPE_CONNECT;
+	  Signal.DrvHandle = TITRC_Data.Handle;
+    (TITRC_Data.Callback)( &Signal );
+    TITRC_Data.connected = TRUE;
+  }
+  return DRV_OK;
+}
+#endif
+
+#ifndef RUN_INT_RAM
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-Frame (8415)           MODULE  : TITRC               |
+| STATE   : code                       ROUTINE : TITRC_Callback      |
++--------------------------------------------------------------------+
+
+  PURPOSE : callback function of the driver
+
+*/
+int callback_busy = 0;
+void TITRC_Callback ( T_RVT_BUFFER ptr, UINT16 len )
+{
+  if ( 	callback_busy == 1 )
+    for (;;)
+      ;
+
+	callback_busy = 1;
+  if ( TITRC_Data.EnabledSignalType & DRV_SIGTYPE_READ )
+  {
+    TITRC_Data.read_ptr = ptr;
+    TITRC_Data.read_len = len;
+    Signal.SignalType = DRV_SIGTYPE_READ;
+	  Signal.DrvHandle = TITRC_Data.Handle;
+    (TITRC_Data.Callback)( &Signal );
+  }
+	callback_busy = 0;
+}
+#endif
+
+#ifndef RUN_INT_RAM
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-Frame (8415)           MODULE  : TITRC               |
+| STATE   : code                       ROUTINE : TITRC_Init          |
++--------------------------------------------------------------------+
+
+  PURPOSE : initialize driver
+
+*/
+USHORT TITRC_Init ( USHORT DrvHandle, T_DRV_CB_FUNC CallbackFunc, T_DRV_EXPORT const **DrvInfo )
+{                
+static const T_DRV_EXPORT TITRC_Info =
+{
+  "TITRC",
+  0,
+  {
+#ifdef _TOOLS_
+    TITRC_Init,
+#endif
+    NULL,
+    TITRC_Read,
+    TITRC_Write,
+    NULL,
+    NULL,
+    NULL,
+    TITRC_SetSignal,
+    TITRC_ResetSignal,
+    TITRC_SetConfig,
+    NULL,
+    NULL,
+  }
+};
+
+  TITRC_Data.connected = FALSE;
+    
+  TITRC_Data.Handle = DrvHandle;
+
+  TITRC_Data.EnabledSignalType = 0;
+
+  TITRC_Data.Callback = CallbackFunc;
+
+  if ( rvt_register_id ( (char*)"L23",&TITRC_Data.trc_id, TITRC_Callback ) == RVT_INVALID_PARAMETER )
+    return DRV_INITFAILURE;
+
+  *DrvInfo = &TITRC_Info;
+
+  return DRV_OK;           
+}
+#endif