FreeCalypso > hg > fc-magnetite
view src/g23m-aci/gdd_dio/gdd_dio_pei.c @ 407:f7f1f6f1a77d
init.c module: a chance at being correct for the D-Sample target
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 18 Jan 2018 04:45:11 +0000 |
parents | 53929b40109c |
children |
line wrap: on
line source
/* +------------------------------------------------------------------------------ | File: gdd_dio_pei.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 module implements the PEI interface | for the entity gdd_dio. +----------------------------------------------------------------------------- */ #define GDD_DIO_PEI_C #define ENTITY_GDD_DIO /*==== INCLUDES =============================================================*/ #include "typedefs.h" /* to get standard types */ #include "vsi.h" /* to get a lot of macros */ #include "gsm.h" /* to get a lot of macros */ #include "custom.h" /* to get GDD_DIO_NAME */ #include "prim.h" /* to get the definitions of used SAP and directions */ #include "pei.h" /* to get PEI interface */ #include "tools.h" /* to get common tools */ #include "mon_gdd_dio.h" /* to get mon-definitions */ #include "gdd_dio.h" /* to get the global entity definitions */ #include "string.h" /* for strncmp */ #include "gdd_dio_kerf.h" #include "gdd_dio_rxf.h" /* Needed for gdd_dio_rx_sig_send_data() */ #include "gdd_dio_drxf.h" /* Needed for gdd_dio_drx_sig_receive_data */ /*==== CONSTS ================================================================*/ /* * Wait as long as possible. This is the time in ms that is waited for a * message in the input queue in the active variant. * It can be decreased by the customer. */ #define GDD_DIO_TIMEOUT 0xffffffff /*==== TYPES =================================================================*/ /* Entry point for testing BAT via the BAT adapter (this entity) */ GLOBAL void gdd_dio_test_bat(const char * in_string); /*==== LOCALS ================================================================*/ static T_MONITOR gdd_dio_mon; /* * Function is needed for grr_table[]. This declaration can be removed * as soon as this function is no more called (i.e. all primitives are * handled). */ static void primitive_not_supported (void *data); #ifdef _SIMULATION_ /* Function to activate/de-activate the PSI STUB for simulation */ void dio_il_sim_activate_psi_stub(BOOL b); void dio_il_psi_stub_activate_batlib_test(BOOL b); #endif /* _SIMULATION */ /*==== PRIVATE FUNCTIONS ====================================================*/ /* +------------------------------------------------------------------------------ | Function : primitive_not_supported +------------------------------------------------------------------------------ | Description : This function handles unsupported primitives. | | Parameters : data - not used | | Return : void +------------------------------------------------------------------------------ */ static void primitive_not_supported (void *data) { TRACE_FUNCTION ("[GDD] primitive_not_supported()"); PFREE (data); } /* +------------------------------------------------------------------------------ | Function : pei_primitive +------------------------------------------------------------------------------ | Description : Process protocol specific primitive. | | Parameters : prim - pointer to the received primitive | | Return : PEI_OK - function succeeded | PEI_ERROR - function failed +------------------------------------------------------------------------------ */ static short pei_primitive (void * ptr) { T_PRIM *prim = (T_PRIM*)ptr; TRACE_FUNCTION ("[GDD] pei_primitive()"); if (prim NEQ NULL) { unsigned long opc = prim->custom.opc; unsigned short n; const T_FUNC *table; /* * This must be called for Partition Pool supervision. Will be replaced * by another macro some time. */ VSI_PPM_REC (&prim->custom, __FILE__, __LINE__); PTRACE_IN (opc); switch (opc & OPC_MASK) { default: table = NULL; n = 0; break; } if (table != NULL) { if ((opc & PRM_MASK) < n) { table += opc & PRM_MASK; #ifdef PALLOC_TRANSITION P_SDU(prim) = table->soff ? (T_sdu*) (((char*)&prim->data) + table->soff) : 0; #ifndef NO_COPY_ROUTING P_LEN(prim) = table->size + sizeof (T_PRIM_HEADER); #endif /* #ifndef NO_COPY_ROUTING */ #endif /* #ifdef PALLOC_TRANSITION */ JUMP (table->func) (P2D(prim)); } else { primitive_not_supported (P2D(prim)); } return PEI_OK; } /* * primitive is not a GSM primitive - forward it to the environment */ if (opc & SYS_MASK) vsi_c_primitive (VSI_CALLER prim); else { PFREE (P2D(prim)); return PEI_ERROR; } } return PEI_OK; } /* +------------------------------------------------------------------------------ | Function : pei_init +------------------------------------------------------------------------------ | Description : Initialize Protocol Stack Entity | | Parameters : handle - task handle | | Return : PEI_OK - entity initialised | PEI_ERROR - entity not (yet) initialised +------------------------------------------------------------------------------ */ static short pei_init (T_HANDLE handle) { TRACE_FUNCTION ("[GDD] pei_init()"); /* Initialize task handle */ GDD_DIO_handle = handle; /* * Open communication channels */ if (hCommGDD_DIO < VSI_OK) { if ((hCommGDD_DIO = vsi_c_open (VSI_CALLER GDD_DIO_NAME)) < VSI_OK) return PEI_ERROR; } /* * Initialize entity data (call init function of every service) */ gdd_dio_ker_init(); return (PEI_OK); } /* +------------------------------------------------------------------------------ | Function : pei_timeout +------------------------------------------------------------------------------ | Description : Process timeout. | | Parameters : index - timer index | | Return : PEI_OK - timeout processed | PEI_ERROR - timeout not processed +------------------------------------------------------------------------------ */ static short pei_timeout (unsigned short index) { TRACE_FUNCTION ("[GDD] pei_timeout()"); /* Process timeout */ switch (index) { case 0: /* Call of timeout routine */ break; default: TRACE_ERROR("[GDD] Unknown Timeout()"); return PEI_ERROR; } return PEI_OK; } /* +------------------------------------------------------------------------------ | Function : pei_signal +------------------------------------------------------------------------------ | Description : Process signal. | | Parameters : opc - signal operation code | data - pointer to primitive | | Return : PEI_OK - signal processed | PEI_ERROR - signal not processed +------------------------------------------------------------------------------ */ static short pei_signal (unsigned long opc, void* data) { #ifdef GDD_MAKE_DTX_CONTEXT_SWITCH U32 con_handle = opc & GDD_DIO_SIGNAL_CON_HANDLE_MASK; #else /* GDD_MAKE_DTX_CONTEXT_SWITCH */ U32 con_handle = opc; #endif /* GDD_MAKE_DTX_CONTEXT_SWITCH */ TRACE_FUNCTION ("[GDD] pei_signal()"); #ifdef GDD_MAKE_DTX_CONTEXT_SWITCH /* Process signal */ switch (opc & GDD_DIO_SIGNAL_MASK) { case GDD_DIO_SIGNAL_SEND_DATA: gdd_dio_rx_sig_send_data(con_handle, (T_dio_buffer *)data); break; case GDD_DIO_SIGNAL_RECEIVE_DATA: gdd_dio_drx_sig_receive_data(con_handle, (T_dio_buffer *)data); break; default: TRACE_ERROR("[GDD] Unknown Signal OPC"); return PEI_ERROR; } #else /* GDD_MAKE_DTX_CONTEXT_SWITCH */ /* If no context switch is done, there is only one signal to be handled. */ gdd_dio_drx_sig_receive_data(con_handle, (T_dio_buffer *)data); #endif /* GDD_MAKE_DTX_CONTEXT_SWITCH */ return PEI_OK; } /* +------------------------------------------------------------------------------ | Function : pei_exit +------------------------------------------------------------------------------ | Description : Close Resources and terminate. | | Parameters : - | | Return : PEI_OK - exit sucessful +------------------------------------------------------------------------------ */ static short pei_exit (void) { TRACE_FUNCTION ("[GDD] pei_exit"); /* * Close communication channels */ vsi_c_close (VSI_CALLER hCommGDD_DIO); hCommGDD_DIO = VSI_ERROR; return PEI_OK; } /* +------------------------------------------------------------------------------ | Function : pei_config +------------------------------------------------------------------------------ | Description : Dynamic Configuration. | | Parameters : in_string - configuration string | | Return : PEI_OK - sucessful | PEI_ERROR - not successful +------------------------------------------------------------------------------ */ static short pei_config (char *in_string) { TRACE_FUNCTION ("[GDD] pei_config()"); TRACE_FUNCTION (in_string); if ( ConfigTimer ( VSI_CALLER in_string, NULL ) == VSI_OK ) return PEI_OK; /* * further dynamic configuration */ #ifdef _SIMULATION_ if (!strncmp("sizeof(T_GDD_DIO_CON_DATA)",in_string,7)) { TRACE_EVENT_P1("[GDD] sizeof(T_GDD_DIO_CON_DATA) = %d", sizeof(T_GDD_DIO_CON_DATA)); } else if (!strncmp("PSI STUB ON",in_string, 11)) { TRACE_EVENT("[GDD] Activating the PSI STUB"); dio_il_sim_activate_psi_stub (TRUE); } else if (!strncmp("PSI STUB OFF",in_string, 12)) { TRACE_EVENT("[GDD] Deactivating the PSI STUB"); dio_il_sim_activate_psi_stub (FALSE); } else if (!strncmp("BATLIB TEST ON",in_string, 14)) { TRACE_EVENT("[GDD] Activating BATlib testing in PSI stub"); dio_il_psi_stub_activate_batlib_test (TRUE); } else if (!strncmp("BATLIB TEST OFF",in_string, 15)) { TRACE_EVENT("[GDD] Deactivating BATlib testing in PSI stub"); dio_il_psi_stub_activate_batlib_test (FALSE); } #endif /* _SIMULATION_ */ return PEI_OK; } /* +------------------------------------------------------------------------------ | Function : pei_monitor +------------------------------------------------------------------------------ | Description : Monitoring of physical Parameters. | | Parameters : out_monitor - return the address of the data to be monitored | | Return : PEI_OK - sucessful (address in out_monitor is valid) | PEI_ERROR - not successful +------------------------------------------------------------------------------ */ static short pei_monitor (void ** out_monitor) { TRACE_FUNCTION ("[GDD] pei_monitor()"); /* * Version = "0.S" (S = Step). */ gdd_dio_mon.version = "gdd_dio 0.1"; *out_monitor = &gdd_dio_mon; return PEI_OK; } /*==== PUBLIC FUNCTIONS =====================================================*/ /* +------------------------------------------------------------------------------ | Function : pei_create +------------------------------------------------------------------------------ | Description : Create the Protocol Stack Entity. | | Parameters : info - Pointer to the structure of entity parameters | | Return : PEI_OK - entity created successfully | +------------------------------------------------------------------------------ */ short gdd_dio_pei_create (T_PEI_INFO **info) { static T_PEI_INFO pei_info = { GDD_DIO_NAME, /* name */ { /* pei-table */ pei_init, #ifdef _SIMULATION_ pei_exit, #else NULL, #endif pei_primitive, pei_timeout, pei_signal, NULL, /* No pei_run function */ pei_config, pei_monitor }, /*1024,*/ /* stack size */ 2048, /* :TODO: check why we need to increase the stack size */ 10, /* queue entries */ 100, /* priority (1->low, 255->high) */ 0, /* number of timers */ 0x03 /* flags: bit 0 active(0) body/passive(1) */ }; /* bit 1 com by copy(0)/reference(1) */ /* * Export startup configuration data */ *info = &pei_info; return PEI_OK; } /*==== END OF FILE ==========================================================*/