view src/gpf2/tst/tst_pei.c @ 389:5addc2943fa2

scripts/config-headers-new.sh: written, to be tested
author Mychaela Falconia <falcon@freecalypso.org>
date Wed, 17 Jan 2018 19:54:56 +0000
parents cd37d228dae0
children
line wrap: on
line source

/* 
+------------------------------------------------------------------------------
|  File:       tst_pei.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 Modul contains the PEI interface of TST
+----------------------------------------------------------------------------- 
*/ 

#ifndef __TST_PEI_C__
#define __TST_PEI_C__
#endif
 
#define ENTITY_TST

/*==== INCLUDES ===================================================*/

#include <string.h>
#include <stdio.h>
#include <stdlib.h>

#ifdef _TOOLS_
 #include "frame_const.h" 
 #include <stdlib.h>
#endif /* _TOOLS_ */

#ifndef _TARGET_ 
 #include "printtofile.h"
#endif

#include "typedefs.h"
#include "vsi.h"
#include "frame.h"
#include "pei.h"
#include "os.h"
#include "tools.h"
#include "gdi.h"
#include "os.h"
#include "frm_defs.h" 
#include "frm_types.h"
#include "frm_glob.h"
#include "route.h"
#include "drvconf.h"
#include "tstdriver.h"
#include "tstheader.h"
#include "tst_mux.h"
#include "pcon.h"

#ifdef CTB
 #include "tst_primitives.h"
#endif

#ifdef _PSOS_
 #include "pna.h"
#endif

#ifdef _FF_RV_EXIST_
 #include "ffs/ffs_api.h"
#endif

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

#undef VSI_CALLER
#ifdef _TOOLS_
 #define VSI_CALLER TST_Handle,
#else
 #define VSI_CALLER e_running[os_MyHandle()],
#endif

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

#ifdef _VXWORKS_
  #define TST_STACKSIZE  8192
  #define TST_PRIORITY    190             /* priority (1->high, 255->low) */
#else
  #ifdef _TOOLS_
    #define TST_STACKSIZE  4096
    #define TST_PRIORITY     15             
    #define TST_SND_PRIORITY 15		          /* priority (1->low, 255->high) */
    #define TST_RCV_PRIORITY 15		          /* priority (1->low, 255->high) */
  #else
    #define TST_STACKSIZE  1024
    #define TST_PRIORITY      2             
    #define TST_SND_PRIORITY  6             /* priority (1->low, 255->high) */
    #define TST_RCV_PRIORITY  7             /* priority (1->low, 255->high) */
  #endif
#endif

#ifdef _TOOLS_
 #define TST_TIMERS                        2
 #define GET_STACK_TIME_TIMER_INDEX        0
 #define GET_STACK_TIME_TIMER_DURATION 60000
 #define TST_SYNC_TIMER_INDEX              1
 #define TST_SYNC_TIMER_DURATION        2000
#else
 #define TST_TIMERS         0
#endif

#ifdef _FF_RV_EXIST_
#define TRACEMASKFILE "/var/dbg/tracemask"
#endif

#define DRV_CALLBACK_OPC     0

#ifdef _TOOLS_
  #define TR_RCV_BUF_SIZE    (MAX_PRIM_PARTITION_SIZE)
  #define TR_MAX_IND         (TR_RCV_BUF_SIZE-1)
  USHORT MaxEntities = MAX_ENTITIES;
#endif /* _TOOLS_ */

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

#ifndef _TOOLS_
extern const T_PCON_PROPERTIES *pcon;
extern const USHORT TST_SndQueueEntries;
extern const USHORT TST_RcvQueueEntries;
extern const USHORT TST_SndStacksize;
extern const USHORT TST_RcvStacksize;
extern UBYTE FrameEnv;
#endif

#ifdef _TOOLS_
__declspec (dllimport) UBYTE SuppressOK;
#else
extern char *str2ind_version;
extern UBYTE SuppressOK;
#endif

#ifdef CTB
  static T_HANDLE hCommIDLE = VSI_ERROR;
  extern short idle_pei_create (T_PEI_INFO const ** info);
#endif

#ifdef _FF_RV_EXIST_
  extern char TaskName[];
#endif

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

#ifndef RUN_INT_RAM

T_HANDLE TST_Handle;
T_HANDLE RCV_Handle;
T_HANDLE TIF_Handle;

UBYTE TST_DrvState = TST_DRV_DISCONNECTED;
static char const *ok_string = "OK";
static UBYTE frmenv;

#ifdef _TOOLS_ 
ULONG TR_RcvBufferSize = TR_RCV_BUF_SIZE;
ULONG TR_MaxInd = TR_MAX_IND;
int tst_syncronized = 0;
int tst_message_received = 0;
int tst_sync_timeout_cnt = 0;
int tst_max_sync_timeout = 0;
int tst_sync_mode = 0;
int tst_sync_sucess = 1;
int tst_sync_started = 0;
int tst_status_received = 0;
T_HANDLE tst_sync_req_handle = VSI_ERROR;
char sync_req_name[RESOURCE_NAMELEN];
char sync_req_time[16];

