1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
|
/* main program of Free Software for Calypso Phone */
/* (C) 2010 by Harald Welte <laforge@gnumonks.org>
*
* All Rights Reserved
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*
*/
#include <stdint.h>
#include <stdio.h>
#include <gsm.h>
#include <debug.h>
#include <memory.h>
#include <rffe.h>
#include <keypad.h>
#include <board.h>
#include <abb/twl3025.h>
#include <display/st7558.h>
#include <rf/trf6151.h>
#include <comm/sercomm.h>
#include <calypso/clock.h>
#include <calypso/tpu.h>
#include <calypso/tsp.h>
#include <calypso/irq.h>
#include <calypso/misc.h>
#include <layer1/sync.h>
#include <layer1/tpu_window.h>
/* FIXME: We need proper calibrated delay loops at some point! */
void delay_us(unsigned int us)
{
volatile unsigned int i;
for (i= 0; i < us*4; i++) { i; }
}
void delay_ms(unsigned int ms)
{
volatile unsigned int i;
for (i= 0; i < ms*1300; i++) { i; }
}
const char *hr = "======================================================================\n";
/* MAIN program **************************************************************/
/* completion call-back for the L1 Sync Pwer Measurement */
static void l1s_signal_cb(struct l1_signal *sig)
{
uint16_t i, next_arfcn;
switch (sig->signum) {
case L1_SIG_PM:
break;
case L1_SIG_NB:
break;
}
}
static void key_handler(enum key_codes code, enum key_states state);
static void la1_l23_rx_cb(uint8_t dlci, struct msgb *msg);
int main(void)
{
board_init();
puts("\n\nHello World from " __FILE__ " program code\n");
puts(hr);
/* Dump device identification */
dump_dev_id();
puts(hr);
keypad_set_handler(&key_handler);
/* Dump clock config aftee PLL set */
calypso_clk_dump();
puts(hr);
st7558_set_attr(DISP_ATTR_INVERT);
st7558_puts("layer1.bin");
sercomm_register_rx_cb(SC_DLCI_L1A_L23, la1_l23_rx_cb);
layer1_init();
l1s_set_handler(&l1s_signal_cb);
tpu_frame_irq_en(1, 1);
while (1) {}
/* NOT REACHED */
twl3025_power_off();
}
static int8_t vga_gain = 40;
static int high_gain = 0;
static int afcout = 0;
static void update_vga_gain(void)
{
printf("VGA Gain: %u %s\n", vga_gain, high_gain ? "HIGH" : "LOW");
trf6151_set_gain(vga_gain, high_gain);
tpu_enq_sleep();
tpu_enable(1);
tpu_wait_idle();
}
static void tspact_toggle(uint8_t num)
{
printf("TSPACT%u toggle\n", num);
tsp_act_toggle((1 << num));
tpu_enq_sleep();
tpu_enable(1);
tpu_wait_idle();
}
static void key_handler(enum key_codes code, enum key_states state)
{
if (state != PRESSED)
return;
switch (code) {
case KEY_1: /* VGA gain decrement */
vga_gain -= 2;
if (vga_gain < 14)
vga_gain = 14;
update_vga_gain();
break;
case KEY_2: /* High/Low Rx gain */
high_gain ^= 1;
update_vga_gain();
break;
case KEY_3: /* VGA gain increment */
vga_gain += 2;
if (vga_gain > 40)
vga_gain = 40;
update_vga_gain();
break;
case KEY_4:
tspact_toggle(6); /* TRENA (RFFE) */
break;
case KEY_5:
tspact_toggle(8); /* GSM_TXEN (RFFE) */
break;
case KEY_6:
tspact_toggle(1); /* PAENA (RFFE) */
break;
case KEY_7: /* decrement AFC OUT */
afcout -= 100;
if (afcout < -4096)
afcout = -4096;
twl3025_afc_set(afcout);
printf("AFC OUT: %u\n", twl3025_afcout_get());
break;
case KEY_9: /* increase AFC OUT */
afcout += 100;
if (afcout > 4095)
afcout = 4095;
twl3025_afc_set(afcout);
printf("AFC OUT: %u\n", twl3025_afcout_get());
break;
default:
break;
}
}
static void la1_l23_rx_cb(uint8_t dlci, struct msgb *msg)
{
struct l1_info_ul *ul = msg->data;
struct l1_sync_new_ccch_req *sync_req;
if (sizeof(*ul) > msg->len) {
printf("la1_l23_cb: Short message. %u\n", msg->len);
goto exit;
}
switch (ul->msg_type) {
case SYNC_NEW_CCCH_REQ:
if (sizeof(*ul) + sizeof(*sync_req) > msg->len) {
printf("Short sync msg. %u\n", msg->len);
break;
}
sync_req = (struct l1_sync_new_ccch_req *) (&msg->data[0] + sizeof(*ul));
printf("Asked to tune to frequency: %u\n", sync_req->band_arfcn);
break;
case DEDIC_MODE_EST_REQ:
break;
}
exit:
msgb_free(msg);
}
|
