view src/gpf2/tst/drv/thif_link.c @ 549:69e52afc01d5

configs/* except classic: rebuild tif_na7_db_{fl,ir} from source The purpose of this change is to allow a TRACEMASK_IN_FFS=1 setting given on the configure line to have effect; all configs except classic are included because this feature setting is orthogonal to the choice of G23M PS version and other config choices. (The classic config is an exception because its very purpose is to preserve a reference config with all of the original blobs.) Note that even though we are switching these TIF libraries from blobs to recompilation from source in all configs, our source for these libs compiles into a perfect match to the original blobs in the current default TRACEMASK_IN_FFS=0 configuration, hence there is no effective change beyond the unfortunate small increase in compilation times.
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 18 Nov 2018 08:33:30 +0000
parents cd37d228dae0
children
line wrap: on
line source

/* 
+------------------------------------------------------------------------------
|  File:       thif_link.c
+------------------------------------------------------------------------------
|  Copyright 2002 Texas Instruments Berlin, 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 Berlin, AG. 
+----------------------------------------------------------------------------- 
|  Purpose :  This Modul contains the serial driver adaptation
+----------------------------------------------------------------------------- 
*/ 

#ifndef __THIF_LINK_C__
#define __THIF_LINK_C__
#endif

/* these types are used in thif_socket.h */
#define Char char
#define Bool8 char
#define Int8 signed char
#define Uint8 unsigned char
#define UInt16 unsigned short int 
#define Uint16 unsigned short int 
#define Uint32 unsigned long int
#define Int32  long int


#ifdef _TARGET_ 
  #include "thif_link.h"
  #include "\global_af\thif\thif_socket.h" 
  #include "string.h"
#else
 #include <windows.h>
 #include <stdio.h>
 #include "usart.h"
 #include "stdlib.h"
 #include "string.h"
 #include "tools.h"
#endif

#include "vsi.h"
#include "drvconf.h"
#include "tstheader.h"
#include "os.h"





/*==== TYPES ======================================================*/

typedef struct
{
  USHORT Handle;
  USHORT EnabledSignalType;
  T_DRV_CB_FUNC Callback;
  char Connected;
  Int8 thif_link;
} T_THIF_LINK_DATA;


typedef union {
  USHORT scalar;
  Uint8 array[2];
} SWAPPER;

/*==== CONSTANTS ==================================================*/

#define ALLOWED_THIF_LINK_SIGNALS   (DRV_SIGTYPE_READ|DRV_SIGTYPE_CONNECT)
#define MAX_CONFIGSTR_LEN 50
#define NO_GOTDATA_CALLBACK 0
#define rxBufSz 0x800
#define txBufSz  0x800
#define WAIT_FOR_RECONNECT 500

/*==== EXTERNALS ==================================================*/


/*==== VARIABLES ==================================================*/

T_THIF_LINK_DATA THIF_LINK_Data;
static T_DRV_SIGNAL Signal;


Uint8 rxBuffer[rxBufSz];
Uint8 txBuffer[txBufSz];
Uint8 *prxBuffer = &rxBuffer[0];
Uint8 *ptxBuffer = &txBuffer[0];

GLOBAL OS_TIME WT;
GLOBAL OS_TIME RT;

/* static unsigned long int foolishSizeArgument = 0; */


/*==== FUNCTIONS ==================================================*/

#ifndef MIN
#  define MIN(a,b)  (((a) < (b)) ? (a) : (b))
#endif

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : swapUSHORT            |
+--------------------------------------------------------------------+

  PURPOSE : byte sex handling

*/
void swapUSHORT(USHORT* candidate)
{
  SWAPPER source;
  SWAPPER dest;
  
  source.scalar = *candidate;
  dest.array[0] = source.array[1];
  dest.array[1] = source.array[0];
  *candidate = dest.scalar;
  
}
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : beSureToBeConnected            |
+--------------------------------------------------------------------+

  PURPOSE : callback function of the driver

*/