#endif /* _TOOLS_ */

GLOBAL USHORT tst_task_priority = TST_PRIORITY;
GLOBAL ULONG tst_task_stack_size = TST_STACKSIZE;

extern SHORT tst_pei_primitive (void *primitive);

#endif /* RUN_INT_RAM */

#ifdef RUN_INT_RAM

extern T_HANDLE TST_Handle;
extern T_HANDLE RCV_Handle;
extern T_HANDLE TIF_Handle;
extern UBYTE TST_DrvState;

#endif

#ifdef CTB
  static char ctb_rcv[4];
  static U32 ctb_remaining_tick_time=0;
  BOOL ctb_tick_enabled = FALSE;
  BOOL ctb_sent_to_tap = FALSE;
  T_HANDLE idle_handle;
#endif

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

#ifndef RUN_FLASH
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-GPF (8415)             MODULE  : TST_PEI             |
| STATE   : code                       ROUTINE : pei_primitive       |
+--------------------------------------------------------------------+ 
*/

SHORT tst_pei_primitive (void *primitive)
{
  T_PRIM_HEADER *prim = (T_PRIM_HEADER*)primitive;
#ifndef _TOOLS_
  T_VOID_STRUCT *prim_ptr = NULL;
#endif
  SHORT ret = PEI_OK;
  
#ifdef _TOOLS_
  if ( ((SAP_NR(prim->opc)==TRACE_SAP) || (prim->opc==TRACE_OPC)) && (P_SHO(prim)!=0) )
  {
    prim->opc = SYS_MASK;
  }
#endif

  if ( (SAP_NR(prim->opc)!=TRACE_SAP) && (prim->opc!=TRACE_OPC) && !(prim->opc & SYS_MASK) )
  {
#ifndef _TOOLS_
    prim_ptr = (T_VOID_STRUCT*)(((T_PRIM_X*)prim)->prim_ptr);
#endif
    VSI_PPM_RCV(prim_ptr);
    PTRACE_OUT(prim->opc );
  }

  if ( TST_DrvState == TST_DRV_CONNECTED )
  {
    if ( vsi_d_write ( TST_Handle, TIF_Handle, primitive, prim->len ) != VSI_OK )
      ret = PEI_ERROR;
#ifdef _TOOLS_
    vsi_t_sleep(TST_Handle,10);
#endif
  }

#ifndef _TOOLS_
  if ( prim_ptr != NULL )
  {
    FREE(P2D(prim_ptr));
  }
#endif
  vsi_trc_free (0, (T_VOID_STRUCT**)&prim);

  return ( ret );
}
#endif
    
#ifndef RUN_INT_RAM
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-GPF (8415)             MODULE  : TST_PEI             |
| STATE   : code                       ROUTINE : pei_init            |
+--------------------------------------------------------------------+ 
*/

LOCAL SHORT pei_init ( T_HANDLE handle )
{
#ifdef _TOOLS_
  T_HANDLE h_pco;
#endif

#ifdef _FF_RV_EXIST_
  T_HANDLE entityTraceMask;
  ULONG actual;
  T_FFS_FD fd;
  T_RV_RETURN retPath;
  BOOL gotAll = TRUE;
#endif

  TST_Handle = handle;
#ifdef _TOOLS_
  while (vsi_c_open (0, FRM_RCV_NAME) < VSI_OK) 
  {
    vsi_t_sleep(0,100);
  }
  frmenv = (UBYTE) pf_get_frameenv ();
  if ( os_OpenQueue (0, FRM_PCO_NAME, &h_pco) == OS_OK ||
       os_create_extq (FRM_PCO_NAME, &h_pco) == OS_OK)
  {
    vsi_o_set_htrace (h_pco);
#ifdef _DEBUG
    fprintf (stdout,"TST: %s commH set to %d\n", FRM_PCO_NAME,h_pco);
#endif
  }
  vsi_t_start ( handle, GET_STACK_TIME_TIMER_INDEX, GET_STACK_TIME_TIMER_DURATION );
#else
  if ( vsi_c_open (TST_Handle, FRM_RCV_NAME) < VSI_OK ) 
    return PEI_ERROR;
  RCV_Handle = vsi_e_handle ( TST_Handle, FRM_RCV_NAME );
  frmenv = FrameEnv;
#endif
#ifndef _TARGET_ 
  initPrintToFile();
#endif
  if ( vsi_d_init ( TST_Handle ) != VSI_OK )
  {
#ifndef _TARGET_
    printf("SYSTEM ERROR: Driver initialization failed\n");
    vsi_o_assert ( TST_Handle, OS_SYST_ERR, __FILE__, __LINE__, "SYSTEM ERROR: Testinterface driver initialization failed" );
#else
    ;
#endif
  }
  TIF_Handle = vsi_d_open ( TST_Handle, (char*)TIF_NAME );
  vsi_d_setsignal ( TST_Handle, 0, DRV_SIGTYPE_READ|DRV_SIGTYPE_CONNECT|DRV_SIGTYPE_DISCONNECT); 
  vsi_d_setconfig ( TST_Handle, 0, NULL ); 
  vsi_trcsuspend ( TST_Handle, TST_Handle, OS_NO_SUSPEND );
  SuppressOK = FALSE;
  tst_mux_init();

#ifdef _FF_RV_EXIST_
  fd = ffs_open(TRACEMASKFILE,  FFS_O_RDWR);
  if (fd < 0)
  {
    // could not open nor create /var/dbg/tracemask warning
    vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_init: no trace mask in FFS");
  }
  else
  {
    InitializeTrace();
    TraceMask[0] = 0;
    TraceMask[0] |= TC_SYSTEM|TC_ERROR;
    for (entityTraceMask = 0; entityTraceMask < (MaxEntities + 1); entityTraceMask++)
    {
      actual = TraceMask[entityTraceMask];
      if (ffs_read(fd, (void*)&TraceMask[entityTraceMask], sizeof(ULONG) ) != sizeof(ULONG) )
      {
        gotAll = FALSE;
      }
      else
      {
        if (entityTraceMask == 0) // first element
        {
           TraceMask[0] = 0;
           TraceMask[0] |= TC_SYSTEM|TC_ERROR;
        }
        if (actual != TraceMask[entityTraceMask])
        {
          // not the default trace mask, generate warning
          if ( vsi_e_name ( 0, entityTraceMask, TaskName ) == VSI_OK )
          {
            vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_init: FFS trace mask gave 0x%08x for %s (default 0x%08x)", TraceMask[entityTraceMask], TaskName, actual);
          }
        }
      }
    }  
  }
  ffs_close(fd);
  if (!gotAll)
  {
    vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_init: some trace masks can't be read from FFS");
  }
#endif

  return PEI_OK;
}
#endif



