FreeCalypso > hg > fc-tourmaline
view src/gpf/tst/drv/thif_link.c @ 301:4bb5772a05a3
AT%SPVER: new command for setting custom speech version lists
The speech version list in the Bearer Capability IE tells the network
which speech codecs are supported by the MS, and in which order of
preference. The standard behaviour is to list all codecs that are
supported by the hw+fw platform, and the standard preference order
is newer over older, FR over HR. But sometimes it is desirable
(for network testing) to artificially restrict which codecs the test MS
will declare as supported, and/or to list them in some peculiar
non-standard order of preference. Add a new private AT command,
AT%SPVER, allowing the user to set and clear custom speech version
lists for the Bearer Capability IE composer in CC.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 21 May 2023 21:43:10 +0000 |
parents | 4e78acac3d88 |
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; }