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