#ifndef RUN_INT_RAM
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-GPF (8415)             MODULE  : TST_PEI             |
| STATE   : code                       ROUTINE : pei_exit            |
+--------------------------------------------------------------------+ 
*/

static SHORT pei_exit (void)
{
#ifdef _TOOLS_
  T_HANDLE rcvh=vsi_p_handle (0, FRM_RCV_NAME);
  if (rcvh > VSI_OK) 
  {
    /* exit RCV process */
    vsi_p_exit ( TST_Handle, vsi_p_handle (0, FRM_RCV_NAME));
  }
  /* exit all drivers */
  vsi_d_exit ( TST_Handle, 0); 
#endif /* _TOOLS_ */

  return PEI_OK;
}
#endif

#ifndef RUN_INT_RAM
#ifdef _TOOLS_
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-GPF (8415)             MODULE  : TST_PEI             |
| STATE   : code                       ROUTINE : pei_timeout         |
+--------------------------------------------------------------------+ 
*/

LOCAL SHORT pei_timeout (USHORT index)
{

  switch ( index )
  {
    case GET_STACK_TIME_TIMER_INDEX:
#if 0
      if ( tst_message_received == 1 )
      {
        tst_drv_write ( NO_TASK, SYS_MASK, FRM_TST_NAME, (char*)SYSPRIM_GET_STACK_TIME );
      }
      vsi_t_start ( VSI_CALLER GET_STACK_TIME_TIMER_INDEX, GET_STACK_TIME_TIMER_DURATION );
#endif
      break;
    case TST_SYNC_TIMER_INDEX:
      if ( tst_sync_timeout_cnt++ >= tst_max_sync_timeout-1 )
      {
        T_HANDLE tif_handle;
        T_VOID_STRUCT *ptr;
        
        tst_status_received = 0;
        tst_sync_timeout_cnt = 0;
        tst_sync_mode = 0;
        tst_sync_sucess = 0;
        tif_handle = vsi_d_open ( TST_Handle, (char*)TIF_NAME );
        vsi_d_setconfig ( TST_Handle, tif_handle, DISABLE_SYNC_MODE );
        vsi_t_stop ( TST_Handle, TST_SYNC_TIMER_INDEX );
        ptr = vsi_c_pnew ( sizeof(T_PRIM_HEADER)+strlen(SYSPRIM_TST_SYNC_REJ), 0x8000 FILE_LINE );
        strcpy ( (char*)ptr, SYSPRIM_TST_SYNC_REJ );
        vsi_c_psend ( tst_sync_req_handle, ptr );
      }
      else
      {
        if ( tst_syncronized == 0 )
        {
          T_HANDLE tif_handle;
          tst_sync_sucess = 1;
          tst_status_received = 0;
          tif_handle = vsi_d_open ( TST_Handle, (char*)TIF_NAME );
          vsi_d_setconfig ( TST_Handle, tif_handle, ENABLE_SYNC_MODE );
          tst_drv_write ( NO_TASK, SYS_MASK, FRM_RCV_NAME, (char*)"TRACECLASS 0x10" );
          vsi_t_sleep ( TST_Handle, 100 );
          tst_drv_write ( NO_TASK, SYS_MASK, FRM_RCV_NAME, (char*)"STATUS TASK" );
          vsi_t_start ( TST_Handle, TST_SYNC_TIMER_INDEX, TST_SYNC_TIMER_DURATION );
          vsi_t_sleep ( TST_Handle, 200 );
          tst_drv_write ( NO_TASK, SYS_MASK, FRM_RCV_NAME, (char*)"ROUTING" );
        }
      }
      break;
    default:
      break;
  }
  return PEI_OK;
}
#endif
#endif