void beSureToBeConnected()
{
  if (THIF_LINK_Data.thif_link < 0)
  {
    thif_link_Open();
  }
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_binding_Callback            |
+--------------------------------------------------------------------+

  PURPOSE : callback function of the driver

*/
void thif_binding_Callback (Int8 sockId) /* this is a bridge to connect the THIF binding callback to the TR-defined callback (see thif_link_Open) */
{
  if ( THIF_LINK_Data.EnabledSignalType & DRV_SIGTYPE_READ )
  {
    Signal.SignalType = DRV_SIGTYPE_READ;
    Signal.DrvHandle = THIF_LINK_Data.Handle;
    (THIF_LINK_Data.Callback)( &Signal );
  }
}


/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Exit            |
+--------------------------------------------------------------------+

  PURPOSE : exit a driver

*/
void thif_link_Exit ( void )
{
  thif_link_Close();
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Open            |
+--------------------------------------------------------------------+

  PURPOSE : open connection to driver

*/
USHORT thif_link_Open(void)
{
  LONG result = -1;

  while (result < 0)
  {
    result = thif_socket_open(THIF_LINK_NAME, thif_binding_Callback, prxBuffer, rxBufSz, ptxBuffer, txBufSz );
    if (result < 0)
    {
      //os_SuspendTask ( 0, WAIT_FOR_RECONNECT);
    }
  }
  THIF_LINK_Data.thif_link = result;
  THIF_LINK_Data.EnabledSignalType = DRV_SIGTYPE_READ;

  Signal.SignalType = DRV_SIGTYPE_CONNECT;
  Signal.DrvHandle = THIF_LINK_Data.Handle;
  Signal.UserData = NULL;
  (THIF_LINK_Data.Callback)( &Signal );
  
  THIF_LINK_Data.Connected = TRUE;
  return DRV_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Close            |
+--------------------------------------------------------------------+

  PURPOSE : exit a driver

*/
USHORT thif_link_Close(void )
{
  if (thif_socket_close(THIF_LINK_Data.thif_link)  < 0)
  {
    return DRV_INTERNAL_ERROR;
  }
  THIF_LINK_Data.thif_link = -1;
  THIF_LINK_Data.EnabledSignalType = DRV_SIGTYPE_DISCONNECT;

  Signal.DrvHandle = THIF_LINK_Data.Handle;
  Signal.UserData = NULL;
  (THIF_LINK_Data.Callback)( &Signal );

  THIF_LINK_Data.Connected = FALSE;
  return DRV_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Read            |
+--------------------------------------------------------------------+

  PURPOSE : read data from driver

*/
USHORT thif_link_Read ( void *Buffer, ULONG *SizeInBytes)
{  

  OS_TIME timeBefore;
  OS_TIME timeAfter;
  T_HANDLE caller;
  USHORT retVal;

/*  
  ULONG to_read = *SizeInBytes;
  Uint8* buff = (Uint8*) Buffer;
  
  beSureToBeConnected();
  caller = os_MyHandle();

  if (foolishSizeArgument == 0)
  {
    to_read = thif_socket_read(THIF_LINK_Data.thif_link, buff, 2);
    foolishSizeArgument = buff[0]*0xff + buff[1];
  }
  to_read= foolishSizeArgument;

  //os_GetTime (caller,  &timeBefore);
  to_read = MIN(to_read, *SizeInBytes);
  *SizeInBytes = thif_socket_read(THIF_LINK_Data.thif_link, buff, to_read);
 
  if (*SizeInBytes <= foolishSizeArgument)
  {
    foolishSizeArgument -= *SizeInBytes;
    retVal = DRV_OK;
  }
  else
  {
    foolishSizeArgument = 0;
    retVal = DRV_INTERNAL_ERROR;
  }
  
  //os_GetTime (caller,  &timeAfter);
  //RT= timeAfter - timeBefore;
  return retVal;
*/
  *SizeInBytes = thif_socket_read( THIF_LINK_Data.thif_link, Buffer, *SizeInBytes ); 
  return DRV_OK;

}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Write_to_socket           |
+--------------------------------------------------------------------+

  PURPOSE : write data to driver

*/
void thif_link_Write_to_socket (void *Buffer, ULONG sizeInBytes )
{
  T_HANDLE caller;
  Uint8* buff;

  OS_TIME timeBefore;
  OS_TIME timeAfter;
  ULONG to_write;
    
  LONG written = -1;


  buff = (Uint8*) Buffer;
  to_write = sizeInBytes;
  caller = os_MyHandle();
  while (to_write > 0)
  {
    //os_GetTime (caller,  &timeBefore);
    written = thif_socket_write(THIF_LINK_Data.thif_link, buff, to_write);
    //os_GetTime (caller,  &timeAfter);
    //WT = timeAfter - timeBefore;
    if (written < 0)
    {
      //os_SuspendTask (caller, WAIT_FOR_RECONNECT);
    }
    else if (written == 0)
    {
      os_SuspendTask (caller, 2000);
      //break;
    }
    else
    {
      to_write -= written;
      buff += written;
    }
  }
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Write           |
+--------------------------------------------------------------------+

  PURPOSE : relay 2 byte header & data to thif_link_Write_to_socket

*/
USHORT thif_link_Write ( void *Buffer, ULONG *SizeInBytes )
{
  USHORT TSTSocketMarker;
  Uint8* buff;

  beSureToBeConnected();

  /* TST's socket interface expects a 2-byte header containing the length of the real message  to receive
      in funtion socket_Read.  We just send that header, converting it to little endian in advance 
  TSTSocketMarker = (USHORT) *SizeInBytes;
  swapUSHORT(&TSTSocketMarker);

  buff = (Uint8*) &TSTSocketMarker;
  thif_link_Write_to_socket( buff, 2);
  */
  
  buff = (Uint8*) Buffer;
  thif_link_Write_to_socket(buff, *SizeInBytes);
  
  //thif_socket_flush(THIF_LINK_Data.thif_link);
  return DRV_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Flush           |
+--------------------------------------------------------------------+

  PURPOSE : flush  data to driver

*/
USHORT thif_link_Flush (void)
{
  beSureToBeConnected();
  return thif_socket_flush(THIF_LINK_Data.thif_link);
}


/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_SetSignal       |
+--------------------------------------------------------------------+

  PURPOSE : enable signal for the driver

*/
USHORT thif_link_SetSignal ( USHORT SignalType )
{
  if ( !(SignalType & ALLOWED_THIF_LINK_SIGNALS) )
  {
    return DRV_INVALID_PARAMS;
  }
  else
  {
    THIF_LINK_Data.EnabledSignalType |= SignalType;
  }

  return DRV_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_ResetSignal     |
+--------------------------------------------------------------------+

  PURPOSE : disable signal for the driver

*/
USHORT thif_link_ResetSignal ( USHORT SignalType )
{
  if ( !(SignalType & ALLOWED_THIF_LINK_SIGNALS) )
  {
    return DRV_INVALID_PARAMS;
  }
  else
  {
    THIF_LINK_Data.EnabledSignalType &= ~SignalType;
  }

  return DRV_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_SetConfig       |
+--------------------------------------------------------------------+

  PURPOSE : set configuration for the driver

*/
USHORT thif_link_SetConfig ( char *buffer )
{
  char token [64];
  unsigned int len;
  USHORT result;

  result = DRV_OK;

  if ( (len = GetNextToken (buffer, token, " #")) == 0) 
  {
    result = thif_link_Open();
  }
  else
  {
    buffer += (len+1);
  }

  if ( !strcmp ( "OPEN", token ) )
  {
    result = thif_link_Open();
  }
  else if ( !strcmp ( "CLOSE", token ) )
  {
    result = thif_link_Close();
  }
  else if ( !strcmp ( "EXIT", token ) )
  {
    thif_link_Exit();
  }
  else
  {
    result = DRV_INVALID_PARAMS;
  }

  if ((result != DRV_OK) && (result != DRV_INVALID_PARAMS))
  {
    result = DRV_NOTCONFIGURED;
  }
  
  return  result;
}


/*
+--------------------------------------------------------------------+
| PROJECT : GSM-Frame (8415)           MODULE  : thif_link                 |
| STATE   : code                       ROUTINE : thif_link_Init            |
+--------------------------------------------------------------------+

  PURPOSE : initialize driver

*/
USHORT thif_link_Init ( USHORT DrvHandle, T_DRV_CB_FUNC CallbackFunc, T_DRV_EXPORT const **DrvInfo )
{
static const T_DRV_EXPORT thif_link_Info =
{
  THIF_LINK_NAME,
  0,
  {
#ifdef _WIN32_
    thif_link_Init,
#endif
    thif_link_Exit,
    thif_link_Read,
    thif_link_Write,
    NULL, /* Look */
    NULL, /* Clear */
    thif_link_Flush,
    thif_link_SetSignal,
    thif_link_ResetSignal,
    thif_link_SetConfig,
    NULL,
    NULL,
  }
};

  THIF_LINK_Data.Handle = DrvHandle;

  THIF_LINK_Data.EnabledSignalType = 0;

  THIF_LINK_Data.Callback = CallbackFunc;

  THIF_LINK_Data.Connected = FALSE;

  *DrvInfo = &thif_link_Info;

  return DRV_OK;
}