FreeCalypso > hg > fc-magnetite
view src/g23m-gsm/cc/cc_em.c @ 116:59ff6e77b23a
r2d_drv_custom_flash.lib compiles
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 06 Oct 2016 18:06:19 +0000 |
parents | 27a4235405c6 |
children |
line wrap: on
line source
/* +----------------------------------------------------------------------------- | Project : | Modul : +----------------------------------------------------------------------------- | 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 defines the engineering mode (EM) device driver for the | G23 protocol stack. This driver is used to control all engineering | mode related functions. +----------------------------------------------------------------------------- */ #ifndef CC_EM_C #define CC_EM_C #define ENTITY_CC /*==== INCLUDES ===================================================*/ #include <string.h> #include "typedefs.h" #include "pcm.h" #include "vsi.h" #include "custom.h" #include "gsm.h" #include "message.h" #include "ccdapi.h" #include "prim.h" #include "cnf_cc.h" #include "mon_cc.h" #include "pei.h" #include "tok.h" #include "cc.h" #include "cc_em.h" /*==== EXPORT =====================================================*/ /*==== PRIVAT =====================================================*/ /*==== VARIABLES ==================================================*/ #ifdef FF_EM_MODE GLOBAL UBYTE em_cc_event_buffer[EM_CC_BUFFER_SIZE]; GLOBAL UBYTE em_cc_buffer_write; /* Event tracing flags for EM */ GLOBAL BOOL cc_v[EM_MAX_CC_EVENTS]; static UBYTE em_cc_trace_occured; #endif /* FF_EM_MODE */ /*==== FUNCTIONS ==================================================*/ #ifdef FF_EM_MODE /* +------------------------------------------------------------------------------ | Function : em_write_buffer_2 +------------------------------------------------------------------------------ | Description : Perform buffer check and store corresponding data in it. | | Parameters : Event number | | Return : TRUE/FALSE | +------------------------------------------------------------------------------ */ GLOBAL UBYTE em_write_buffer_2 (UBYTE event_no) { TRACE_FUNCTION ("cc_em_write_buffer_2()"); if (check_write_index(2)) { em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */ em_cc_event_buffer[em_cc_buffer_write++] = 0; /* Length: 0 means no value */ return FALSE; /* Data is stored inside buffer, reset flag */ } else return TRUE; /* No more space inside buffer, serve flag next time */ } /* +------------------------------------------------------------------------------ | Function : em_write_buffer_3 +------------------------------------------------------------------------------ | Description : Perform buffer check and store corresponding data in it. | | Parameters : Event number, data value | | Return : TRUE/FALSE | +------------------------------------------------------------------------------ */ GLOBAL UBYTE em_write_buffer_3 (UBYTE event_no, UBYTE value) { TRACE_FUNCTION ("cc_em_write_buffer_3()"); if (check_write_index(3)) { em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */ em_cc_event_buffer[em_cc_buffer_write++] = 1; /* Length: 0 means no value */ em_cc_event_buffer[em_cc_buffer_write++] = value; /* Data to be stored */ return FALSE; /* Data is stored inside buffer, reset flag */ } else return TRUE; /* No more space inside buffer, serve flag next time */ } /* +------------------------------------------------------------------------------ | Function : em_write_buffer_3a +------------------------------------------------------------------------------ | Description : Perform buffer check and store corresponding data in it. | | Parameters : Event number, data value (USHORT) | | Return : TRUE/FALSE | +------------------------------------------------------------------------------ */ GLOBAL UBYTE em_write_buffer_3a (UBYTE event_no, USHORT value) { TRACE_FUNCTION ("cc_em_write_buffer_3a()"); if (check_write_index(4)) { em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */ em_cc_event_buffer[em_cc_buffer_write++] = 2; /* Length: 0 means no value */ /* Value: Data to be stored. MSB first, LSB second */ em_cc_event_buffer[em_cc_buffer_write++] = (UBYTE)(value >> 8); em_cc_event_buffer[em_cc_buffer_write++] = (UBYTE)(value); return FALSE; /* Data is stored inside buffer, reset flag */ } else return TRUE; /* No more space inside buffer, serve flag next time */ } /* +------------------------------------------------------------------------------ | Function : em_write_buffer_4 +------------------------------------------------------------------------------ | Description : Perform buffer check and store corresponding data in it. | | Parameters : Event number, data value1, data value2 | | Return : TRUE/FALSE | +------------------------------------------------------------------------------ */ GLOBAL UBYTE em_write_buffer_4 (UBYTE event_no, UBYTE value1, UBYTE value2) { TRACE_FUNCTION ("cc_em_write_buffer_4()"); if (check_write_index(4)) { em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */ em_cc_event_buffer[em_cc_buffer_write++] = 2; /* Length: 0 means no value */ em_cc_event_buffer[em_cc_buffer_write++] = value1; /* Data to be stored, first */ em_cc_event_buffer[em_cc_buffer_write++] = value2; /* Data to be stored, second */ return FALSE; /* Data is stored inside buffer, reset flag */ } else return TRUE; /* No more space inside buffer, serve flag next time */ } /* +------------------------------------------------------------------------------ | Function : em_write_buffer_4a +------------------------------------------------------------------------------ | Description : Perform buffer check and store corresponding data in it. | | Parameters : Event number, data value1 (UBYTE *), data value2 | | Return : TRUE/FALSE | | Purpose : Stores Bearer Capabilitys +------------------------------------------------------------------------------ */ GLOBAL UBYTE em_write_buffer_4a (UBYTE event_no, UBYTE *ptr1, UBYTE value2) { UBYTE bc_len; UBYTE i, em_report_len = 3; /* Initial 2 + TI */ TRACE_FUNCTION ("cc_em_write_buffer_4a()"); ptr1++; /* Skip message type --> ptr1 shows now to BC-Tag*/ if (*ptr1++ EQ 0x04) /* BC tag (0x04) --> ptr1 shows now to length field*/ { TRACE_FUNCTION ("EM_CC: BC tag found (0x04)"); if(*ptr1 > MNCC_MAX_BC_LEN) /* Field length exceeded */ { ; /*better to insert some kind of trace here*/ bc_len = MNCC_MAX_BC_LEN; /*Just trace the maximum of BC's - skip the rest*/ } else /* Field length not exceeded */ { bc_len = *ptr1; /*trace all BC's possible */ } ptr1++; /* ptr1 shows now the first BC */ em_report_len += bc_len; /* Length of encoded bearer caps */ if(check_write_index((UBYTE)(em_report_len))) /* just to ensure no buffer overflow */ { em_cc_event_buffer[em_cc_buffer_write++] = event_no; em_cc_event_buffer[em_cc_buffer_write++] = (em_report_len - 2); for (i=0; i<(bc_len); i++) /* Starting with the bearercap IEI */ { em_cc_event_buffer[em_cc_buffer_write++] = *ptr1++; /* Bearer caps encoded */ } /* Only bearer caps should be recorded, therefore decrement em_cc_buffer_write */ em_cc_event_buffer[em_cc_buffer_write++] = value2; /* TI */ return FALSE; /* Data is stored inside buffer, reset flag */ } /* check_write_index */ } /* BC tag 0x04*/ else { TRACE_FUNCTION ("EM_CC: No BC tag found"); }/* no BC tag 0x04*/ return TRUE; /* No more space inside buffer or no BC tag, serve flag next time */ } /* +------------------------------------------------------------------------------ | Function : check_write_index +------------------------------------------------------------------------------ | Description : Checks the write index inside the buffer. No reset when | buffer is full. | | Parameters : Number of bytes to be stored in buffer | | Return : TRUE/FALSE | +------------------------------------------------------------------------------ */ GLOBAL UBYTE check_write_index (UBYTE n) { TRACE_FUNCTION ("cc_check_write_index()"); if (em_cc_buffer_write + n < EM_CC_BUFFER_SIZE) { /* * ACI is informed about the first event trace, * used for later data processing. */ if (em_cc_trace_occured == 0) { PALLOC(data, EM_DATA_IND); data->entity = EM_CC; PSENDX(MMI, data); em_cc_trace_occured++; } return TRUE; } else { TRACE_ERROR("EM_CC: buffer overflow"); return FALSE; } } /* +------------------------------------------------------------------------------ | Function : em_init_cc_event_trace +------------------------------------------------------------------------------ | Description : Initialize the event tracing flags for SMS | | Parameters : | | Return : | +------------------------------------------------------------------------------ */ GLOBAL void em_init_cc_event_trace(void) { UBYTE i; TRACE_FUNCTION ("em_init_cc_event_trace()"); for (i = 1; i < EM_MAX_CC_EVENTS; i++) cc_v[i] = 0; em_cc_buffer_write = 0; } /* +------------------------------------------------------------------------------ | Function : cc_em_cc_event_req +------------------------------------------------------------------------------ | Description : Set the event tracing flags according the bitmask | | Parameters : Primitive - Bitmask | | Return : | +------------------------------------------------------------------------------ */ GLOBAL void cc_em_cc_event_req (T_EM_CC_EVENT_REQ *em_cc_event_req) { UBYTE i; TRACE_FUNCTION ("cc_em_cc_event_req()"); /* * The event tracing flags are set according the bitmask. cc_v[i] are * the flags belonging to the event number described in 8443.601 */ for(i = 1; i < 33; i++) cc_v[i] = ((em_cc_event_req->bitmask_cc_l & (0x01<<(i-1))) > 0) ? TRUE : FALSE; for(i = 33; i < EM_MAX_CC_EVENTS; i++) cc_v[i] = ((em_cc_event_req->bitmask_cc_h & (0x01<<(i-1))) > 0) ? TRUE : FALSE; /* * A new event trace is generated therefor the flag is reset. */ em_cc_trace_occured = 0; PFREE(em_cc_event_req); } #endif /* FF_EM_MODE */ #endif /* CC_EM_C */