#ifndef RUN_INT_RAM
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-GPF (8415)             MODULE  : TST_PEI             |
| STATE   : code                       ROUTINE : pei_signal          |
+--------------------------------------------------------------------+ 
*/
LOCAL SHORT pei_signal (ULONG SignalType, void *ptr)
{
/*
 * the following line of code causes a warning on tms470 compiler, that cannot be avoided
 * without changing the PEI interface. Warning will not cause a problem 
 */
T_VOID_STRUCT *sig_ptr = (T_VOID_STRUCT*)ptr;
T_PRIM_HEADER *prim;
T_S_HEADER *s_hdr;
T_HANDLE DestTaskHandle, DestComHandle;
T_HANDLE min, max, i;
unsigned int Length;
ULONG Suspend, TraceMask, OldTraceMask;
unsigned int Offset = 0;
char token[81];
UBYTE FreePrim = 1;
SHORT ret = PEI_OK;
USHORT processed = FALSE;

  switch ( SignalType )
  {
    case DRV_SIGTYPE_READ:
    VSI_PPM_RCV(sig_ptr);
    if ( (prim = ((T_PRIM_X*)sig_ptr)->prim_ptr) != NULL )
    {
      VSI_PPM_RCV (prim);
      s_hdr = (T_S_HEADER*)((ULONG*)prim + prim->sh_offset);
      DestTaskHandle = vsi_e_handle ( TST_Handle, s_hdr->rcv );
      if ( DestTaskHandle == VSI_ERROR )
      {
        if ( !strcmp ( "IRQ", s_hdr->rcv ) )
        {
          DestTaskHandle = 0;
          OldTraceMask = TC_SYSTEM;
          TraceMask = 0;
        }
        else 
        {
          if ( !strcmp ( "SYST", s_hdr->rcv ) )
          {
            DestTaskHandle = 0;
            vsi_gettracemask ( DestTaskHandle, 0, &OldTraceMask);
            TraceMask = TC_SYSTEM;
          }
          else
          {
            OldTraceMask = 0;
            TraceMask = 0;
          }
        }
      }
      else
      {
        /* to satisfy LINT */
        OldTraceMask = 0;
        TraceMask = 0;
      }
      if ( DestTaskHandle != VSI_ERROR )
      {
        if ( prim->opc & SYS_MASK )
        {
          Length = GetNextToken ((char*)(P2D(prim)), token, "  #");
          Offset = Length+1;
          if ( frmenv == ENV_STACK )
          {
            /* Set Traceclass for non-frame tasks/HISRs */
            if ( DestTaskHandle == 0 && !strcmp (token, SYSPRIM_TRACECLASS_TOKEN) )
            {
              Length = GetNextToken ((char *)(P2D(prim))+Offset, token, " #");
              TraceMask = ASCIIToHex(token, CHARS_FOR_32BIT);
              vsi_settracemask ( DestTaskHandle, 0, TraceMask|OldTraceMask); /* it is not allowed to switch of system traces */
              sprintf ( token, "%s (%s %s)", ok_string, (char*)(P2D(prim)), s_hdr->rcv );
              tst_drv_write ( NO_TASK, 0, NULL, token );
              processed = TRUE;
            }
            if (!strcmp (token, SYSPRIM_TRC_SUSPEND))
            {
              processed = TRUE;
              /*
               * set suspend for traces to SUSPEND or NO_SUSPEND
               */
              Length = GetNextToken ((char *)(P2D(prim))+Offset, token, " #");
              Offset += (Length+1);
 
              if ( !strcmp ( token, "ALL" ) )
              {  
                min = 1; 
                max = MaxEntities;
                GetNextToken ((char *)(P2D(prim))+Offset, token, " #");
              }
              else
              { 
                min = DestTaskHandle; 
                max = min; 
              }
              if ( !strcmp ( token, "YES" ) )
                Suspend = 0xffffffff;
              else
                Suspend = 0;
     
              for ( i = min; i <= max; i++ ) 
                vsi_trcsuspend ( TST_Handle, i, Suspend );
              sprintf ( token, "%s (%s %s)", ok_string, (char*)(P2D(prim)), s_hdr->rcv );
              tst_drv_write ( NO_TASK, 0, NULL, token );
            }
            else if (!strcmp (token, SYSPRIM_MEMCHECK_TOKEN))
            {
              processed = TRUE;
              /*
               * Memory Check
               */
              for ( i = 1; i <= MaxEntities; i++ )
              {
                 if ( vsi_object_info (TST_Handle, OS_OBJTASK, (USHORT)i, token, sizeof(token)) != VSI_ERROR )
                 {
                   tst_drv_write ( NO_TASK, 0, NULL, token );
                 }
              }
            }
#ifdef CTB
#ifndef _TOOLS_
            else if (!strcmp (token, SYSPRIM_TIMER_TICK_REQ)) 
            {
               processed = TRUE;
               ctb_sent_to_tap = FALSE;
               if(strlen(ctb_rcv)<3)
               {
                  strcpy(ctb_rcv, P_SND(prim));
               }
               ctb_remaining_tick_time = P_TIME(prim);  //The time parameter is sent in the time stap.
               /*sprintf ( token, "Requesting ticking for %d from %s", ctb_remaining_tick_time, ctb_rcv);
               tst_drv_write ( NO_TASK, 0, NULL, token );*/
               PSIGNAL(hCommIDLE, IDLE_REQ, NULL);
            }
            else if (!strcmp (token, SYSPRIM_INT_TICK_MODE_REQ)) 
            {
              processed = TRUE;
              if(ctb_tick_enabled)
              {               
                vsi_p_delete (TST_Handle,idle_handle); 
                ctb_tick_enabled = FALSE;
                ctb_sent_to_tap = FALSE;
                sprintf ( token, "Disabling Common Timer Base");
                ctb_rcv[0]='\0';
                os_StartTicking();
              }
              else
                sprintf ( token, "Common Timer Base already disabled");
              tst_drv_write ( NO_TASK, 0, NULL, token );
              if(!strcmp(P_SND(prim), "TAP")) 
              {
                tst_drv_write ( NO_TASK, SYS_MASK, "TAP", "INT_TICK_MODE_CNF");
              }
            }
            else if (!strcmp (token, SYSPRIM_EXT_TICK_MODE_REQ)) 
            {
              processed = TRUE;
              if(!ctb_tick_enabled)
              {
                if ( (idle_handle = vsi_p_create (TST_Handle, idle_pei_create, NULL, 1)) == VSI_ERROR )
                {
                  vsi_o_assert ( TST_Handle, OS_SYST_ERR, __FILE__, __LINE__, "CTB: Cannot create IDLE task" );
                }
                vsi_p_start (TST_Handle, idle_handle);
                while ( (hCommIDLE = vsi_e_handle ( TST_Handle, "IDLE" ))<VSI_OK)
                {
	                vsi_t_sleep(0,1000);
                }
                os_StopTicking();
                sprintf ( token, "Enabling Common Timer Base");
     	          ctb_tick_enabled = TRUE;
              }
              else
                sprintf ( token, "Common Timer Base already enabled");
   			      tst_drv_write ( NO_TASK, 0, NULL, token );
				      if(!strcmp(P_SND(prim), "TAP")) 
              {
                char send_str[50];
                char tmp_str[8];
                //Get process id and put in this syst primitive.
                strcpy(send_str,"EXT_TICK_MODE_CNF#");
                _itoa(os_GetProcessId(), tmp_str, 10);
                strcat(send_str, tmp_str);
                tst_drv_write ( NO_TASK, SYS_MASK, "TAP", send_str);
              }
	          }
#endif
#endif //CTB

#ifndef _TARGET_
            else if (!strcmp (token, SYSPRIM_SUPPRESS_OK))
            {
              processed = TRUE;
              SuppressOK = TRUE;
            }  
#endif
            else if (!strcmp (token, SYSPRIM_GET_STACK_TIME))
            {
              processed = TRUE;
              tst_drv_write ( NO_TASK, SYS_MASK, FRM_TST_NAME, (char*)SYSPRIM_IS_STACK_TIME );
            }  
            else if (!strcmp (token, SYSPRIM_READ_ROUTING))
            {
              processed = TRUE;
              i = 0;
              while ( rt_RouteRead ( DestTaskHandle, token ) != RT_ERROR )
              {
                tst_drv_write ( NO_TASK, 0, NULL, token );
                i++;
              }
              if ( !i )
              {
                sprintf ( token, "NO %s ROUTINGS STORED", s_hdr->rcv );
                tst_drv_write ( NO_TASK, 0, NULL, token );
              }
            }
#ifndef _TOOLS_
            else if (!strcmp (token, SYSPRIM_STR2IND_VERSION))
            {
              processed = TRUE;
              tst_drv_write ( NO_TASK, 0, NULL, str2ind_version );
            }
#endif
          }
        }
      }
#ifdef _TOOLS_
      else
      {
        /* synchronization with protocol stack */
        if ( tst_sync_mode == 1 )
        {
          char *pos;
          char task_status;
          T_VOID_STRUCT *cmd_ptr;

          pos = strstr ( (char*)(P2D(prim)), "Name:" );
          if ( pos != NULL )
          {
            tst_sync_started = 1;
            GetNextToken ((char *)(P2D(prim))+strlen("Name:"), token, " #");
            if ( strcmp(token,FRM_RCV_NAME) && strcmp(token,FRM_TST_NAME) && strcmp(token,"EXTR") )
            {
              pos = strstr ( (char*)(P2D(prim)), "Stat:" );
              if ( pos != NULL )
              {
                tst_status_received = 1;
                task_status = atoi(pos+strlen("Stat:"));
                if ( task_status != 6 )
                {
                  tst_sync_sucess = 0;
                }
              }
            }
          }
          else
          {
            if ( tst_sync_started == 1 )
            {
              pos = strstr ( (char*)(P2D(prim)), "ROUTING" );
              if ( pos != NULL )
              {
                if ( tst_sync_sucess == 1 && tst_status_received == 1 )
                {
                  T_HANDLE tif_handle = vsi_d_open ( TST_Handle, (char*)TIF_NAME );
                  vsi_d_setconfig ( TST_Handle, tif_handle, DISABLE_SYNC_MODE );
                  vsi_t_stop ( TST_Handle, TST_SYNC_TIMER_INDEX );
                  cmd_ptr = vsi_c_pnew ( sizeof(T_PRIM_HEADER)+strlen(SYSPRIM_TST_SYNC_CNF), 0x8000 FILE_LINE );
                  strcpy ( (char*)cmd_ptr, SYSPRIM_TST_SYNC_CNF );
                  vsi_o_ttrace ( TST_Handle, TC_TIMER, "SYNC DONE") ;
                  vsi_c_psend ( tst_sync_req_handle, cmd_ptr );
                  tst_sync_mode = 0;
                  tst_sync_timeout_cnt = 0;
                  tst_syncronized = 1;
                }
              }
            }
          }
        }
      }
#endif /* _TOOLS_ */
      if ( processed == FALSE )
      {
        if ( ( DestComHandle = vsi_c_open ( TST_Handle, s_hdr->rcv ) ) != VSI_ERROR )
        {
          /* free carrier */
          PFREE(P2D(sig_ptr));
          FreePrim = 0;
          vsi_c_psend (DestComHandle, (T_VOID_STRUCT*)P2D(prim) FILE_LINE_MACRO);
        }
        else 
        {
#ifndef _TOOLS_
          if ( frmenv == ENV_STACK )
          {
            sprintf ( token, "SYSTEM WARNING: Receiver Process '%s' unknown", s_hdr->rcv );
            tst_drv_write ( NO_TASK, 0, NULL, token );
            ret = PEI_ERROR;
          }
#endif /* _TOOLS_ */
          /* free dyn_ptr if unknown receiver */
          FREE(P2D(prim));
        }
      }
      else
      {
        /* free dyn_ptr if processed in TST */
        FREE(P2D(prim));
      }
    }

    if ( FreePrim ) 
    {
      /* free carrier */
      PFREE(P2D(sig_ptr));
    }
    break;
    case DRV_SIGTYPE_CONNECT:
      TST_DrvState = TST_DRV_CONNECTED;
#ifndef _TOOLS_
      tst_drv_write ( NO_TASK, SYS_MASK, FRM_TST_NAME, (char*)SYSPRIM_IS_STACK_TIME );
      tst_drv_write ( NO_TASK, 0, NULL, str2ind_version );
#endif
    break;
    case DRV_SIGTYPE_DISCONNECT:
      TST_DrvState = TST_DRV_DISCONNECTED;
#ifdef _PSOS_
      /* for pSOS: send empty message to TST */
      if ( vsi_d_open ( TST_Handle, "SOCKET" ) != VSI_ERROR )
      {
        T_QMSG Message;
        static T_HANDLE tst_handle = 0;

        if( TST_Handle > 0 ) 
        {
          Message.MsgType = MSG_PRIMITIVE;
          Message.Msg.Primitive.Prim = NULL;
          Message.Msg.Primitive.PrimLen = 0;
#ifdef MEMORY_SUPERVISION
          vsi_c_send (TST_Handle, TST_Handle, &Message, __FILE__, __LINE__);
#else
          vsi_c_send (TST_Handle, TST_Handle, &Message);
#endif
        }
      }
#endif
    break;
#ifdef CTB
    case IDLE_CNF:
     if(ctb_remaining_tick_time > 0 && ctb_tick_enabled && !ctb_sent_to_tap) 
     {
       os_Tick();
       PSIGNAL(hCommIDLE, IDLE_REQ, NULL);
       ctb_remaining_tick_time = ctb_remaining_tick_time-50;
     }
     else
     {
       /*sprintf ( token, "Ticking finished - remaining time %d", ctb_remaining_tick_time);
       tst_drv_write ( NO_TASK, 0, NULL, token );*/
       if(!strcmp(ctb_rcv, "TAP"))
         tst_drv_write ( NO_TASK, SYS_MASK, FRM_TST_NAME, SYSPRIM_IS_STACK_TIME ); //Synchronize time with tools
       tst_drv_write ( NO_TASK, SYS_MASK, ctb_rcv, "TIMER_TICK_CNF");
     }
    break;
#endif
    default:
        sprintf ( token, "Unhandled PSIGNAL");
        tst_drv_write ( NO_TASK, 0, NULL, token );
    break;
  }
  return ( ret );
}
#endif

