104
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 +-----------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 | Project :
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 | Modul :
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 +-----------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 | Copyright 2002 Texas Instruments Berlin, AG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 | All rights reserved.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 | This file is confidential and a trade secret of Texas
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 | Instruments Berlin, AG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 | The receipt of or possession of this file does not convey
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 | any rights to reproduce or disclose its contents or to
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 | manufacture, use, or sell anything it may describe, in
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 | whole, or in part, without the specific written consent of
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 | Texas Instruments Berlin, AG.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 +-----------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 | Purpose : This Module defines the engineering mode (EM) device driver for the
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 | G23 protocol stack. This driver is used to control all engineering
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 | mode related functions.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 +-----------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 #ifndef CC_EM_C
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 #define CC_EM_C
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 #define ENTITY_CC
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 /*==== INCLUDES ===================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 #include <string.h>
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 #include "typedefs.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 #include "pcm.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 #include "vsi.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 #include "custom.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
35 #include "gsm.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
36 #include "message.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 #include "ccdapi.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 #include "prim.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39 #include "cnf_cc.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 #include "mon_cc.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
41 #include "pei.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 #include "tok.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
43 #include "cc.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
44 #include "cc_em.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
45
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
46 /*==== EXPORT =====================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
47
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
48 /*==== PRIVAT =====================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
49
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
50 /*==== VARIABLES ==================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 #ifdef FF_EM_MODE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 GLOBAL UBYTE em_cc_event_buffer[EM_CC_BUFFER_SIZE];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
54 GLOBAL UBYTE em_cc_buffer_write;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 /* Event tracing flags for EM */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 GLOBAL BOOL cc_v[EM_MAX_CC_EVENTS];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
58
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
59 static UBYTE em_cc_trace_occured;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
60 #endif /* FF_EM_MODE */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
61
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
62 /*==== FUNCTIONS ==================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
63
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
64 #ifdef FF_EM_MODE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
65
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
66 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 | Function : em_write_buffer_2
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
69 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 | Description : Perform buffer check and store corresponding data in it.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
71 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
72 | Parameters : Event number
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
73 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
74 | Return : TRUE/FALSE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
75 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
77 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
79 GLOBAL UBYTE em_write_buffer_2 (UBYTE event_no)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
80 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
81 TRACE_FUNCTION ("cc_em_write_buffer_2()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 if (check_write_index(2))
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
85 em_cc_event_buffer[em_cc_buffer_write++] = 0; /* Length: 0 means no value */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
86 return FALSE; /* Data is stored inside buffer, reset flag */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
87 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
88 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
89 return TRUE; /* No more space inside buffer, serve flag next time */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
90 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
91
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
92 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
93 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
94 | Function : em_write_buffer_3
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
95 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
96 | Description : Perform buffer check and store corresponding data in it.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
97 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
98 | Parameters : Event number, data value
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
99 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
100 | Return : TRUE/FALSE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
101 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
102 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
103 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
104
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
105 GLOBAL UBYTE em_write_buffer_3 (UBYTE event_no, UBYTE value)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
106 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
107 TRACE_FUNCTION ("cc_em_write_buffer_3()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
108
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
109 if (check_write_index(3))
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
110 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
111 em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
112 em_cc_event_buffer[em_cc_buffer_write++] = 1; /* Length: 0 means no value */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
113 em_cc_event_buffer[em_cc_buffer_write++] = value; /* Data to be stored */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
114 return FALSE; /* Data is stored inside buffer, reset flag */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
115 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
116 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
117 return TRUE; /* No more space inside buffer, serve flag next time */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
118 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
119
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
120 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
121 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
122 | Function : em_write_buffer_3a
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
123 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
124 | Description : Perform buffer check and store corresponding data in it.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
125 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
126 | Parameters : Event number, data value (USHORT)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
127 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
128 | Return : TRUE/FALSE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
129 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
130 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
131 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
132
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
133 GLOBAL UBYTE em_write_buffer_3a (UBYTE event_no, USHORT value)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
134 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
135 TRACE_FUNCTION ("cc_em_write_buffer_3a()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
136
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
137 if (check_write_index(4))
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
138 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
139 em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
140 em_cc_event_buffer[em_cc_buffer_write++] = 2; /* Length: 0 means no value */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
141
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
142 /* Value: Data to be stored. MSB first, LSB second */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
143 em_cc_event_buffer[em_cc_buffer_write++] = (UBYTE)(value >> 8);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
144 em_cc_event_buffer[em_cc_buffer_write++] = (UBYTE)(value);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
145 return FALSE; /* Data is stored inside buffer, reset flag */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
146 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
147 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
148 return TRUE; /* No more space inside buffer, serve flag next time */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
149 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
150
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
151 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
152 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
153 | Function : em_write_buffer_4
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
154 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
155 | Description : Perform buffer check and store corresponding data in it.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
156 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
157 | Parameters : Event number, data value1, data value2
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
158 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
159 | Return : TRUE/FALSE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
160 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
161 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
162 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
163
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
164 GLOBAL UBYTE em_write_buffer_4 (UBYTE event_no, UBYTE value1, UBYTE value2)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
165 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
166 TRACE_FUNCTION ("cc_em_write_buffer_4()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
167
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
168 if (check_write_index(4))
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
169 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
170 em_cc_event_buffer[em_cc_buffer_write++] = event_no; /* Tag: Event number */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
171 em_cc_event_buffer[em_cc_buffer_write++] = 2; /* Length: 0 means no value */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
172 em_cc_event_buffer[em_cc_buffer_write++] = value1; /* Data to be stored, first */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
173 em_cc_event_buffer[em_cc_buffer_write++] = value2; /* Data to be stored, second */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
174 return FALSE; /* Data is stored inside buffer, reset flag */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
175 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
176 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
177 return TRUE; /* No more space inside buffer, serve flag next time */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
178 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
179
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
180
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
181 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
182 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
183 | Function : em_write_buffer_4a
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
184 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
185 | Description : Perform buffer check and store corresponding data in it.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
186 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
187 | Parameters : Event number, data value1 (UBYTE *), data value2
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
188 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
189 | Return : TRUE/FALSE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
190 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
191 | Purpose : Stores Bearer Capabilitys
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
192 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
193 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
194
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
195 GLOBAL UBYTE em_write_buffer_4a (UBYTE event_no, UBYTE *ptr1, UBYTE value2)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
196 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
197
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
198 UBYTE bc_len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
199 UBYTE i, em_report_len = 3; /* Initial 2 + TI */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
200
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
201 TRACE_FUNCTION ("cc_em_write_buffer_4a()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
202
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
203 ptr1++; /* Skip message type --> ptr1 shows now to BC-Tag*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
204 if (*ptr1++ EQ 0x04) /* BC tag (0x04) --> ptr1 shows now to length field*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
205 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
206 TRACE_FUNCTION ("EM_CC: BC tag found (0x04)");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
207 if(*ptr1 > MNCC_MAX_BC_LEN) /* Field length exceeded */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
208 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
209 ; /*better to insert some kind of trace here*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
210 bc_len = MNCC_MAX_BC_LEN; /*Just trace the maximum of BC's - skip the rest*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
211 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
212 else /* Field length not exceeded */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
213 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
214 bc_len = *ptr1; /*trace all BC's possible */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
215 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
216
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
217 ptr1++; /* ptr1 shows now the first BC */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
218
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
219 em_report_len += bc_len; /* Length of encoded bearer caps */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
220
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
221 if(check_write_index((UBYTE)(em_report_len))) /* just to ensure no buffer overflow */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
222 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
223 em_cc_event_buffer[em_cc_buffer_write++] = event_no;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
224 em_cc_event_buffer[em_cc_buffer_write++] = (em_report_len - 2);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
225 for (i=0; i<(bc_len); i++) /* Starting with the bearercap IEI */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
226 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
227 em_cc_event_buffer[em_cc_buffer_write++] = *ptr1++; /* Bearer caps encoded */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
228 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
229 /* Only bearer caps should be recorded, therefore decrement em_cc_buffer_write */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
230 em_cc_event_buffer[em_cc_buffer_write++] = value2; /* TI */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
231
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
232 return FALSE; /* Data is stored inside buffer, reset flag */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
233 } /* check_write_index */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
234 } /* BC tag 0x04*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
235 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
236 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
237 TRACE_FUNCTION ("EM_CC: No BC tag found");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
238 }/* no BC tag 0x04*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
239 return TRUE; /* No more space inside buffer or no BC tag, serve flag next time */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
240 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
241
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
242
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
243 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
244 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
245 | Function : check_write_index
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
246 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
247 | Description : Checks the write index inside the buffer. No reset when
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
248 | buffer is full.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
249 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
250 | Parameters : Number of bytes to be stored in buffer
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
251 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
252 | Return : TRUE/FALSE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
253 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
254 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
255 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
256
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
257 GLOBAL UBYTE check_write_index (UBYTE n)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
258 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
259 TRACE_FUNCTION ("cc_check_write_index()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
260
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
261 if (em_cc_buffer_write + n < EM_CC_BUFFER_SIZE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
262 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
263 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
264 * ACI is informed about the first event trace,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
265 * used for later data processing.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
266 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
267 if (em_cc_trace_occured == 0)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
268 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
269 PALLOC(data, EM_DATA_IND);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
270 data->entity = EM_CC;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
271 PSENDX(MMI, data);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
272 em_cc_trace_occured++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
273 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
274 return TRUE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
275 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
276 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
277 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
278 TRACE_ERROR("EM_CC: buffer overflow");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
279 return FALSE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
280 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
281 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
282
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
283
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
284 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
285 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
286 | Function : em_init_cc_event_trace
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
287 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
288 | Description : Initialize the event tracing flags for SMS
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
289 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
290 | Parameters :
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
291 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
292 | Return :
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
293 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
294 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
295 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
296
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
297 GLOBAL void em_init_cc_event_trace(void)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
298 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
299 UBYTE i;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
300
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
301 TRACE_FUNCTION ("em_init_cc_event_trace()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
302
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
303 for (i = 1; i < EM_MAX_CC_EVENTS; i++)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
304 cc_v[i] = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
305
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
306 em_cc_buffer_write = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
307 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
308
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
309
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
310 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
311 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
312 | Function : cc_em_cc_event_req
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
313 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
314 | Description : Set the event tracing flags according the bitmask
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
315 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
316 | Parameters : Primitive - Bitmask
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
317 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
318 | Return :
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
319 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
320 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
321 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
322
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
323 GLOBAL void cc_em_cc_event_req (T_EM_CC_EVENT_REQ *em_cc_event_req)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
324 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
325 UBYTE i;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
326
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
327 TRACE_FUNCTION ("cc_em_cc_event_req()");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
328
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
329 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
330 * The event tracing flags are set according the bitmask. cc_v[i] are
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
331 * the flags belonging to the event number described in 8443.601
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
332 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
333 for(i = 1; i < 33; i++)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
334 cc_v[i] = ((em_cc_event_req->bitmask_cc_l & (0x01<<(i-1))) > 0) ? TRUE : FALSE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
335
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
336 for(i = 33; i < EM_MAX_CC_EVENTS; i++)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
337 cc_v[i] = ((em_cc_event_req->bitmask_cc_h & (0x01<<(i-1))) > 0) ? TRUE : FALSE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
338
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
339 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
340 * A new event trace is generated therefor the flag is reset.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
341 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
342 em_cc_trace_occured = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
343
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
344 PFREE(em_cc_event_req);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
345 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
346
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
347 #endif /* FF_EM_MODE */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
348
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
349 #endif /* CC_EM_C */
|