fc-magnetite: src/g23m-gsm/mm/mm

annotate src/g23m-gsm/mm/mm_em.c @ 702:9394305d4ff5 default tip

etm_audio.c: fix off-by-one error in auw of FIR coefficients This fix was already made in FC Tourmaline a while back, but it is also the kind of bugfix that deserves to be backported to Magnetite and Selenite as well.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Mon, 31 Oct 2022 00:14:44 +0000
parents	27a4235405c6
children

rev	line source
104 27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 +-----------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 \| Project :
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 \| Modul :
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 +-----------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 \| Copyright 2002 Texas Instruments Berlin, AG
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 \| All rights reserved.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 \| Instruments Berlin, AG
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 \| The receipt of or possession of this file does not convey
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 \| whole, or in part, without the specific written consent of
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 \| Texas Instruments Berlin, AG.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 +-----------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 \| Purpose : This Module defines the engineering mode (EM) device driver for the
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 \| G23 protocol stack. This driver is used to control all engineering
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 \| mode related functions.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 +-----------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #ifndef MM_EM_C
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #define MM_EM_C
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 #define ENTITY_MM
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 /==== INCLUDES ===================================================/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include <string.h>
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include <stdlib.h>
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include <stddef.h>
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "typedefs.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #include "pcm.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "pconst.cdg"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "mconst.cdg"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #include "message.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #include "ccdapi.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #include "vsi.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 #include "custom.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #include "gsm.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #include "prim.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #include "cnf_mm.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #include "mon_mm.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 #include "pei.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #include "tok.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #include "mm.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include "mm_em.h"
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 /==== EXPORT =====================================================/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 /==== PRIVAT =====================================================/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 /==== VARIABLES ==================================================/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #ifdef FF_EM_MODE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 GLOBAL UBYTE em_mm_event_buffer[EM_MM_BUFFER_SIZE];
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 GLOBAL UBYTE em_mm_buffer_write;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 /* Event tracing flags for EM */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 GLOBAL BOOL mm_v[EM_MAX_MM_EVENTS];
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 static UBYTE em_mm_trace_occured;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 #endif /* FF_EM_MODE */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 /==== FUNCTIONS ==================================================/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #ifdef FF_EM_MODE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 \| Function : em_write_buffer_2
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 \| Parameters : Event number
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 GLOBAL UBYTE em_write_buffer_2 (UBYTE event_no)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 TRACE_FUNCTION ("mm_em_write_buffer_2()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 if (check_write_index(2))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 em_mm_event_buffer[em_mm_buffer_write++] = 0; /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 \| Function : em_write_buffer_3
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 \| Parameters : Event number, data value
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 GLOBAL UBYTE em_write_buffer_3 (UBYTE event_no, UBYTE value)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 TRACE_FUNCTION ("mm_em_write_buffer_3()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 if (check_write_index(3))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 em_mm_event_buffer[em_mm_buffer_write++] = 1; /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 em_mm_event_buffer[em_mm_buffer_write++] = value; /* Value: Data to be stored */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 \| Function : em_write_buffer_3a
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 \| Parameters : Event number, data value (USHORT)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 GLOBAL UBYTE em_write_buffer_3a (UBYTE event_no, USHORT value)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 TRACE_FUNCTION ("mm_em_write_buffer_3a()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 if (check_write_index(4))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 em_mm_event_buffer[em_mm_buffer_write++] = 2; /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 /* Value: Data to be stored. MSB first, LSB second */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value >> 8);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 \| Function : em_write_buffer_3b
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 \| Parameters : Event number, data value (ULONG)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 \| Pupose : Used for storing TMSI
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 #define RINGBUF_3B_LENGTH (2 + 4)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 GLOBAL UBYTE em_write_buffer_3b (UBYTE event_no, ULONG value)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 TRACE_FUNCTION ("mm_em_write_buffer_3b()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 if (check_write_index(RINGBUF_3B_LENGTH))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 em_mm_event_buffer[em_mm_buffer_write++] = RINGBUF_3B_LENGTH-2; /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 /* Value: Data to be stored. MSB first, LSB second */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value>>24); /* MSB first */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value>>16); /* new TMSI */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value>> 8);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value); /* LSB last */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 \| Function : em_write_buffer_4
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 \| Parameters : Event number, data value1, data plmn (T_plmn)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 \| Pupose : Used for storing PLMN list
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 GLOBAL UBYTE em_write_buffer_4 (UBYTE event_no, UBYTE value1, T_plmn *plmn)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 UBYTE i;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 UBYTE n = 2;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 TRACE_FUNCTION ("mm_em_write_buffer_4()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 n += ((SIZE_MCC + SIZE_MNC) * value1); /Compute exact size of data to be stored/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 if(check_write_index(n))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 em_mm_event_buffer[em_mm_buffer_write++] = (n - 2); /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 for (i = 0; i < value1; i++) /stores MCC and MNC of every available PLMN/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 if(plmn[i].v_plmn)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 memcpy(&em_mm_event_buffer[em_mm_buffer_write], plmn[i].mcc, SIZE_MCC);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 em_mm_buffer_write += SIZE_MCC;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 memcpy(&em_mm_event_buffer[em_mm_buffer_write], plmn[i].mnc, SIZE_MNC);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 em_mm_buffer_write += SIZE_MNC;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 } /valid/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 } /for/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 }/* check write index*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 \| Function : em_write_buffer_4a
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 \| Parameters : Event number, data value1 (UBYTE), data value2 (USHORT)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 \| Pupose : Used for storing Location Update Reject
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 #define RINGBUF_4A_LENGTH (2 + 1 + 2)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 GLOBAL UBYTE em_write_buffer_4a (UBYTE event_no, UBYTE value1, USHORT value2)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 TRACE_FUNCTION ("mm_em_write_buffer_4a()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 if (check_write_index(RINGBUF_4A_LENGTH))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 em_mm_event_buffer[em_mm_buffer_write++] = RINGBUF_4A_LENGTH-2; /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 em_mm_event_buffer[em_mm_buffer_write++] = value1;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value2 >> 8);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value2);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 }/* check write index*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 \| Function : em_write_buffer_4b
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 \| Parameters : Event number, data identity type (UBYTE), data value (UBYTE *)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 \| Pupose : Used for storing IMEI, IMEISV, IMSI during Identity Request/Response
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 GLOBAL UBYTE em_write_buffer_4b (UBYTE event_no, UBYTE ident_type, UBYTE *value)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 UBYTE n;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 UBYTE digits;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 TRACE_FUNCTION ("mm_em_write_buffer_4b()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 switch (ident_type) /Creating length of data to be stored/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 case ID_TYPE_IMEI:
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 digits = 14; /length of IMEI /
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 break;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 case ID_TYPE_IMSI:
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 case ID_TYPE_IMEISV:
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 digits = 16; /length of IMSI / IMEISV /
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 break;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 default: /* Illegal mobile identity - not possible because of calling function*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 break;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 } /switch/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 n = 3 + digits; /* Tag + Length + Type + Digits / /lint !e644/ /for lint: Digits are
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 always initialized because of calling function*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 if (check_write_index(n))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 em_mm_event_buffer[em_mm_buffer_write++] = (n - 2); /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 em_mm_event_buffer[em_mm_buffer_write++] = ident_type;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 memcpy (&em_mm_event_buffer[em_mm_buffer_write], value, digits);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 em_mm_buffer_write += digits;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 }/* check write index*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 \| Function : em_write_buffer_4c
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 \| Parameters : Event number, data identity type (UBYTE), data value (ULONG)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 \| Pupose : Used during Identity Request/Response for storing TMSI
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 #define RINGBUF_4C_LENGTH (2 + 1 + 4)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 GLOBAL UBYTE em_write_buffer_4c (UBYTE event_no, UBYTE ident_type, ULONG value)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 TRACE_FUNCTION ("mm_em_write_buffer_4c()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 if (check_write_index(RINGBUF_4C_LENGTH))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 em_mm_event_buffer[em_mm_buffer_write++] = (RINGBUF_4C_LENGTH - 2); /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 em_mm_event_buffer[em_mm_buffer_write++] = ident_type;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value>>24); /* MSB first */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value>>16);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value>> 8);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(value); /* LSB last */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 }/* check write index*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 \| Function : em_write_buffer_5a
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 \| Parameters : Event number, data value (UBYTE), data mcc (UBYTE), data mnc (UBYTE)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 \| Pupose : Used for storing Service Mode, MCC und MNC during registration
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 \| Used for storing data during cell reselection
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 #define RINGBUF_5A_LENGTH (2 + 1 + SIZE_MCC + SIZE_MNC)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 GLOBAL UBYTE em_write_buffer_5a (UBYTE event_no, UBYTE value, UBYTE mcc[SIZE_MCC], UBYTE mnc[SIZE_MNC])
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 TRACE_FUNCTION ("mm_em_write_buffer_5a()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 if (check_write_index(RINGBUF_5A_LENGTH))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 em_mm_event_buffer[em_mm_buffer_write++] = RINGBUF_5A_LENGTH-2; /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 em_mm_event_buffer[em_mm_buffer_write++] = value;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 /missing check for validy/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 memcpy(&em_mm_event_buffer[em_mm_buffer_write], mcc, SIZE_MCC);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 em_mm_buffer_write += SIZE_MCC;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 memcpy(&em_mm_event_buffer[em_mm_buffer_write], mnc, SIZE_MNC);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 em_mm_buffer_write += SIZE_MNC;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 }/* check write index*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 \| Function : em_write_buffer_6
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 \| Description : Perform buffer check and store corresponding data in it.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 \| Parameters : Event number, data location update type (UBYTE), data lai (T_loc_area_ident)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 \| Pupose : Used for storing Location Update Type, MCC, MNC and LAC
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 #define RINGBUF_6_LENGTH (2 + 1 + SIZE_MCC + SIZE_MNC + 2)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 GLOBAL UBYTE em_write_buffer_6 (UBYTE event_no, UBYTE loc_upd_type, T_loc_area_ident lai)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 TRACE_FUNCTION ("mm_em_write_buffer_6()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 if (check_write_index(RINGBUF_6_LENGTH))
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 em_mm_event_buffer[em_mm_buffer_write++] = event_no; /* Tag: Event number */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 em_mm_event_buffer[em_mm_buffer_write++] = RINGBUF_6_LENGTH - 2; /* Length: 0 means no value */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 em_mm_event_buffer[em_mm_buffer_write++] = loc_upd_type;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 memcpy(&em_mm_event_buffer[em_mm_buffer_write], lai.mcc, SIZE_MCC); /stores MCC/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 em_mm_buffer_write += SIZE_MCC;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 memcpy(&em_mm_event_buffer[em_mm_buffer_write], lai.mnc, SIZE_MNC); /stores MNC/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 em_mm_buffer_write += SIZE_MNC;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(lai.lac >> 8); /stores LAC/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 em_mm_event_buffer[em_mm_buffer_write++] = (UBYTE)(lai.lac);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 return FALSE; /* Data is stored inside buffer, reset flag */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 }/* check write index*/
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 return TRUE; /* No more space inside buffer, serve flag next time */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 \| Function : check_write_index
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 \| Description : Checks the write index inside the buffer. No reset when
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 \| buffer is full.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 \| Parameters : Number of bytes to be stored in buffer
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 \| Return : TRUE/FALSE
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 GLOBAL UBYTE check_write_index (UBYTE n)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 TRACE_FUNCTION ("mm_check_write_index()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 if (em_mm_buffer_write + n < EM_MM_BUFFER_SIZE)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 * ACI is informed about the first event trace,
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 * used for later data processing.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 if (em_mm_trace_occured EQ 0)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 PALLOC(data, EM_DATA_IND);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 data->entity = EM_MM;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 PSENDX(MMI, data);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 em_mm_trace_occured++;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 return TRUE;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 else
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 return FALSE;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 \| Function : mm_em_mm_event_req
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 \| Description : Set the event tracing flags according the bitmask for dl
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 \| Parameters : Primitive - Bitmask
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 \| Return :
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 GLOBAL void mm_em_dl_event_req (T_EM_DL_EVENT_REQ *em_dl_event_req)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 TRACE_FUNCTION ("mm_em_dl_event_req()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 PSENDX(DL, em_dl_event_req);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 \| Function : em_init_mm_event_trace
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 \| Description : Initialize the event tracing flags for MM
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 \| Parameters : void
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 \| Return : void
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 GLOBAL void em_init_mm_event_trace(void)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 UBYTE i;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 TRACE_FUNCTION ("em_init_mm_event_trace()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 for (i = 0; i < EM_MAX_MM_EVENTS; i++)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 mm_v[i] = 0;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 em_mm_buffer_write = 0;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 \| Function : mm_em_mm_event_req
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 \| Description : Set the event tracing flags according the bitmask
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 \| Parameters : Primitive - Bitmask
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 \| Return :
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 \|
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 +------------------------------------------------------------------------------
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 GLOBAL void mm_em_mm_event_req (T_EM_MM_EVENT_REQ *em_mm_event_req)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516 {
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 UBYTE i;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 TRACE_FUNCTION ("mm_em_mm_event_req()");
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 * The event tracing flags are set according the bitmask. mm_v[i] are
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 * the flags belonging to the event number described in 8443.601
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 for(i = 1; i < EM_MAX_MM_EVENTS; i++)
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526 mm_v[i] = ((em_mm_event_req->bitmask_mm & (0x01<<(i-1))) > 0) ? TRUE : FALSE;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 /*
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 * A new event trace is generated therefore the flag is reset.
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 em_mm_trace_occured = 0;
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 PFREE(em_mm_event_req);
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 }
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 #endif /* FF_EM_MODE */
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536
27a4235405c6 src/g23m-gsm: import from LoCosto source Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 #endif /* MM_EM_C */

FreeCalypso > hg > fc-magnetite

annotate src/g23m-gsm/mm/mm_em.c @ 702:9394305d4ff5 default tip