#ifndef RUN_INT_RAM
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-GPF (8415)             MODULE  : TST_PEI             |
| STATE   : code                       ROUTINE : pei_config          |
+--------------------------------------------------------------------+ 
*/

LOCAL SHORT pei_config (char * inString)
{
T_HANDLE drv_handle;
char token[80];
unsigned int length, offset;
BOOL select = 0,config = 0;
T_TST_DRV_ENTRY *tst_drv_info;

  length = GetNextToken (inString, token, " #");
  offset = length+1;
  if ( !strcmp ( token, "DRIVER") )
  {
    length = GetNextToken (inString+offset, token, " #");
    offset += (length+1);
    if ( !strcmp ( token, "FLUSH") )
    {
     vsi_d_flush ( TST_Handle, 0 );
    }
    if ( !strcmp ( token, "SELECT") )
    {
     select = 1;
    }
    if ( !strcmp ( token, "CONFIG") )
    {
      config = 1;
#ifdef _TOOLS_
      tst_syncronized = 0;
#endif
    }
    length = GetNextToken (inString+offset, token, " #");
    offset += (length+1);
    if ( select )
    {
#ifdef _TOOLS_
      if ( !strcmp(NODRV_NAME,token) )
      {
        if ( tst_drv_open ( token, &tst_drv_info ) == VSI_ERROR ||
             vsi_d_create ( TST_Handle, tst_drv_info ) == VSI_ERROR)
        {
          return PEI_ERROR;
        }
        PrintToFile("TST: all drivers unloaded\n");
      }
      else
#endif
      {
        /* check if driver is already loaded */
        if ( (drv_handle = vsi_d_open ( TST_Handle, token )) == VSI_ERROR )
        {
          if ( tst_drv_open ( token, &tst_drv_info ) == VSI_ERROR ||
               vsi_d_create ( TST_Handle, tst_drv_info ) == VSI_ERROR )
          {
            return PEI_ERROR;
          }
        } 
        else 
        {
#ifdef _TOOLS_
#ifdef _DEBUG
          PrintToFile("TST: keeping %s loaded\n",token);
#endif
#endif
          vsi_d_close( TST_Handle, drv_handle );
        }
      }
    }
    if ( config )
    {
      if ( ( drv_handle = vsi_d_open ( TST_Handle, token ) ) == VSI_ERROR )
      {
        return PEI_ERROR;
      }
      if (vsi_d_setconfig ( TST_Handle, drv_handle, inString+offset) != VSI_OK)
      {
#ifdef _TOOLS_
        char text[99];
        _snprintf(text,98,"TST: Error configuring driver %s with \"%s\" :-(",token, inString+offset);
        vsi_o_ttrace(NO_TASK, TC_SYSTEM, text);
#endif /* _TOOLS_ */
      }
      vsi_d_close( TST_Handle, drv_handle );
    }
  }  
  else if ( !strcmp ( token, "THIF") )
  {
    T_HANDLE tif_handle;
    tif_handle = vsi_d_open ( TST_Handle, (char*)TIF_NAME );
    length = GetNextToken (inString+offset, token, " #");
    offset += (length+1);

    if ( !strcmp ( token, "OPEN") )
    {
      vsi_d_setconfig ( TST_Handle, tif_handle, token );
    }
    else if ( !strcmp ( token, "CLOSE") )
    {
      vsi_d_setconfig ( TST_Handle, tif_handle, token );
    }
  }
#ifdef _TOOLS_
  else if ( !strcmp ( token, SYSPRIM_TST_SYNC_REQ) )
  {
    T_HANDLE tif_handle;
    unsigned int len;

    len = GetNextToken (inString+offset, sync_req_name, " #");
    offset += len;
    len = GetNextToken (inString+offset, sync_req_time, " #"); 
    tst_max_sync_timeout = (atoi(sync_req_time) - 1000)/TST_SYNC_TIMER_DURATION;

    tst_sync_req_handle = vsi_c_open ( TST_Handle, sync_req_name );
    if ( tst_sync_req_handle != VSI_ERROR )
    {
      if ( tst_syncronized == 0 )
      {
        tst_sync_started = 0;
        tst_status_received = 0;
        tst_sync_mode = 1;
        tst_sync_sucess = 1;
        tif_handle = vsi_d_open ( TST_Handle, (char*)TIF_NAME );
        vsi_d_setconfig ( TST_Handle, tif_handle, ENABLE_SYNC_MODE );
        tst_drv_write ( NO_TASK, SYS_MASK, FRM_RCV_NAME, (char*)"TRACECLASS 0x10" );
        vsi_t_sleep ( TST_Handle, 100 );
        tst_drv_write ( NO_TASK, SYS_MASK, FRM_RCV_NAME, (char*)"STATUS TASK" );
        vsi_t_start ( TST_Handle, TST_SYNC_TIMER_INDEX, TST_SYNC_TIMER_DURATION );
        vsi_t_sleep ( TST_Handle, 200 );
        tst_drv_write ( NO_TASK, SYS_MASK, FRM_RCV_NAME, (char*)"ROUTING" );
      }
    }
  }
#endif
#ifdef _FF_RV_EXIST_
  else if ( !strcmp ( token, "TRACEMASK_IN_FFS") )
  {
    int amount;
    T_FFS_FD fd;
    T_FFS_RET ret;
    T_FFS_SIZE written;
    T_FFS_DIR dir;
    BOOL writeFailed = FALSE;
    if (vsi_e_handle ( TST_Handle, FRM_RCV_NAME ) == e_running[os_MyHandle()]) // config prim processing only allowed in RCV, not TST!
    {
      fd = ffs_open(TRACEMASKFILE,  FFS_O_RDWR | FFS_O_CREATE | FFS_O_TRUNC);
      if (fd < 0)
      {
        // could not open nor create /var/dbg/tracemask warning
        vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_config: could not open/create FFS trace mask, reason is 0x%x", fd);
      }
      else
      {
        TraceMask[0] = 0;
        TraceMask[0] |= TC_SYSTEM|TC_ERROR;
        amount = sizeof(ULONG) * (MaxEntities + 1);
        written = ffs_write(fd, (void*)&TraceMask[0], amount);
        if (written != amount)
        {
          if (written >= 0)
          {
            amount -= written;
            vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_config: writing to  FFS, second try");
            written = ffs_write(fd, (void*)&TraceMask[0], amount);
            if (written != amount) 
            {
              writeFailed = TRUE;
            }
          }
          else
          {
            writeFailed = TRUE;
          } 
        }
        if (writeFailed)
        {
          vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_config: ffs_write to FFS failed with 0x%x, did open with", written, fd);
        }
        else
        {
          if (ffs_fdatasync(fd) == EFFS_OK)
          {
            vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_config: successfully written trace mask to FFS");
          }
          else
          {
            vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_config: flushing FFS trace mask failed!");
          }
        }
        ffs_close(fd);
      }
    }
  }
  else if ( !strcmp ( token, "NO_TRACEMASK_IN_FFS") )
  {
    T_FFS_RET ret;

    InitializeTrace();
    TraceMask[0] = 0;
    TraceMask[0] |= TC_SYSTEM|TC_ERROR;
    if (vsi_e_handle ( TST_Handle, FRM_RCV_NAME ) == e_running[os_MyHandle()]) // config prim processing only allowed in RCV, not TST!
    {
      ret = ffs_remove(TRACEMASKFILE);
      if (ret != EFFS_OK)
      {
       vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_config: failed to remove FFS trace mask, reason is 0x%x", ret);
      }
      else
      {
        vsi_o_ttrace(NO_TASK, TC_SYSTEM, "pei_config: successfully removed FFS trace mask");
      }
    }
  }
#endif
  return PEI_OK;
}
#endif

