FreeCalypso > hg > tcs211-l1-reconst
annotate chipsetsw/layer1/p_cfile/l1p_ctl.c @ 311:5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Tue, 03 Oct 2017 06:30:41 +0000 |
parents | cd2507a8ec57 |
children | 701fb3242432 |
rev | line source |
---|---|
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1 /************* Revision Controle System Header ************* |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
2 * GSM Layer 1 software |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
3 * L1P_CTL.C |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
4 * |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
5 * Filename l1p_ctl.c |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
6 * Copyright 2003 (C) Texas Instruments |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
7 * |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
8 ************* Revision Controle System Header *************/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
9 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
10 #include "l1_macro.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
11 #include "l1_confg.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
12 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
13 #if L1_GPRS |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
14 #if (CODE_VERSION == SIMULATION) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
15 #include <string.h> |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
16 #include "l1_types.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
17 #include "sys_types.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
18 #include "l1_const.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
19 #include "l1_time.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
20 #include "l1_signa.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
21 #if TESTMODE |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
22 #include "l1tm_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
23 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
24 #if (AUDIO_TASK == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
25 #include "l1audio_const.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
26 #include "l1audio_cust.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
27 #include "l1audio_signa.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
28 #include "l1audio_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
29 #include "l1audio_msgty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
30 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
31 #if (L1_GTT == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
32 #include "l1gtt_const.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
33 #include "l1gtt_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
34 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
35 #if (L1_MP3 == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
36 #include "l1mp3_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
37 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
38 #if (L1_MIDI == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
39 #include "l1midi_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
40 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
41 #include "l1_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
42 #include "cust_os.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
43 #include "l1_msgty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
44 #include "l1_varex.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
45 #include "l1_proto.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
46 #include "l1_mftab.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
47 #include "l1_tabs.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
48 #include "l1_ver.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
49 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
50 #include "l1_ctl.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
51 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
52 #include "l1p_cons.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
53 #include "l1p_msgt.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
54 #include "l1p_deft.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
55 #include "l1p_vare.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
56 #include "l1p_sign.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
57 #if (OP_L1_STANDALONE == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
58 #ifdef _INLINE |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
59 #define INLINE static inline // Inline functions when -v option is set |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
60 #else // when the compiler is ivoked. |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
61 #define INLINE |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
62 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
63 #endif //0maps00090550 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
64 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
65 #include <string.h> |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
66 #include "l1_types.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
67 #include "sys_types.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
68 #include "l1_const.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
69 #include "l1_time.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
70 #include "l1_signa.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
71 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
72 #if (RF_FAM == 61) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
73 #include "tpudrv61.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
74 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
75 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
76 #if TESTMODE |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
77 #include "l1tm_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
78 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
79 #if (AUDIO_TASK == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
80 #include "l1audio_const.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
81 #include "l1audio_cust.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
82 #include "l1audio_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
83 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
84 #if (L1_GTT == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
85 #include "l1gtt_const.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
86 #include "l1gtt_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
87 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
88 #if (L1_MP3 == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
89 #include "l1mp3_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
90 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
91 #if (L1_MIDI == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
92 #include "l1midi_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
93 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
94 #include "l1_defty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
95 #include "cust_os.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
96 #include "l1_msgty.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
97 #include "l1_varex.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
98 #include "l1_proto.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
99 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
100 #include "l1_ctl.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
101 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
102 #include "l1p_cons.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
103 #include "l1p_msgt.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
104 #include "l1p_deft.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
105 #include "l1p_vare.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
106 #include "l1p_sign.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
107 #if (OP_L1_STANDALONE == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
108 #ifdef _INLINE |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
109 #define INLINE static inline // Inline functions when -v option is set |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
110 #else // when the compiler is ivoked. |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
111 #define INLINE |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
112 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
113 #endif //omaps00090550 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
114 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
115 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
116 #if(RF_FAM == 61) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
117 #include "l1_rf61.h" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
118 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
119 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
120 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
121 // Macro definition |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
122 //----------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
123 #define min(value1,value2) \ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
124 value1 < value2 ? value1 : value2 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
125 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
126 // External prototypes |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
127 //-------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
128 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
129 WORD8 l1ctl_encode_delta1(UWORD16 radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
130 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
131 /*********************************************************/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
132 /* GPRS AGC Algorithms */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
133 /*********************************************************/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
134 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
135 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
136 /* l1pctl_pagc_ctrl() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
137 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
138 /* Description: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
139 /* =========== */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
140 /* Based on the same principle as the one used for PAGC */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
141 /* algorithm except that we also feed the beacon FIFO */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
142 /* with IL measured on other carriers (Pb parameter is */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
143 /* applied) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
144 /* This function is used in the control phase of PCCCH, */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
145 /* serving PBCCH and PTCCH reading tasks to determine */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
146 /* which AGC and lna_off must apply */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
147 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
148 /* WARNING: in the layer 1 code, input levels IL(l1) use */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
149 /* format 7.1: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
150 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
151 /* * IL(l1) = - 2 x IL * */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
152 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
153 /* -> Reversed sign, reversed test conditions */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
154 /* -> max replaced by min */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
155 /* ex: if IL -120 dBm, IL(l1) = 240 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
156 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
157 void l1pctl_pagc_ctrl(WORD8 *agc, UWORD8 *lna_off, UWORD16 radio_freq, UWORD8 serving_cell) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
158 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
159 UWORD8 pb; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
160 WORD16 input_level, new_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
161 WORD32 freq_index; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
162 UWORD16 beacon_frequency; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
163 UWORD8 *lna_off_ptr; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
164 UWORD8 curve_id; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
165 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
166 // We memorize the LNA state used for other serving frequencies that can be used |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
167 // in Packet idle mode |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
168 static UWORD8 lna_off_others = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
169 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
170 if (serving_cell == TRUE) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
171 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
172 beacon_frequency = l1a_l1s_com.Scell_info.radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
173 pb = l1a_l1s_com.Scell_info.pb; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
174 lna_off_ptr = &lna_off_others; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
175 curve_id = MAX_ID; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
176 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
177 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
178 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
179 beacon_frequency = l1pa_l1ps_com.pbcchn.bcch_carrier; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
180 pb = l1pa_l1ps_com.pbcchn.pb; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
181 lna_off_ptr = lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
182 curve_id = AV_ID; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
183 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
184 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
185 #if(L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
186 freq_index = beacon_frequency - l1_config.std.radio_freq_index_offset; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
187 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
188 freq_index = l1_multiband_radio_freq_convert_into_operative_radio_freq(beacon_frequency); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
189 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
190 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
191 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
192 // If the downlink channel is decoded on the beacon frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
193 if (radio_freq == beacon_frequency) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
194 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
195 // Downlink task on the serving beacon: process AGC according to the "beacon IL" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
196 input_level = l1a_l1s_com.last_input_level[freq_index].input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
197 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
198 // lna_off already processed in the read phase |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
199 *lna_off = l1a_l1s_com.last_input_level[freq_index].lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
200 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
201 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
202 // If the downlink channel is decoded on a frequency other than the beacon |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
203 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
204 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
205 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
206 // Process AGC according to "beacon IL + Pb" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
207 input_level = (WORD16) (l1a_l1s_com.last_input_level[freq_index].input_level + pb); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
208 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
209 // IL_2_AGC_xx array size |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
210 if (input_level>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
211 input_level = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
212 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
213 // lna_off must be processed in the control phase because input_level |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
214 // depends on last_input_level and Pb, and last_input_level or pb can have changed |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
215 // at any time |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
216 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
217 // New calibrated IL to reach on radio freq other than beacon |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
218 new_calibrated_IL = (WORD16) (input_level - l1ctl_encode_delta1(radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
219 - l1ctl_encode_delta2(radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
220 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
221 // IL_2_AGC_xx array size |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
222 if (new_calibrated_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
223 new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
224 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
225 // lna_off computing... |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
226 l1ctl_encode_lna((UWORD8)(new_calibrated_IL>>1), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
227 lna_off_ptr, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
228 radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
229 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
230 *lna_off = *lna_off_ptr; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
231 } // End if "radio_freq != beacon_frequency" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
232 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
233 // Process AGC to apply |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
234 *agc = Cust_get_agc_from_IL(radio_freq, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
235 input_level >> 1, |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
236 curve_id); |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
237 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
238 // Store lna_off and input_level field used for current CTRL in order to be able |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
239 // to build IL from pm in READ phase. |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
240 l1a_l1s_com.Scell_used_IL.input_level = (UWORD8)input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
241 l1a_l1s_com.Scell_used_IL.lna_off = *lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
242 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
243 } // End of "l1pctl_pagc_ctrl" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
244 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
245 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
246 /* l1pctl_pagc_read() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
247 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
248 /* Description : */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
249 /* =========== */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
250 /* Based on the same principle as the one used for PAGC */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
251 /* algorithm except that we also feed the beacon FIFO */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
252 /* with IL measured on other carriers (Pb parameter is */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
253 /* applied) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
254 /* This function is used in the read phase of PCCCH and */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
255 /* serving PBCCH reading tasks to determine the IL value */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
256 /* store it in the FIFO and find the next IL to use */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
257 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
258 /* WARNING: in the layer 1 code, input levels IL(l1) use */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
259 /* format 7.1: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
260 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
261 /* * IL(l1) = - 2 x IL * */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
262 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
263 /* -> Reversed sign, reversed test conditions */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
264 /* -> max replaced by min */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
265 /* ex: if IL -120 dBm, IL(l1) = 240 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
266 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
267 UWORD8 l1pctl_pagc_read(UWORD8 pm, UWORD16 radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
268 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
269 UWORD8 i, new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
270 WORD8 delta1_freq, delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
271 WORD16 delta_drp_gain=0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
272 UWORD16 lna_value; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
273 WORD16 used_agc, current_IL, new_calibrated_IL, current_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
274 WORD32 serving_index; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
275 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
276 UWORD16 arfcn; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
277 #endif |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
278 UWORD8 lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
279 UWORD16 dco_algo_ctl_pw_temp = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
280 UWORD8 if_ctl = 0; |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
281 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
282 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GPRS; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
283 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
284 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
285 #if (L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
286 serving_index = l1a_l1s_com.Scell_info.radio_freq - l1_config.std.radio_freq_index_offset; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
287 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
288 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
289 serving_index = l1_multiband_radio_freq_convert_into_operative_radio_freq(l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
290 #endif /*if (L1_FF_MULTIBAND == 0)*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
291 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
292 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
293 // Calibration factors |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
294 delta1_freq = l1ctl_encode_delta1(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
295 delta2_freq = l1ctl_encode_delta2(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
296 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
297 // AGC used in the control phase (format F7.1) |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
298 used_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1; |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
299 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
300 // LNA attenuation |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
301 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
302 |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
303 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
304 // DRP correction |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
305 #if (L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
306 arfcn = Convert_l1_radio_freq(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
307 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
308 arfcn=radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
309 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
310 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
311 #if (CODE_VERSION != SIMULATION) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
312 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
313 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID , |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
314 l1a_l1s_com.Scell_used_IL_dd.input_level, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
315 radio_freq,if_threshold); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
316 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
317 delta_drp_gain = drp_gain_correction(arfcn, lna_off, used_agc); // F7.1 format |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
318 if(if_ctl == IF_100KHZ_DSP){ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
319 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
320 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
321 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
322 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
323 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
324 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
325 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
326 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
327 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
328 // current_IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
329 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
330 if (0==pm) // Check and filter illegal pm value by using last valid IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
331 { |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
332 current_IL = l1a_l1s_com.last_input_level[serving_index].input_level - lna_value; |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
333 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
334 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
335 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
336 current_IL = -(pm - (used_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
337 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
338 // IL normalization to beacon (ILnorm = IL - Pb) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
339 if (radio_freq != l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
340 current_IL -= l1a_l1s_com.Scell_info.pb; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
341 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
342 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
343 // Calibrated IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
344 // NOTE: calibrated_IL is normalized to beacon. This is needed for the |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
345 // pccch_lev processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
346 current_calibrated_IL = (WORD16) (current_IL - delta1_freq - delta2_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
347 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
348 // Protect IL stores against overflow |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
349 if (current_calibrated_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
350 current_calibrated_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
351 if (current_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
352 current_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
353 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
354 // FIFO management |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
355 for (i=3;i>0;i--) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
356 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-1]; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
357 l1a_l1s_com.Scell_info.buff_beacon[0] = (UWORD8)current_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
358 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
359 // Find min IL in FIFO |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
360 new_IL = l1ctl_find_max(l1a_l1s_com.Scell_info.buff_beacon, 4); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
361 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
362 // Input levels are always stored with lna_on |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
363 new_calibrated_IL = (WORD16) (new_IL - delta1_freq - delta2_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
364 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
365 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
366 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
367 l1ctl_encode_lna( (UWORD8)(new_calibrated_IL>>1), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
368 &(l1a_l1s_com.last_input_level[serving_index].lna_off), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
369 radio_freq ); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
370 |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
371 l1a_l1s_com.last_input_level[serving_index].input_level = new_IL + |
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
372 l1a_l1s_com.last_input_level[serving_index].lna_off * l1ctl_get_lna_att(radio_freq); |
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
373 |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
374 return((UWORD8)current_calibrated_IL); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
375 } // End of "l1pctl_pagc_read" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
376 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
377 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
378 /* l1pctl_transfer_agc_init() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
379 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
380 /* Description : */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
381 /* =========== */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
382 /* Packet transfer AGC algorithm initialization */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
383 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
384 void l1pctl_transfer_agc_init() |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
385 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
386 WORD16 calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
387 UWORD16 radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
388 WORD32 serving_index; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
389 WORD16 input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
390 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
391 #if (L1_FF_MULTIBAND ==0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
392 serving_index = l1a_l1s_com.Scell_info.radio_freq - l1_config.std.radio_freq_index_offset; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
393 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
394 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
395 serving_index = l1_multiband_radio_freq_convert_into_operative_radio_freq(l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
396 #endif /*if L1_FF_MULTIBAND*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
397 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
398 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
399 // Daughter frequencies input level initialization |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
400 //------------------------------------------------ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
401 if (l1pa_l1ps_com.transfer.aset->dl_pwr_ctl.p0 == 255) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
402 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
403 // No power control mode AGC algorithm |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
404 input_level = (WORD16) (l1a_l1s_com.last_input_level[serving_index].input_level + l1a_l1s_com.Scell_info.pb); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
405 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
406 // Set fn_select to current_fn |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
407 l1ps.fn_select = l1s.actual_time.fn; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
408 // Initialize algorithm in "SEARCH" phase |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
409 l1ps.phase = SEARCH; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
410 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
411 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
412 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
413 // Downlink power control AGC algorithms |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
414 if (l1pa_l1ps_com.transfer.aset->dl_pwr_ctl.bts_pwr_ctl_mode == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
415 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
416 // BTS Power control mode A |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
417 input_level = (WORD16) (l1a_l1s_com.last_input_level[serving_index].input_level + |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
418 l1pa_l1ps_com.transfer.aset->dl_pwr_ctl.p0 + 10); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
419 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
420 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
421 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
422 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
423 // BTS power control mode B |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
424 input_level = (WORD16) (l1a_l1s_com.last_input_level[serving_index].input_level + |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
425 l1pa_l1ps_com.transfer.aset->dl_pwr_ctl.p0); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
426 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
427 // Initialization: PR = P0 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
428 l1ps.last_PR_good = l1pa_l1ps_com.transfer.aset->dl_pwr_ctl.p0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
429 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
430 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
431 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
432 if (input_level>INDEX_MAX) input_level = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
433 l1a_l1s_com.Scell_info.transfer_meas.input_level = (UWORD8)input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
434 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
435 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
436 // Daughter frequencies lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
437 //---------------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
438 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
439 // We need to know on which frequency band we work |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
440 if (!l1pa_l1ps_com.transfer.aset->freq_param.chan_sel.h) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
441 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
442 // Single frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
443 radio_freq = l1pa_l1ps_com.transfer.aset->freq_param.chan_sel.rf_channel.single_rf.radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
444 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
445 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
446 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
447 // Frequency hopping: all frequencies of the frequency list are on the same band |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
448 // We take the first frequency of the list |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
449 radio_freq = l1pa_l1ps_com.transfer.aset->freq_param.freq_list.rf_chan_no.A[0]; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
450 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
451 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
452 calibrated_IL = (WORD16) (l1a_l1s_com.Scell_info.transfer_meas.input_level |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
453 - l1ctl_encode_delta1(radio_freq) - l1ctl_encode_delta2(radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
454 - l1a_l1s_com.last_input_level[serving_index].lna_off * l1ctl_get_lna_att(radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
455 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
456 if (calibrated_IL>INDEX_MAX) calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
457 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
458 l1ctl_encode_lna((UWORD8)(calibrated_IL>>1), &(l1a_l1s_com.Scell_info.transfer_meas.lna_off), radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
459 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
460 } // End of "l1pctl_transfer_agc_init" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
461 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
462 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
463 /* l1pctl_transfer_agc_ctrl() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
464 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
465 /* Description : */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
466 /* =========== */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
467 /* This function is used in the control phase of PDTCH/D */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
468 /* to determine which AGC and lna_off must apply */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
469 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
470 void l1pctl_transfer_agc_ctrl(WORD8 *agc, UWORD8 *lna_off, UWORD16 radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
471 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
472 T_INPUT_LEVEL *selected_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
473 #if(L1_FF_MULTIBAND == 1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
474 UWORD16 operative_radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
475 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
476 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
477 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
478 // input_level selection |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
479 if (radio_freq == l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
480 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
481 // Beacon frequency input_level used for AGC processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
482 #if(L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
483 selected_IL = &l1a_l1s_com.last_input_level[l1a_l1s_com.Scell_info.radio_freq |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
484 - l1_config.std.radio_freq_index_offset]; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
485 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
486 #else // L1_FF_MULTIBAND = 1 below |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
487 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
488 operative_radio_freq = |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
489 l1_multiband_radio_freq_convert_into_operative_radio_freq(l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
490 selected_IL = &(l1a_l1s_com.last_input_level[operative_radio_freq]); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
491 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
492 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
493 #endif // #if(L1_FF_MULTIBAND == 0) else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
494 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
495 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
496 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
497 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
498 // Daughter frequency input_level used for AGC processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
499 selected_IL = &l1a_l1s_com.Scell_info.transfer_meas; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
500 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
501 *lna_off = selected_IL->lna_off; |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
502 *agc = Cust_get_agc_from_IL(radio_freq,selected_IL->input_level >> 1, MAX_ID); |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
503 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
504 // Store lna_off and input_level field used for current CTRL in order to be able |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
505 // to build IL from pm in READ phase. |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
506 l1a_l1s_com.Scell_used_IL.input_level = selected_IL->input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
507 l1a_l1s_com.Scell_used_IL.lna_off = *lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
508 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
509 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
510 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
511 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
512 /* l1pctl_npc_agc_read() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
513 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
514 /* Description : */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
515 /* =========== */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
516 /* AGC algorithm in packet transfer used when */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
517 /* NO POWER CONTROL is done by the BTS. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
518 /* This function is used during the read phase of PDTCH: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
519 /* 1- to determine the IL value for each timeslot in each*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
520 /* TDMA */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
521 /* 2- to find the IL value to use for the next PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
522 /* block */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
523 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
524 /* Algorithm */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
525 /* --------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
526 /* For each timeslot i used for PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
527 /* IL(i) = fct(used AGC, pm) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
528 /* if (beacon) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
529 /* ILmax_beacon = max(ILmax_beacon, IL(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
530 /* else */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
531 /* ILmax_others(i) = max(IL(i), ILmax_others(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
532 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
533 /* If (burst_nb == 3) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
534 /* If (ILmax_beacon was found during the block) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
535 /* FIFO[beacon] updated with ILmax_beacon */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
536 /* transfer_meas = max(FIFO[beacon]) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
537 /* Reset ILmax_beacon */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
538 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
539 /* For each timeslot i used for PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
540 /* if (CRC good) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
541 /* ILmax_correct = max(ILmax_correct, */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
542 /* ILmax_others(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
543 /* else */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
544 /* ILmax_not_correct = max(ILmax_not_correct, */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
545 /* ILmax_others(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
546 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
547 /* If (no ILmax_correct was found) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
548 /* ILselected = ILmax_correct */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
549 /* FNselected = current FN */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
550 /* else */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
551 /* DeltaFN = (current FN - FNselected) % MAX_FN */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
552 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
553 /* if (DeltaFN < 78) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
554 /* ILweighted = ILselected * (1 - DeltaFN/78) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
555 /* - 120 * DeltaFN /78 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
556 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
557 /* if (ILweighted < -120) ILweighted = -120 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
558 /* if (ILmax_not_correct > ILweighted) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
559 /* ILselected = ILmax_not_correct */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
560 /* FNselected = current FN */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
561 /* else */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
562 /* ILselected = -120 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
563 /* FNselected = current FN */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
564 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
565 /* Reset ILmax_others[8] */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
566 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
567 /* WARNING: in the layer 1 code, input levels IL(l1) use */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
568 /* format 7.1: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
569 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
570 /* * IL(l1) = - 2 x IL * */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
571 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
572 /* -> Reversed sign, reversed test conditions */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
573 /* -> max replaced by min */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
574 /* ex: if IL -120 dBm, IL(l1) = 240 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
575 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
576 /* Parameters */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
577 /* ---------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
578 /* "calibrated_IL[8]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
579 /* contains the IL found on timeslots */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
580 /* used for PDCH/D. These ILs can be used to process */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
581 /* RXLEV values. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
582 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
583 /* "*pdsp_db_r_ptr" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
584 /* Pointer on the DSP DB Read page, used to extract */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
585 /* pm values, burst number and timeslot allocated */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
586 /* for downlink PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
587 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
588 /* "*pdsp_ndb_ptr" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
589 /* Pointer on the DSP NDB page, used to extract the */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
590 /* CRC value for each decoded burst */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
591 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
592 /* Global parameters */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
593 /* ----------------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
594 /* "l1a_l1s_com.Scell_info.transfer_meas.input_level" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
595 /* "l1a_l1s_com.Scell_info.transfer_meas.lna_off" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
596 /* Used to store the ILselected and the associated */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
597 /* lna_off value. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
598 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
599 /* "l1a_l1s_com.Scell_info.fn_select" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
600 /* Used to store the FNselected value. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
601 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
602 /* "l1a_l1s_com.last_input_level[freq index] */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
603 /* .input_level */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
604 /* .lna_off" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
605 /* Used to store the beacon input level and */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
606 /* the associated lna_off value. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
607 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
608 /* "l1ps.transfer_beacon_buf[4]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
609 /* FIFO[beacon] */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
610 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
611 /* "l1ps.ILmin_beacon" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
612 /* "l1ps.ILmin_others[8]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
613 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
614 void l1pctl_npc_agc_read(UWORD8 calibrated_IL[8], T_DB_DSP_TO_MCU_GPRS *pdsp_db_r_ptr, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
615 T_NDB_MCU_DSP_GPRS *pdsp_ndb_ptr) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
616 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
617 UWORD8 ts; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
618 UWORD8 rx_no = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
619 UWORD8 bit_mask = 0x80; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
620 UWORD8 ILmin_correct = 255; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
621 UWORD8 ILmin_not_correct = 255; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
622 WORD8 delta1_freq, delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
623 WORD16 delta_drp_gain=0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
624 UWORD16 radio_freq, lna_value; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
625 WORD16 used_agc; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
626 WORD32 serving_index; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
627 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
628 UWORD16 arfcn; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
629 #endif |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
630 UWORD8 lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
631 UWORD16 dco_algo_ctl_pw_temp = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
632 UWORD8 if_ctl = 0; |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
633 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
634 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GPRS; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
635 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
636 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
637 #if(L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
638 serving_index = l1a_l1s_com.Scell_info.radio_freq - l1_config.std.radio_freq_index_offset; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
639 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
640 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
641 serving_index = l1_multiband_radio_freq_convert_into_operative_radio_freq(l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
642 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
643 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
644 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
645 // Control phase parameters: same AGC, radio_freq, lna_off used for all PDTCH |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
646 // *************************************************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
647 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
648 // Get radio_freq on which the downlink block was received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
649 radio_freq = l1a_l1s_com.dedic_set.radio_freq_dd; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
650 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
651 // Compute calibration factors |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
652 delta1_freq = l1ctl_encode_delta1(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
653 delta2_freq = l1ctl_encode_delta2(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
654 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
655 // AGC used in the control phase (format F7.1) |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
656 used_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1; |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
657 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
658 // LNA attenuation |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
659 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
660 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
661 // Burst 0: Reset ILmin_beacon and ILmin_others |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
662 if(pdsp_db_r_ptr->d_burst_nb_gprs == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
663 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
664 l1ps.ILmin_beacon = 255; // Not valid |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
665 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
666 for (ts = 0; ts < 8; ts++) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
667 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
668 l1ps.ILmin_others[ts] = (UWORD8) l1_config.params.il_min; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
669 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
670 } // End if "burst 0" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
671 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
672 // IL processing for each received burst |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
673 // ************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
674 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
675 // For each timeslot on which a burst was received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
676 for(ts = 0; ts < 8; ts ++) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
677 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
678 if(pdsp_db_r_ptr->d_task_d_gprs & bit_mask) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
679 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
680 WORD16 current_IL, current_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
681 UWORD8 pm; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
682 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
683 // IL = fct(pm, last_known_agc, lna_value, g_magic) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
684 //------------------------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
685 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
686 pm = (UWORD8) ((pdsp_db_r_ptr->a_burst_pm_gprs[ts] & 0xffff) >> 5); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
687 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
688 // current_IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
689 if (0==pm) // Check and filter illegal pm value by using last valid IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
690 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
691 if (radio_freq == l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
692 current_IL = l1a_l1s_com.last_input_level[serving_index].input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
693 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
694 current_IL = l1a_l1s_com.Scell_info.transfer_meas.input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
695 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
696 else |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
697 { |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
698 |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
699 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
700 // DRP correction |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
701 #if (L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
702 arfcn = Convert_l1_radio_freq(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
703 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
704 arfcn=radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
705 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
706 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
707 #if (CODE_VERSION != SIMULATION) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
708 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
709 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID , |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
710 l1a_l1s_com.Scell_used_IL_dd.input_level, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
711 radio_freq,if_threshold); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
712 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
713 delta_drp_gain = drp_gain_correction(arfcn, lna_off, used_agc); // F7.1 format |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
714 if(if_ctl == IF_100KHZ_DSP){ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
715 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
716 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
717 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
718 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
719 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
720 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
721 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
722 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
723 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
724 current_IL = -(pm - (used_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq)); |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
725 } |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
726 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
727 // Calibrated IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
728 current_calibrated_IL = current_IL - delta1_freq - delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
729 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
730 // Protect IL stores against overflow |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
731 if(current_calibrated_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
732 current_calibrated_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
733 if (current_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
734 current_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
735 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
736 calibrated_IL[ts] = (UWORD8)(current_calibrated_IL); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
737 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
738 // Keep ILmax |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
739 if (radio_freq == l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
740 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
741 // Beacon frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
742 l1ps.ILmin_beacon = min((UWORD8) current_IL, l1ps.ILmin_beacon); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
743 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
744 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
745 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
746 // Daughter frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
747 l1ps.ILmin_others[ts] = min((UWORD8) current_IL,l1ps.ILmin_others[ts]); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
748 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
749 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
750 // Input Level selection among ILmax found on each timeslot during the block (when burst = 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
751 // ******************************************************************************************* |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
752 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
753 if(pdsp_db_r_ptr->d_burst_nb_gprs == 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
754 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
755 // If CRC good |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
756 if (!(pdsp_ndb_ptr->a_dd_gprs[rx_no][0] & 0x0100)) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
757 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
758 // Find the min found IL for blocks that were correctly received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
759 ILmin_correct = min(l1ps.ILmin_others[ts],ILmin_correct); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
760 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
761 // If CRC bad |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
762 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
763 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
764 // Find the min found IL for blocks that were not correctly received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
765 ILmin_not_correct = min(l1ps.ILmin_others[ts],ILmin_not_correct); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
766 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
767 } // End if "burst = 3" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
768 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
769 // Next downlink block |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
770 rx_no ++; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
771 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
772 } // End if "timeslot used for downlink PDCH" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
773 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
774 // Next timeslot |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
775 bit_mask >>= 1; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
776 } // End for "each timeslot...." |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
777 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
778 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
779 // IL selection for the next block if burst = 3 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
780 // ********************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
781 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
782 if(pdsp_db_r_ptr->d_burst_nb_gprs == 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
783 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
784 WORD16 new_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
785 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
786 // Beacon frequency input level updating |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
787 //-------------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
788 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
789 // If a PDCH has been received on the beacon |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
790 if (l1ps.ILmin_beacon != 255) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
791 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
792 UWORD8 i, new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
793 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
794 // FIFO management |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
795 for (i=3;i>0;i--) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
796 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-1]; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
797 l1a_l1s_com.Scell_info.buff_beacon[0] = l1ps.ILmin_beacon; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
798 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
799 // Find min IL in FIFO |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
800 new_IL = l1ctl_find_max(l1a_l1s_com.Scell_info.buff_beacon, 4); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
801 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
802 // Input levels are always stored with lna_on |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
803 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
804 // lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
805 new_calibrated_IL = (WORD16) (new_IL - l1ctl_encode_delta1(l1a_l1s_com.Scell_info.radio_freq) - l1ctl_encode_delta2(l1a_l1s_com.Scell_info.radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
806 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
807 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
808 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
809 l1ctl_encode_lna((UWORD8)(new_calibrated_IL>>1), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
810 &(l1a_l1s_com.last_input_level[serving_index].lna_off), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
811 l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
812 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
813 l1a_l1s_com.last_input_level[serving_index].input_level = new_IL ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
814 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
815 } // End of "beacon frequency input level updating" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
816 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
817 // Daughter frequencies input level updating |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
818 //------------------------------------------ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
819 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
820 // If at least one block was correctly received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
821 // (Note: ILs truncated to 240 so 255 isn't valid) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
822 if (ILmin_correct != 255) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
823 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
824 // Select the min input level found on correctly received blocks |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
825 l1a_l1s_com.Scell_info.transfer_meas.input_level = ILmin_correct; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
826 l1ps.fn_select = l1s.actual_time.fn; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
827 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
828 // Algorithm switch to "TRACK" phase if it was in "SEARCH" phase |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
829 l1ps.phase = TRACK; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
830 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
831 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
832 // No block was correctly received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
833 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
834 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
835 UWORD8 input_level_ref = l1a_l1s_com.Scell_info.transfer_meas.input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
836 // SEARCH phase |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
837 if (l1ps.phase == SEARCH) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
838 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
839 // If measured level superior to currently tracket level, switch to TRACK mode |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
840 if (input_level_ref > ILmin_not_correct) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
841 l1ps.phase = TRACK; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
842 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
843 // Select the min input level found on badly received blocks |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
844 l1a_l1s_com.Scell_info.transfer_meas.input_level = ILmin_not_correct; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
845 l1ps.fn_select = l1s.actual_time.fn; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
846 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
847 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
848 // TRACK phase |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
849 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
850 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
851 // If the IL found on incorrect block is lower than current wanted IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
852 if (ILmin_not_correct < input_level_ref) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
853 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
854 // Select the new IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
855 l1a_l1s_com.Scell_info.transfer_meas.input_level = ILmin_not_correct; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
856 l1ps.fn_select = l1s.actual_time.fn; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
857 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
858 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
859 // If the IL found on incorrect block is higher than current wanted IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
860 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
861 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
862 UWORD32 delta_fn; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
863 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
864 // delta_fn processing for IL selection forgetting factor |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
865 delta_fn = l1s.actual_time.fn - l1ps.fn_select; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
866 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
867 // MAX_FN modulo management |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
868 if (l1s.actual_time.fn < l1ps.fn_select) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
869 delta_fn += MAX_FN; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
870 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
871 // If the last selected IL is more recent than 72 frames |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
872 // |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
873 // |....|R...............................C|....| |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
874 // ^ ^ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
875 // fn_selected IL reset to -120 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
876 // <--------------------------------------> |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
877 // 312 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
878 // 306 = 312 - 4 (block_size) - 1 (Read phase fn delay) - 1 (Control phase fn advance) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
879 if (delta_fn > 306) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
880 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
881 WORD16 input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
882 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
883 // IL initialized to "beacon level - Pb" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
884 input_level = (WORD16) (l1a_l1s_com.last_input_level[serving_index].input_level + l1a_l1s_com.Scell_info.pb); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
885 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
886 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
887 if (input_level>INDEX_MAX) input_level = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
888 l1a_l1s_com.Scell_info.transfer_meas.input_level = (UWORD8)input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
889 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
890 l1ps.fn_select = l1s.actual_time.fn; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
891 // Returns to "SEARCH" phase |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
892 l1ps.phase = SEARCH; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
893 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
894 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
895 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
896 WORD16 input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
897 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
898 input_level = l1a_l1s_com.Scell_info.transfer_meas.input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
899 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
900 if (input_level>INDEX_MAX) input_level = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
901 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
902 l1a_l1s_com.Scell_info.transfer_meas.input_level = (UWORD8)input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
903 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
904 } // End if the IL found on incorrect block is higher than current wanted IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
905 } // End of "track phase" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
906 } // End if no block correctly received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
907 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
908 // lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
909 new_calibrated_IL = (WORD16) (l1a_l1s_com.Scell_info.transfer_meas.input_level - l1ctl_encode_delta1(l1ps.read_param.radio_freq_for_lna)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
910 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
911 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
912 l1ctl_encode_lna((UWORD8)(new_calibrated_IL>>1), &(l1a_l1s_com.Scell_info.transfer_meas.lna_off), l1ps.read_param.radio_freq_for_lna); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
913 } // End if "burst = 3" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
914 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
915 } // End of "l1pctl_npc_agc_read" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
916 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
917 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
918 /* l1pctl_dpcma_agc_read() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
919 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
920 /* Description : */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
921 /* =========== */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
922 /* AGC algorithm in packet transfer used when the BTS */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
923 /* use DOWNLINK POWER CONTROL mode A. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
924 /* This function is used during the read phase of PDTCH: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
925 /* 1- to determine the IL value for each timeslot in each*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
926 /* TDMA */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
927 /* 2- to find the IL value to use for the next PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
928 /* block */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
929 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
930 /* Algorithm */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
931 /* --------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
932 /* For each timeslot i used for PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
933 /* IL(i) = fct(used AGC, pm) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
934 /* if (beacon) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
935 /* ILmax_beacon = max(ILmax_beacon, IL(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
936 /* else */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
937 /* ILmax_others(i) = max(IL(i), ILmax_others(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
938 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
939 /* If (burst_nb == 3) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
940 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
941 /* For each timeslot i used for PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
942 /* if (CRC good) and */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
943 /* ((PR_MODE A) or (PR_MODE B and TFI good)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
944 /* ILmax = max(ILmax, ILmax_others(i) + P0 + PR(i))*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
945 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
946 /* ILmax=max(ILmax, ILmax_beacon) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
947 /* FIFO[beacon] updated with ILmax */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
948 /* last_input_level[serving beacon] = max(FIFO[beacon])*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
949 /* transfer_meas = max(FIFO[beacon]) - P0 - 5 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
950 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
951 /* Reset ILmax_others[8] and ILmax_beacon */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
952 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
953 /* WARNING: in the layer 1 code, input levels IL(l1) use */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
954 /* format 7.1: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
955 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
956 /* * IL(l1) = - 2 x IL * */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
957 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
958 /* -> Reversed sign, reversed test conditions */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
959 /* -> max replaced by min */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
960 /* ex: if IL -120 dBm, IL(l1) = 240 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
961 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
962 /* Parameters */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
963 /* ---------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
964 /* "calibrated_IL[8]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
965 /* contains the IL found on timeslots */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
966 /* used for PDCH/D. These ILs can be used to process */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
967 /* RXLEV values. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
968 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
969 /* "*pdsp_db_r_ptr" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
970 /* Pointer on the DSP DB Read page, used to extract */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
971 /* pm values, burst number and timeslot allocated */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
972 /* for downlink PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
973 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
974 /* "*pdsp_ndb_ptr" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
975 /* Pointer on the DSP NDB page, used to extract the */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
976 /* CRC value for each decoded burst */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
977 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
978 /* Global parameters */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
979 /* ----------------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
980 /* "l1a_l1s_com.Scell_info.transfer_meas.input_level" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
981 /* "l1a_l1s_com.Scell_info.transfer_meas.lna_off" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
982 /* Used to store the ILselected and the associated */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
983 /* lna_off value. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
984 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
985 /* "l1a_l1s_com.last_input_level[freq. index] */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
986 /* .input_level */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
987 /* .lna_off" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
988 /* Used to store the beacon input level and */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
989 /* the associated lna_off value. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
990 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
991 /* "l1ps.transfer_beacon_buf[4]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
992 /* FIFO[beacon] */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
993 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
994 /* "l1ps.ILmin_beacon" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
995 /* "l1ps.ILmin_others[8]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
996 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
997 void l1pctl_dpcma_agc_read(UWORD8 calibrated_IL[8], T_DB_DSP_TO_MCU_GPRS *pdsp_db_r_ptr, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
998 T_NDB_MCU_DSP_GPRS *pdsp_ndb_ptr, UWORD8 pr_table[8]) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
999 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1000 UWORD8 ts = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1001 UWORD8 rx_no = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1002 UWORD8 bit_mask = 0x80; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1003 UWORD8 IL_norm_min = 255; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1004 WORD8 delta1_freq, delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1005 WORD16 delta_drp_gain=0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1006 UWORD16 radio_freq, lna_value; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1007 WORD16 used_agc; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1008 WORD32 serving_index; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1009 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1010 UWORD16 arfcn; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1011 #endif |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1012 UWORD8 lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1013 UWORD16 dco_algo_ctl_pw_temp = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1014 UWORD8 if_ctl = 0; |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
1015 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1016 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GPRS; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1017 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1018 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1019 #if(L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1020 serving_index = l1a_l1s_com.Scell_info.radio_freq - l1_config.std.radio_freq_index_offset; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1021 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1022 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1023 serving_index = l1_multiband_radio_freq_convert_into_operative_radio_freq(l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1024 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1025 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1026 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1027 // Control phase parameters: same AGC, radio_freq, lna_off used for all PDTCH |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1028 // *************************************************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1029 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1030 // Get radio_freq on which the downlink block was received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1031 radio_freq = l1a_l1s_com.dedic_set.radio_freq_dd; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1032 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1033 // Compute calibration factors |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1034 delta1_freq = l1ctl_encode_delta1(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1035 delta2_freq = l1ctl_encode_delta2(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1036 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1037 // Last known AGC (format F7.1) |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
1038 used_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1; |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1039 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1040 // LNA attenuation |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1041 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1042 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1043 // Burst 0: Reset ILmin_beacon and ILmin_others |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1044 if(pdsp_db_r_ptr->d_burst_nb_gprs == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1045 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1046 l1ps.ILmin_beacon = 255; // Not valid |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1047 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1048 for (ts = 0; ts < 8; ts++) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1049 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1050 l1ps.ILmin_others[ts] = 255; // Not valid |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1051 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1052 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1053 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1054 // IL processing for each received burst |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1055 // ************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1056 |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1057 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1058 // DRP correction |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1059 #if (L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1060 arfcn = Convert_l1_radio_freq(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1061 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1062 arfcn=radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1063 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1064 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1065 #if (CODE_VERSION != SIMULATION) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1066 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1067 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID , |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1068 l1a_l1s_com.Scell_used_IL_dd.input_level, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1069 radio_freq, if_threshold); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1070 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1071 delta_drp_gain = drp_gain_correction(arfcn, lna_off, used_agc); // F7.1 format |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1072 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1073 if(if_ctl == IF_100KHZ_DSP){ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1074 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1075 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1076 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1077 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1078 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1079 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1080 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1081 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1082 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1083 // For each timeslot on which a burst was received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1084 for(ts = 0; ts < 8; ts ++) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1085 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1086 if(pdsp_db_r_ptr->d_task_d_gprs & bit_mask) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1087 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1088 WORD16 current_IL, current_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1089 UWORD8 pm; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1090 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1091 // IL = fct(pm, last_known_agc, lna_value, g_magic) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1092 //------------------------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1093 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1094 pm = (UWORD8) ((pdsp_db_r_ptr->a_burst_pm_gprs[ts] & 0xffff) >> 5); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1095 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1096 // current_IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1097 if (0==pm) // Check and filter illegal pm value by using last valid IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1098 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1099 current_IL = l1a_l1s_com.last_input_level[serving_index].input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1100 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1101 if (radio_freq != l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1102 current_IL += (l1ps.read_param.dl_pwr_ctl.p0 + 10); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1103 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1104 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1105 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1106 current_IL = -(pm - (used_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1107 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1108 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1109 // Calibrated IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1110 current_calibrated_IL = current_IL - delta1_freq - delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1111 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1112 // Protect IL stores against overflow |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1113 if(current_calibrated_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1114 current_calibrated_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1115 if (current_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1116 current_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1117 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1118 calibrated_IL[ts] = (UWORD8)(current_calibrated_IL); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1119 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1120 // Keep the minimum IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1121 if (radio_freq == l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1122 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1123 // Beacon frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1124 l1ps.ILmin_beacon = min((UWORD8) current_IL,l1ps.ILmin_beacon); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1125 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1126 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1127 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1128 // Daughter frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1129 l1ps.ILmin_others[ts] = min((UWORD8) current_IL, l1ps.ILmin_others[ts]); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1130 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1131 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1132 // Input Level selection among ILmax found on each timeslot during the block (when burst = 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1133 //------------------------------------------------------------------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1134 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1135 if(pdsp_db_r_ptr->d_burst_nb_gprs == 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1136 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1137 // If CRC good |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1138 if (!(pdsp_ndb_ptr->a_dd_gprs[rx_no][0] & 0x0100)) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1139 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1140 // If ((PR_MODE A and TFI good) or (PR_MODE B)) AND PR != 0 [Not usable]) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1141 if (((l1ps.read_param.dl_pwr_ctl.pr_mode != 0) || (!(pr_table[ts] & 0x80))) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1142 && ((pr_table[ts] & 0x1f) != 0)) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1143 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1144 if (l1ps.ILmin_others[ts] != 255) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1145 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1146 UWORD8 IL_norm; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1147 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1148 // IL normalization to beacon (ILnorm = ILmax_others(ts) - P0 - PR) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1149 IL_norm = l1ps.ILmin_others[ts] - l1ps.read_param.dl_pwr_ctl.p0 - ((pr_table[ts] & 0x1f) << 1); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1150 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1151 // Update IL_min with the minimum found IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1152 IL_norm_min = min(IL_norm, IL_norm_min); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1153 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1154 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1155 } // End if "CRC good" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1156 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1157 } // End if "burst = 3" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1158 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1159 // Next downlink block |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1160 rx_no ++; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1161 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1162 } // End if "timeslot used for downlink PDCH" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1163 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1164 // Next timeslot |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1165 bit_mask >>= 1; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1166 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1167 } // End for "each timeslot...." |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1168 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1169 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1170 // IL selection for the next block if burst = 3 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1171 // ********************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1172 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1173 if(pdsp_db_r_ptr->d_burst_nb_gprs == 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1174 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1175 UWORD8 i, new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1176 UWORD16 input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1177 WORD16 new_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1178 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1179 // Select the minimum IL between minimum IL found on daughter frequencies (normalized to beacon) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1180 // and minimum IL found on the beacon |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1181 IL_norm_min = min(IL_norm_min, l1ps.ILmin_beacon); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1182 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1183 // If a valid IL has been found |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1184 if (IL_norm_min != 255) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1185 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1186 // FIFO management |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1187 for (i=3;i>0;i--) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1188 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-1]; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1189 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1190 l1a_l1s_com.Scell_info.buff_beacon[0] = IL_norm_min; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1191 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1192 // last_input_level[serving beacon] updating |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1193 //------------------------------------------ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1194 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1195 // Find min IL in FIFO |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1196 new_IL = l1ctl_find_max(l1a_l1s_com.Scell_info.buff_beacon,4); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1197 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1198 // Input levels are always stored with lna_on |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1199 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1200 // lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1201 new_calibrated_IL = (WORD16) (new_IL - l1ctl_encode_delta1(l1a_l1s_com.Scell_info.radio_freq) - l1ctl_encode_delta2(l1a_l1s_com.Scell_info.radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1202 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1203 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1204 l1ctl_encode_lna((UWORD8)(new_calibrated_IL >> 1), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1205 &(l1a_l1s_com.last_input_level[serving_index].lna_off), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1206 l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1207 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1208 l1a_l1s_com.last_input_level[serving_index].input_level = new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1209 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1210 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1211 // transfer_meas updating |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1212 //----------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1213 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1214 // IL = (min IL in FIFO) + P0 + 10 (PR = 5 format 7.1) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1215 // Input levels are always stored with lna_on |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1216 input_level = l1a_l1s_com.last_input_level[serving_index].input_level + l1ps.read_param.dl_pwr_ctl.p0 + 10; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1217 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1218 // IL_2_AGC_xx array size |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1219 if (input_level>INDEX_MAX) input_level = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1220 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1221 // lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1222 new_calibrated_IL = (WORD16) (input_level - l1ctl_encode_delta1(l1ps.read_param.radio_freq_for_lna)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1223 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1224 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1225 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1226 l1ctl_encode_lna((UWORD8)(new_calibrated_IL>>1), &(l1a_l1s_com.Scell_info.transfer_meas.lna_off), l1ps.read_param.radio_freq_for_lna); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1227 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1228 l1a_l1s_com.Scell_info.transfer_meas.input_level = (UWORD8)input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1229 } // End if "burst = 3" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1230 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1231 } // End of "l1pctl_dpcma_agc_read" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1232 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1233 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1234 /* l1pctl_dpcmb_agc_read() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1235 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1236 /* Description : */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1237 /* =========== */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1238 /* AGC algorithm in packet transfer used when the BTS */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1239 /* use DOWNLINK POWER CONTROL mode B. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1240 /* This function is used during the read phase of PDTCH: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1241 /* 1- to determine the IL value for each timeslot in each*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1242 /* TDMA */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1243 /* 2- to find the IL value to use for the next PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1244 /* block */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1245 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1246 /* Algorithm */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1247 /* --------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1248 /* For each timeslot i used for PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1249 /* IL(i) = fct(used AGC, pm) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1250 /* if (beacon) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1251 /* ILmax_beacon = max(ILmax_beacon, IL(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1252 /* else */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1253 /* ILmax_others(i) = max(IL(i), ILmax_others(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1254 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1255 /* If (burst_nb == 3) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1256 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1257 /* For each timeslot i used for PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1258 /* if (CRC good) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1259 /* if (TFI good) last_PR_good = PR(i) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1260 /* if ((PR_MODE A) or (PR_MODE B and TFI good)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1261 /* ILmax = max(ILmax, ILmax_others(i) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1262 /* + P0 + PR(i)) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1263 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1264 /* ILmax=max(ILmax, ILmax_beacon) */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1265 /* FIFO[beacon] updated with ILmax */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1266 /* last_input_level[serving beacon] = max(FIFO[beacon])*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1267 /* transfer_meas = max(FIFO[beacon]) - last_PR_good */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1268 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1269 /* Reset ILmax_others[8] and ILmax_beacon */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1270 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1271 /* WARNING: in the layer 1 code, input levels IL(l1) use */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1272 /* format 7.1: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1273 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1274 /* * IL(l1) = - 2 x IL * */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1275 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1276 /* -> Reversed sign, reversed test conditions */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1277 /* -> max replaced by min */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1278 /* ex: if IL -120 dBm, IL(l1) = 240 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1279 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1280 /* Parameters */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1281 /* ---------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1282 /* "calibrated_IL[8]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1283 /* contains the IL found on timeslots */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1284 /* used for PDCH/D. These ILs can be used to process */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1285 /* RXLEV values. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1286 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1287 /* "*pdsp_db_r_ptr" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1288 /* Pointer on the DSP DB Read page, used to extract */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1289 /* pm values, burst number and timeslot allocated */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1290 /* for downlink PDCH */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1291 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1292 /* "*pdsp_ndb_ptr" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1293 /* Pointer on the DSP NDB page, used to extract the */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1294 /* CRC value for each decoded burst */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1295 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1296 /* Global parameters */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1297 /* ----------------- */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1298 /* "l1a_l1s_com.Scell_info.transfer_meas.input_level" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1299 /* "l1a_l1s_com.Scell_info.transfer_meas.lna_off" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1300 /* Used to store the ILselected and the associated */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1301 /* lna_off value. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1302 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1303 /* "l1a_l1s_com.last_input_level[freq. index] */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1304 /* .input_level */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1305 /* .lna_off" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1306 /* Used to store the beacon input level and */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1307 /* the associated lna_off value. */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1308 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1309 /* "l1ps.transfer_beacon_buf[4]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1310 /* FIFO[beacon] */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1311 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1312 /* "l1ps.ILmin_beacon" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1313 /* "l1ps.ILmin_others[8]" */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1314 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1315 void l1pctl_dpcmb_agc_read(UWORD8 calibrated_IL[8], T_DB_DSP_TO_MCU_GPRS *pdsp_db_r_ptr, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1316 T_NDB_MCU_DSP_GPRS *pdsp_ndb_ptr, UWORD8 pr_table[8]) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1317 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1318 UWORD8 ts = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1319 UWORD8 rx_no = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1320 UWORD8 bit_mask = 0x80; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1321 UWORD8 IL_norm_min = 255; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1322 WORD8 delta1_freq, delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1323 WORD16 delta_drp_gain=0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1324 UWORD16 radio_freq, lna_value; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1325 WORD16 used_agc; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1326 WORD32 serving_index; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1327 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1328 UWORD16 arfcn; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1329 #endif |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1330 UWORD8 lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1331 UWORD16 dco_algo_ctl_pw_temp = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1332 UWORD8 if_ctl = 0; |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
1333 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1334 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GPRS; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1335 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1336 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1337 #if(L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1338 serving_index = l1a_l1s_com.Scell_info.radio_freq - l1_config.std.radio_freq_index_offset; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1339 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1340 serving_index = l1_multiband_radio_freq_convert_into_operative_radio_freq(l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1341 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1342 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1343 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1344 // Control phase parameters: same AGC, radio_freq, lna_off used for all PDTCH |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1345 // *************************************************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1346 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1347 // Get radio_freq on which the downlink block was received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1348 radio_freq = l1a_l1s_com.dedic_set.radio_freq_dd; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1349 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1350 // Compute calibration factors |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1351 delta1_freq = l1ctl_encode_delta1(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1352 delta2_freq = l1ctl_encode_delta2(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1353 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1354 // Last known AGC (format F7.1) |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
1355 used_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1; |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1356 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1357 // LNA attenuation |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1358 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1359 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1360 // Burst 0: Reset ILmin_beacon and ILmin_others |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1361 if(pdsp_db_r_ptr->d_burst_nb_gprs == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1362 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1363 l1ps.ILmin_beacon = 255; // Not valid |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1364 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1365 for (ts = 0; ts < 8; ts++) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1366 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1367 l1ps.ILmin_others[ts] = 255; // Not valid |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1368 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1369 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1370 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1371 // IL processing for each received burst |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1372 // ************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1373 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1374 // For each timeslot on which a burst was received |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1375 for(ts = 0; ts < 8; ts ++) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1376 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1377 if(pdsp_db_r_ptr->d_task_d_gprs & bit_mask) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1378 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1379 WORD16 current_IL, current_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1380 UWORD8 pm; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1381 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1382 // IL = fct(pm, last_known_agc, lna_value, g_magic) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1383 //------------------------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1384 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1385 pm = (UWORD8) ((pdsp_db_r_ptr->a_burst_pm_gprs[ts] & 0xffff) >> 5); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1386 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1387 // current_IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1388 if (0==pm) // Check and filter illegal pm value by using last valid IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1389 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1390 current_IL = l1a_l1s_com.last_input_level[serving_index].input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1391 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1392 if (radio_freq != l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1393 current_IL += (l1ps.last_PR_good); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1394 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1395 else |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1396 { |
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1397 |
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1398 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1399 // DRP correction |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1400 #if (L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1401 arfcn = Convert_l1_radio_freq(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1402 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1403 arfcn=radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1404 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1405 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1406 #if (CODE_VERSION != SIMULATION) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1407 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1408 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1409 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID , |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1410 l1a_l1s_com.Scell_used_IL_dd.input_level, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1411 radio_freq, if_threshold); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1412 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1413 delta_drp_gain = drp_gain_correction(arfcn, lna_off, used_agc); // F7.1 format |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1414 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1415 if(if_ctl == IF_100KHZ_DSP){ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1416 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1417 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1418 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1419 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1420 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1421 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1422 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1423 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1424 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1425 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1426 current_IL = -(pm - ( used_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq)); |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1427 } |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1428 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1429 // Calibrated IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1430 current_calibrated_IL = current_IL - delta1_freq - delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1431 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1432 // Protect IL stores against overflow |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1433 if(current_calibrated_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1434 current_calibrated_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1435 if (current_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1436 current_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1437 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1438 calibrated_IL[ts] = (UWORD8)(current_calibrated_IL); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1439 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1440 // Keep the minimum IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1441 if (radio_freq == l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1442 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1443 // Beacon frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1444 l1ps.ILmin_beacon = min((UWORD8) current_IL,l1ps.ILmin_beacon); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1445 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1446 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1447 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1448 // Daughter frequency |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1449 l1ps.ILmin_others[ts] = min((UWORD8) current_IL, l1ps.ILmin_others[ts]); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1450 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1451 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1452 // Input Level selection among ILmax found on each timeslot during the block (when burst = 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1453 //------------------------------------------------------------------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1454 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1455 if(pdsp_db_r_ptr->d_burst_nb_gprs == 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1456 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1457 // If CRC good |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1458 if (!(pdsp_ndb_ptr->a_dd_gprs[rx_no][0] & 0x0100)) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1459 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1460 // If ((PR_MODE A and TFI good) or (PR_MODE B)) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1461 if ((l1ps.read_param.dl_pwr_ctl.pr_mode != 0) || (!(pr_table[ts] & 0x80))) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1462 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1463 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1464 // If TFI good |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1465 if (!(pr_table[ts] & 0x80)) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1466 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1467 // Memorize decoded PR |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1468 l1ps.last_PR_good = ((pr_table[ts] & 0x1f) << 1); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1469 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1470 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1471 if (l1ps.ILmin_others[ts] != 255) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1472 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1473 UWORD8 IL_norm; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1474 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1475 // IL normalization to beacon (ILnorm = ILmax_others(ts) - PR) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1476 IL_norm = l1ps.ILmin_others[ts] - ((pr_table[ts] & 0x1f) << 1); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1477 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1478 // Update IL_min with the minimum found IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1479 IL_norm_min = min(IL_norm, IL_norm_min); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1480 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1481 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1482 } // End if "CRC good" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1483 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1484 } // End if "burst = 3" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1485 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1486 // Next downlink block |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1487 rx_no ++; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1488 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1489 } // End if "timeslot used for downlink PDCH" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1490 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1491 // Next timeslot |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1492 bit_mask >>= 1; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1493 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1494 } // End for "each timeslot...." |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1495 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1496 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1497 // IL selection for the next block if burst = 3 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1498 // ********************************************** |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1499 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1500 if(pdsp_db_r_ptr->d_burst_nb_gprs == 3) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1501 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1502 UWORD8 i, new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1503 UWORD16 input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1504 WORD16 new_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1505 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1506 // Select the minimum IL between minimum IL found on daughter frequencies (normalized to beacon) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1507 // and minimum IL found on the beacon |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1508 IL_norm_min = min(IL_norm_min, l1ps.ILmin_beacon); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1509 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1510 // If a valid IL has been found |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1511 if (IL_norm_min != 255) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1512 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1513 // FIFO management |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1514 for (i=3;i>0;i--) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1515 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-1]; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1516 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1517 l1a_l1s_com.Scell_info.buff_beacon[0] = IL_norm_min; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1518 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1519 // last_input_level[serving beacon] updating |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1520 //------------------------------------------ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1521 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1522 // Find min IL in FIFO |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1523 new_IL = l1ctl_find_max(l1a_l1s_com.Scell_info.buff_beacon,4); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1524 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1525 // Input levels are always stored with lna_on |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1526 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1527 // lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1528 new_calibrated_IL = (WORD16) (new_IL - l1ctl_encode_delta1(l1a_l1s_com.Scell_info.radio_freq) - l1ctl_encode_delta2(l1a_l1s_com.Scell_info.radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1529 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1530 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1531 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1532 l1ctl_encode_lna((UWORD8)(new_calibrated_IL >> 1), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1533 &(l1a_l1s_com.last_input_level[serving_index].lna_off), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1534 l1a_l1s_com.Scell_info.radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1535 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1536 l1a_l1s_com.last_input_level[serving_index].input_level = new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1537 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1538 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1539 // transfer_meas updating |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1540 //----------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1541 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1542 // IL = (min IL in FIFO) + PR (Middle of the range specified by the last decoded PR with CRC and TFI good) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1543 // Input levels are always stored with lna_on |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1544 input_level = l1a_l1s_com.last_input_level[serving_index].input_level + l1ps.last_PR_good; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1545 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1546 // IL_2_AGC_xx array size |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1547 if (input_level>INDEX_MAX) input_level = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1548 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1549 // lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1550 new_calibrated_IL = (WORD16) (input_level - l1ctl_encode_delta1(l1ps.read_param.radio_freq_for_lna)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1551 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1552 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1553 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1554 l1ctl_encode_lna((UWORD8)(new_calibrated_IL>>1), &(l1a_l1s_com.Scell_info.transfer_meas.lna_off), l1ps.read_param.radio_freq_for_lna); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1555 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1556 l1a_l1s_com.Scell_info.transfer_meas.input_level = (UWORD8)input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1557 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1558 } // End if "burst = 3" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1559 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1560 } // End of "l1pctl_dpcmb_agc_read" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1561 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1562 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1563 /* l1pctl_pgc() */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1564 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1565 /* Description : */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1566 /* ============= */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1567 /* This function is used in packet transfer mode for the*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1568 /* Read phase of power measurements. It permits to: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1569 /* - Process the IL value in function of the Pm and AGC */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1570 /* used */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1571 /* - Update the FIFO[beacon] used in packet transfer AGC*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1572 /* algorithms */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1573 /* - Update last_input_level */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1574 /* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1575 /* WARNING: in the layer 1 code, input levels IL(l1) use */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1576 /* format 7.1: */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1577 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1578 /* * IL(l1) = - 2 x IL * */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1579 /* ********************* */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1580 /* -> Reversed sign, reversed test conditions */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1581 /* -> max replaced by min */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1582 /* ex: if IL -120 dBm, IL(l1) = 240 */ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1583 /*-------------------------------------------------------*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1584 UWORD8 l1pctl_pgc(UWORD8 pm, UWORD8 last_known_il, UWORD8 lna_off, UWORD16 radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1585 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1586 UWORD8 i, new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1587 WORD8 delta1_freq, delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1588 WORD16 delta_drp_gain=0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1589 UWORD16 lna_value; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1590 WORD16 used_agc, current_IL, current_calibrated_IL, new_calibrated_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1591 WORD32 index; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1592 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1593 UWORD16 arfcn; |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1594 #endif |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1595 UWORD16 dco_algo_ctl_pw_temp = 0; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1596 UWORD8 if_ctl = 0; |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
1597 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1598 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GPRS; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1599 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1600 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1601 // Calibration factors |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1602 delta1_freq = l1ctl_encode_delta1(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1603 delta2_freq = l1ctl_encode_delta2(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1604 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1605 // initialize index |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1606 #if(L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1607 index = radio_freq - l1_config.std.radio_freq_index_offset; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1608 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1609 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1610 index = l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1611 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1612 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1613 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1614 // LNA attenuation |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1615 lna_value = lna_off * l1ctl_get_lna_att(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1616 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1617 // Used AGC in the control phase (format F7.1) |
310
cd2507a8ec57
l1p_ctl.c: passes compilation
Mychaela Falconia <falcon@freecalypso.org>
parents:
309
diff
changeset
|
1618 used_agc = (Cust_get_agc_from_IL(radio_freq, last_known_il >> 1, PWR_ID)) << 1; |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1619 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1620 |
311
5f8ab159aa76
l1p_ctl.c: l1pctl_pagc_read() reconstructed
Mychaela Falconia <falcon@freecalypso.org>
parents:
310
diff
changeset
|
1621 #if (RF_FAM == 61) |
309
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1622 // DRP correction |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1623 #if (L1_FF_MULTIBAND == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1624 arfcn = Convert_l1_radio_freq(radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1625 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1626 arfcn=radio_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1627 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1628 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1629 #if (CODE_VERSION != SIMULATION) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1630 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1631 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1632 #if (PWMEAS_IF_MODE_FORCE == 0) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1633 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID , |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1634 last_known_il, |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1635 radio_freq, if_threshold); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1636 #else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1637 if_ctl = IF_120KHZ_DSP; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1638 dco_algo_ctl_pw_temp = DCO_IF_0KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1639 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1640 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1641 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1642 delta_drp_gain = drp_gain_correction(arfcn, lna_off, used_agc); // F7.1 format |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1643 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1644 if(if_ctl == IF_100KHZ_DSP){ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1645 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1646 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1647 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1648 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1649 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1650 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1651 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1652 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1653 #endif |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1654 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1655 if (0==pm) // Check and filter illegal pm value by using last valid IL |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1656 current_IL = l1a_l1s_com.last_input_level[index].input_level; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1657 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1658 current_IL = -(pm - (used_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq)); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1659 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1660 // Calibrated IL processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1661 current_calibrated_IL = current_IL - delta1_freq - delta2_freq; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1662 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1663 // Protect IL stores against overflow |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1664 if (current_calibrated_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1665 current_calibrated_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1666 if (current_IL>INDEX_MAX) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1667 current_IL=INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1668 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1669 // if radio freq is the serving beacon |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1670 //------------------------------------ |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1671 if (radio_freq == l1a_l1s_com.Scell_info.radio_freq) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1672 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1673 // FIFO management |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1674 for (i=3;i>0;i--) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1675 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-1]; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1676 l1a_l1s_com.Scell_info.buff_beacon[0] = (UWORD8) current_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1677 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1678 // Find min IL in FIFO |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1679 new_IL = l1ctl_find_max(l1a_l1s_com.Scell_info.buff_beacon,4); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1680 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1681 // lna_off processing |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1682 new_calibrated_IL = (WORD16) (new_IL - delta1_freq - delta2_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1683 if (new_calibrated_IL>INDEX_MAX) new_calibrated_IL = INDEX_MAX; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1684 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1685 l1ctl_encode_lna((UWORD8)(new_calibrated_IL>>1), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1686 &(l1a_l1s_com.last_input_level[index].lna_off), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1687 radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1688 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1689 l1a_l1s_com.last_input_level[index].input_level = new_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1690 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1691 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1692 // if radio freq is a neighbor beacon |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1693 //----------------------------------- |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1694 else |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1695 { |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1696 // Update last_input_level (IL with LNA ON) |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1697 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1698 &(l1a_l1s_com.last_input_level[index].lna_off), |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1699 radio_freq); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1700 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1701 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL; |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1702 } |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1703 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1704 return((UWORD8)current_calibrated_IL); |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1705 |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1706 } // End of "l1pctl_pgc" |
871cf4253768
l1p_ctl.c: initial import from LoCosto source
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
1707 #endif |