view src/gpf2/tst/drv/thif_link.c @ 662:8cd8fd15a095

SIM speed enhancement re-enabled and made configurable TI's original code supported SIM speed enhancement, but Openmoko had it disabled, and OM's disabling of speed enhancement somehow caused certain SIM cards to start working which didn't work before (OM's bug #666). Because our FC community is much smaller in year 2020 than OM's community was in their day, we are not able to find one of those #666-affected SIMs, thus the real issue they had encountered remains elusive. Thus our solution is to re-enable SIM speed enhancement and simply wait for if and when someone runs into a #666-affected SIM once again. We provide a SIM_allow_speed_enhancement global variable that allows SIM speed enhancement to be enabled or disabled per session, and an /etc/SIM_spenh file in FFS that allows it to enabled or disabled on a non-volatile basis. SIM speed enhancement is now enabled by default.
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 24 May 2020 05:02:28 +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;
}