FreeCalypso > hg > fc-magnetite
view src/gpf2/tst/drv/titrc.c @ 663:cf1cfe12a54a
AT@SPENH command implemented in aci3
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 24 May 2020 06:53:25 +0000 |
parents | cd37d228dae0 |
children |
line wrap: on
line source
/* +------------------------------------------------------------------------------ | 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