#ifndef RUN_INT_RAM
GLOBAL SHORT tstsnd_pei_create ( T_PEI_INFO ** info)
{
  static T_PEI_INFO data = 
  { "TST",  
    { 
      pei_init,
      pei_exit,
      tst_pei_primitive,
#ifdef _TOOLS_
      pei_timeout,
#else
      NULL,
#endif
      NULL,
      NULL,
      pei_config,
      NULL 
    },
    TST_STACKSIZE, 
    0,
    TST_SND_PRIORITY,
    TST_TIMERS,
    (PASSIVE_BODY|COPY_BY_REF|SYSTEM_PROCESS|TRC_NO_SUSPEND)
  };

#ifdef _TOOLS_
  data.QueueEntries = TST_QUEUE_ENTRIES;
#else
  data.QueueEntries = TST_SndQueueEntries;
  /* 
   * This way of setting the TST and RCV stacksize is chosen to keep it backwardscompatible,
   * i.e. not change the behavior if the stacksizes are not define in the configuration
   * file xxxconst.h.
   */
  if ( TST_SndStacksize > 0 )
  {
    data.StackSize = TST_SndStacksize;
  }
  if ( pcon != NULL )
  {
    data.StackSize += pcon->stack_offset;
  }
#endif
  *info = &data;
  return PEI_OK;
} 
#endif

#ifndef RUN_INT_RAM
GLOBAL SHORT tstrcv_pei_create ( T_PEI_INFO ** info)
{
  static T_PEI_INFO data = 
  { "RCV",  
    { 
      NULL,
      NULL,
      NULL,
      NULL,
      pei_signal,
      NULL,
      pei_config,
      NULL 
    },
    TST_STACKSIZE, 
    0,
    TST_RCV_PRIORITY,
    TST_TIMERS,
    (PASSIVE_BODY|COPY_BY_REF|SYSTEM_PROCESS|TRC_NO_SUSPEND)
  };

#ifdef _TOOLS_
  data.QueueEntries = TST_QUEUE_ENTRIES;
#else
  data.QueueEntries = TST_RcvQueueEntries;
  /* 
   * This way of setting the TST and RCV stacksize is chosen to keep it backwardscompatible,
   * i.e. not change the behavior if the stacksizes are not define in the configuration
   * file xxxconst.h.
   */
  if ( TST_RcvStacksize > 0 )
  {
    data.StackSize = TST_RcvStacksize;
  }
  if ( pcon != NULL )
  {
    data.StackSize += pcon->stack_offset;
  }
#endif
  *info = &data;
  return PEI_OK;
} 
#endif