FreeCalypso > hg > freecalypso-citrine

comparison L1/dyn_dwl_cfile/l1_dyn_dwl_afunc.c @ 0:75a11d740a02

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 09 Jun 2016 00:02:41 +0000
parents
children dfc7b0bc468a
comparison
equal deleted inserted replaced
-1:000000000000 0:75a11d740a02
1 /************* Revision Controle System Header *************
2 * GSM Layer 1 software
3 * L1_DYN_DWL_AFUNC.C
4 *
5 * Filename l1_dyn_dwl_afunc.c
6 * Copyright 2004 (C) Texas Instruments
7 *
8 ************* Revision Controle System Header *************/
9
10 #include "config.h"
11 #include "l1_confg.h"
12 #include "l1_types.h"
13 #include "sys_types.h"
14 #include "../../gpf/inc/cust_os.h"
15 #include "l1_macro.h"
16 #include "l1_const.h"
17 #if TESTMODE
18 #include "l1tm_defty.h"
19 #endif
20 #if (AUDIO_TASK == 1)
21 #include "l1audio_const.h"
22 #include "l1audio_cust.h"
23 #include "l1audio_defty.h"
24 #include "l1audio_signa.h"
25 #endif
26 #if (L1_GTT == 1)
27 #include "l1gtt_const.h"
28 #include "l1gtt_defty.h"
29 #include "l1gtt_signa.h"
30 #endif
31 #if (L1_DYN_DSP_DWNLD == 1)
32 #include "l1_dyn_dwl_msgty.h"
33 #include "l1_dyn_dwl_defty.h"
34 #include "l1_dyn_dwl_proto.h"
35 #include "l1_dyn_dwl_const.h"
36 #endif //L1_DYN_DSP_DWNLD
37 #if (L1_MP3 == 1)
38 #include "l1mp3_signa.h"
39 #include "l1mp3_defty.h"
40 #endif //L1_MP3
41 #if (L1_MIDI == 1)
42 #include "l1midi_defty.h"
43 #endif
44 #if (L1_AAC == 1)
45 #include "l1aac_signa.h"
46 #include "l1aac_defty.h"
47 #endif //L1_AAC
48 #include "l1_defty.h"
49 #include "l1_varex.h"
50 #include "l1_msgty.h"
51 #include "l1_proto.h"
52 #include "l1_signa.h"
53 #include <string.h>
54 #include <stdio.h>
55
56
57 #if (TRACE_TYPE == 1) ||(TRACE_TYPE == 4) || (TRACE_TYPE == 7) || (TESTMODE)
58 #include "l1_trace.h"
59 #endif
60
61 #if (L1_DYN_DSP_DWNLD == 1)
62
63 extern const BOOL primitives_to_patch_matrix[][MAX_NUM_OF_PATCH_IDS];
64 extern const BOOL incompatibility_matrix[][MAX_NUM_OF_PATCH_IDS];
65 extern const BOOL semaphore_matrix[][MAX_NUM_OF_SEMAPHORES];
66
67 /* table reconstructed from disassembly of TCS211 binary object */
68 const T_SIGNAL_PATCH signal_patch_array[NUM_OF_DYN_DWNLD_PRIMITIVES] =
69 {
70 {L1C_STOP_DEDICATED_DONE, 0},
71 #if (L1_GTT == 1)
72 {MMI_GTT_START_REQ, 1},
73 #endif
74 {MPHC_IMMED_ASSIGN_REQ, 2},
75 #if (MELODY_E2 == 1)
76 {MMI_MELODY0_E2_START_REQ, 3},
77 {MMI_MELODY1_E2_START_REQ, 4},
78 {L1_BACK_MELODY_E2_UNLOAD_INSTRUMENT_CON, 5},
79 #endif
80 };
81
82
83 /*
84 * LoCosto version of L1 has a function called l1_check_flag_for_download_area()
85 * here. TCS211 binary object has l1_handle_particular_cases_for_TCS211()
86 * instead. We are going to reconstruct the TCS211 function based on
87 * disassembly, using the LoCosto version as our starting point.
88 */
89
90 void l1_handle_particular_cases_for_TCS211(UWORD32 msg_code, BOOL *return_flag)
91 {
92 switch(msg_code)
93 {
94 /* from disassembly */
95 case MPHC_IMMED_ASSIGN_REQ: /* 0x0033 */
96 /* code at 0x8e */
97 l1a.dyn_dwnld.dedicated_stop_flag = FALSE;
98 return;
99 case L1C_STOP_DEDICATED_DONE: /* 0x0081 */
100 /* code at 0x86 */
101 l1a.dyn_dwnld.dedicated_stop_flag = TRUE;
102 return;
103 #if (MELODY_E2 == 1)
104 case MMI_MELODY0_E2_START_REQ: /* 0x182E */
105 /* code at 0x6c */
106 l1a.dyn_dwnld.melody0_E2_flag_activated = TRUE;
107 if (l1a.dyn_dwnld.melody1_E2_flag_activated == TRUE) {
108 /* code at 0x80 */
109 *return_flag = FALSE;
110 return;
111 }
112 return;
113 case MMI_MELODY1_E2_START_REQ: /* 0x1832 */
114 /* code at 0x56 */
115 l1a.dyn_dwnld.melody1_E2_flag_activated = TRUE;
116 if (l1a.dyn_dwnld.melody0_E2_flag_activated == TRUE) {
117 /* code at 0x80 */
118 *return_flag = FALSE;
119 return;
120 }
121 return;
122 case L1_BACK_MELODY_E2_UNLOAD_INSTRUMENT_CON: /* 0x1866 */
123 /* code at 0x3e */
124 if (l1a.dyn_dwnld.melody0_E2_flag_activated == TRUE ||
125 l1a.dyn_dwnld.melody1_E2_flag_activated == TRUE) {
126 /* code at 0x80 */
127 *return_flag = FALSE;
128 return;
129 }
130 return;
131 case L1_MELODY0_E2_STOP_CON: /* 0x1867 */
132 /* code at 0x36 */
133 l1a.dyn_dwnld.melody0_E2_flag_activated = FALSE;
134 return;
135 case L1_MELODY1_E2_STOP_CON: /* 0x1868 */
136 /* code at 0x2e */
137 l1a.dyn_dwnld.melody1_E2_flag_activated = FALSE;
138 return;
139 #endif
140 default:
141 return;
142 }
143
144 }
145 /*------------------------------------------------------------------------------------------------------------------- */
146 /* l1_does_the_incoming_primitive_trigger_dynamic_dwnld */
147 /*------------------------------------------------------------------------------------------------------------------- */
148 /* */
149 /* Parameters : Signal Code of the message, delay flag */
150 /* */
151 /* Return : TRUE if the primitive triggers a dynamic download, FALSE in the other case */
152 /* */
153 /* Description : Check if the primitive triggers a dynamic download; if yes it return TRUE, otherwise FALSE */
154 /* */
155 /* */
156 /*------------------------------------------------------------------------------------------------------------------- */
157
158 BOOL l1_does_the_incoming_primitive_trigger_dynamic_dwnld(UWORD32 msg_code, BOOL delay_flag)
159 {
160 BOOL return_flag = FALSE;
161 UWORD16 i;
162 for (i=0;i<l1a.dyn_dwnld.num_of_primitives;i++)
163 {
164 if(msg_code == signal_patch_array[i].primitive)
165 return_flag = TRUE;
166
167 }
168
169 l1_handle_particular_cases_for_TCS211(msg_code, &return_flag);
170
171 return return_flag;
172 }
173
174 /*---------------------------------------------------------------------------------------- */
175 /* l1_lookup_primitive_patch_matrix */
176 /*---------------------------------------------------------------------------------------- */
177 /* */
178 /* Parameters : Signal Code of the message, patch_id vector */
179 /* */
180 /* Return : number of patches to download, patch ids vectore (by reference) */
181 /* */
182 /* Description : Retrieves the patch ids to be downloaded and number of patches to download */
183 /* Patch ID is retrieved via look-up in primitives to patch ID matrix */
184 /* */
185 /*---------------------------------------------------------------------------------------- */
186
187 UWORD16 l1_lookup_primitive_patch_matrix(UWORD32 msg_code, UWORD16* patch_id_p)
188 {
189 UWORD16 j;
190 UWORD16 counter=0;
191 UWORD16 msg_code_id=0 ;//omaps00090550
192
193 // Check if one of the messages belongs to the set of primitves which triggers a dynamic download and saves its index
194
195 #if 0 // LoCosto-ism not present in TCS211
196 if (!((l1a.state[L1A_GTT_STATE] == 0) || (l1a.state[L1A_GTT_STATE] == 1))) // TTY ON
197 {
198 if(msg_code == MMI_TCH_VOCODER_CFG_REQ) // AND Current_message == VOCODER
199 {
200 // Dont do anything
201 return 0;
202 }
203 }
204 #endif
205
206 for (j=0;j<NUM_OF_DYN_DWNLD_PRIMITIVES;j++)
207 {
208 if (msg_code == signal_patch_array[j].primitive)
209 msg_code_id = signal_patch_array[j].msg_id;
210 }
211
212
213 // Compute the number of elements to be downloaded and their ids
214 for (j=0; j<MAX_NUM_OF_PATCH_IDS; j++)
215 {
216 patch_id_p[j]=0xFFFF; //omaps00090550 ;
217 if(primitives_to_patch_matrix[msg_code_id][j] == 1)
218 {
219 patch_id_p[counter++]=j;
220 }
221 }
222 return counter;
223 }
224
225 /*------------------------------------------------------------------------- */
226 /* l1_is_patch_already_installed */
227 /*------------------------------------------------------------------------- */
228 /* */
229 /* Parameters : patch id */
230 /* */
231 /* Return : TRUE patch is already installed, FALSE otherwise */
232 /* */
233 /* Description : Check if the selected patch id is already installed or not*/
234 /* */
235 /* */
236 /*------------------------------------------------------------------------- */
237
238 BOOL l1_is_patch_already_installed (UWORD16 patch_id)
239 {
240 UWORD16 i=0;
241 while(i<l1a.dyn_dwnld.num_patches_installed)
242 {
243 if(l1a.dyn_dwnld.patch_id[i]==patch_id)
244 break;
245 else
246 i++;
247 }
248 if(i<l1a.dyn_dwnld.num_patches_installed)
249 return TRUE;
250 else
251 return FALSE;
252 }
253
254 /*----------------------------------------------------------------------------- */
255 /* l1_is_patch_id_in_uninstall_set */
256 /*----------------------------------------------------------------------------- */
257 /* */
258 /* Parameters : patch id, uninstall address vector, num of uninstall elements */
259 /* */
260 /* Return : TRUE patch is in the set, FALSE otherwise */
261 /* */
262 /* Description : Check if the selected patch id is in the uninstall set or not */
263 /* */
264 /* */
265 /*----------------------------------------------------------------------------- */
266
267 BOOL l1_is_patch_id_in_uninstall_set (UWORD16 patch_id, UWORD16 *uninstall_patch_vect, UWORD16 num_of_uninstall_elem)
268 {
269 UWORD16 i;
270 for (i=0;i<num_of_uninstall_elem;i++)
271 {
272 if(patch_id==uninstall_patch_vect[i])
273 return TRUE;
274 }
275 return FALSE;
276 }
277
278 /*--------------------------------------------------------------------------------------------------------------------------------------- */
279 /* l1_manage_patch_incompatibilty */
280 /*--------------------------------------------------------------------------------------------------------------------------------------- */
281 /* */
282 /* Parameters : num of patch to download, num of uninstalled elements (pointer), uninstall vect */
283 /* Return : TRUE if there is some patch to uninstall, FALSE otherwise. By reference, num of patches to uninstall and their IDs */
284 /* */
285 /* Description : Check if some patch must be uninstalled: in case, retrieves the number of patch to uninstall and their IDs */
286 /* */
287 /*--------------------------------------------------------------------------------------------------------------------------------------- */
288
289 BOOL l1_manage_patch_incompatibilty(UWORD16 num_of_patch_id_to_dwnld, UWORD16 *num_of_uninstall_elem, UWORD16 *uninstall_patch_id_vect)
290 {
291 UWORD16 i,j;
292 UWORD16 patch_id;
293
294 // Reset values passed by reference
295 *num_of_uninstall_elem=0;
296 for(j=0;j<MAX_NUM_OF_PATCH_IDS;j++)
297 uninstall_patch_id_vect[j]=0xFFFF; //omaps00090550 ;
298
299 // First cycle: for all the patches that must be downloaded
300 for(i=0;i<num_of_patch_id_to_dwnld;i++)
301 {
302 patch_id=l1a.dyn_dwnld.next_patch_id[i];
303 // Check all incompatibilities
304 for(j=0;j<MAX_NUM_OF_PATCH_IDS;j++)
305 {
306 // If patch ID j is incompatible with selected patch id that must be downloaded
307 if(incompatibility_matrix[patch_id][j]==1)
308 {
309 // If patch j is already installed and not yet in the uninstall set
310 if((l1_is_patch_already_installed(j) == TRUE) && (l1_is_patch_id_in_uninstall_set(j,uninstall_patch_id_vect,(*num_of_uninstall_elem))==FALSE))
311 {
312 // Add patch j in the uninstall set and increase number of uninstall elements
313 uninstall_patch_id_vect[*num_of_uninstall_elem]=j;
314 (*num_of_uninstall_elem)++;
315 }
316 }
317 }
318 }
319 if(*num_of_uninstall_elem==0)
320 return TRUE;
321 else
322 return FALSE;
323 }
324
325 /*----------------------------------------------------------------- */
326 /* l1_set_semaphores_for_all_state_machines_involved */
327 /*----------------------------------------------------------------- */
328 /* */
329 /* Parameters : num of patches to download, */
330 /* Return : none */
331 /* */
332 /* Description : Set semaphores for the state machines impacted */
333 /* */
334 /* */
335 /*----------------------------------------------------------------- */
336
337 void l1_set_semaphores_for_all_state_machines_involved(UWORD16 num_of_patch_id_to_dwnld, UWORD16* next_patch_id)
338 {
339 UWORD16 i,j, patch_id;
340 for (i=0;i<num_of_patch_id_to_dwnld;i++)
341 {
342 patch_id = next_patch_id[i];
343 for(j=0;j<MAX_NUM_OF_SEMAPHORES;j++)
344 {
345 if(semaphore_matrix[patch_id][j]==1)
346 {
347 l1a.dyn_dwnld.semaphore_vect[j]=RED;
348 }
349 }
350 }
351 }
352
353 /*----------------------------------------------------------------- */
354 /* l1_update_semaphores_for_all_state_machines */
355 /*----------------------------------------------------------------- */
356 /* */
357 /* Parameters : num of patches to download, */
358 /* Return : none */
359 /* */
360 /* Description : Update semaphores for the state machines impacted */
361 /* (DELAY case) */
362 /* */
363 /*----------------------------------------------------------------- */
364
365 void l1_update_semaphores_for_all_state_machines(UWORD16 num_of_patch_id_to_dwnld)
366 {
367 /* In case of delay the patch which is DELAYED may have been be already installed*/
368 /* The semaphores that have been raised during the previous dynamic download */
369 /* for that patch must be updated */
370
371 UWORD16 i,j, patch_id;
372 for(j=0;j<MAX_NUM_OF_SEMAPHORES;j++)
373 l1a.dyn_dwnld.semaphore_vect[j] = GREEN;
374 for (i=0;i<num_of_patch_id_to_dwnld;i++)
375 {
376 patch_id = l1a.dyn_dwnld.next_patch_id[i];
377 for(j=0;j<MAX_NUM_OF_SEMAPHORES;j++)
378 {
379 if(semaphore_matrix[patch_id][j]==1)
380 {
381 l1a.dyn_dwnld.semaphore_vect[j]=RED;
382 }
383 }
384 }
385 }
386
387 /*-------------------------------------------------------*/
388 /* l1_reset_semaphores */
389 /*-------------------------------------------------------*/
390 /* */
391 /* Parameters : none */
392 /* Return : */
393 /* */
394 /* Description : Reset semaphores only for the state machines related to the currently downloaded patches */
395 /* In fact, because of delay, some semaphores can be set for patch that will be downloaded in the follwoing step */
396 /* */
397 /*-------------------------------------------------------*/
398 void l1_reset_semaphores()
399 {
400 UWORD16 i,j, patch_id;
401 for (i=0;i<l1a.dyn_dwnld.num_of_elem_to_copy;i++)
402 {
403 patch_id = l1a.dyn_dwnld.next_patch_id[i];
404 for(j=0;j<MAX_NUM_OF_SEMAPHORES;j++)
405 {
406 if(semaphore_matrix[patch_id][j]==1)
407 {
408 l1a.dyn_dwnld.semaphore_vect[j]=GREEN;
409 }
410 }
411 }
412 }
413
414
415 /*---------------------------------------------------------- */
416 /* l1_push_Primitive */
417 /*---------------------------------------------------------- */
418 /* */
419 /* Parameters : primitive ID */
420 /* Return : TRUE if push is successful, FALSE otherwise */
421 /* */
422 /* Description : Push primitive ID into DELAY FIFO */
423 /* */
424 /* */
425 /*---------------------------------------------------------- */
426
427 BOOL l1_push_Primitive(UWORD32 primitive_id)
428 {
429 UWORD32 num_elem = l1a.dyn_dwnld.waiting_patch_fifo.num_of_elem;
430 BOOL return_flag = TRUE;
431
432 if(num_elem >= MAX_NUM_OF_PATCH_IDS)
433 {
434 return_flag = FALSE;
435 }
436 else
437 {
438 l1a.dyn_dwnld.waiting_patch_fifo.signal_code_vect[num_elem++] = primitive_id;
439 l1a.dyn_dwnld.waiting_patch_fifo.num_of_elem = num_elem;
440 }
441 return return_flag;
442 }
443
444 /*---------------------------------------------------------- */
445 /* l1_pop_Primitive */
446 /*---------------------------------------------------------- */
447 /* */
448 /* Parameters : primitive ID (pointer) */
449 /* Return : TRUE if pop is successful, FALSE otherwise */
450 /* */
451 /* Description : Pop primitive from DELAY FIFO */
452 /* */
453 /* */
454 /*---------------------------------------------------------- */
455
456 BOOL l1_pop_Primitive(UWORD32 *p_primitive)
457 {
458 UWORD32 primitive_id;
459 UWORD8 ind;
460 UWORD32 num_elem = l1a.dyn_dwnld.waiting_patch_fifo.num_of_elem;
461 BOOL return_flag = TRUE;
462
463 if(num_elem <= 0)
464 {
465 return_flag = FALSE;
466 }
467 else
468 {
469 primitive_id = l1a.dyn_dwnld.waiting_patch_fifo.signal_code_vect[0];
470 for (ind = 0;ind<num_elem-1;ind++)
471 l1a.dyn_dwnld.waiting_patch_fifo.signal_code_vect[ind] = l1a.dyn_dwnld.waiting_patch_fifo.signal_code_vect[ind+1];
472 l1a.dyn_dwnld.waiting_patch_fifo.signal_code_vect[num_elem-1] = 0;
473 l1a.dyn_dwnld.waiting_patch_fifo.num_of_elem = num_elem-1;
474 *p_primitive = primitive_id;
475 }
476 return return_flag;
477 }
478 /*---------------------------------------------------------- */
479 /* l1_check_Fifo_Primitive */
480 /*---------------------------------------------------------- */
481 /* */
482 /* Parameters : none */
483 /* Return : Number of elements in the FIFO */
484 /* */
485 /* Description : Return number of elements in the FIFO */
486 /* */
487 /* */
488 /*---------------------------------------------------------- */
489
490 UWORD32 l1_check_Fifo_Primitive()
491 {
492 return l1a.dyn_dwnld.waiting_patch_fifo.num_of_elem;
493 }
494 #endif // L1_DYN_DSP_DWNLD == 1