collab/mm20

git clone https://git.julia.blue/collab/mm20

Joseph RyanAdd blocking UART input backendf9a9dd3

algorithms
6.4 KiB302 linesraw
1#include <stdint.h>
2
3#define mkstr(s) #s
4#define DECLARE_HANDLER(name)                                                  \
5    void default_##name##_handler(void) {                                      \
6        while (1) {}                                                           \
7    }                                                                          \
8    __attribute__(                                                             \
9        (weak,                                                                 \
10         alias(mkstr(default_##name##_handler)))) void name##_handler(void);
11
12DECLARE_HANDLER(nonmaskable_interrupt)
13DECLARE_HANDLER(svcall)
14DECLARE_HANDLER(debug_monitor)
15DECLARE_HANDLER(pendsv)
16DECLARE_HANDLER(systick)
17DECLARE_HANDLER(hardfault)
18DECLARE_HANDLER(memory_management_fault)
19DECLARE_HANDLER(bus_fault)
20DECLARE_HANDLER(usage_fault)
21DECLARE_HANDLER(gpio_porta)
22DECLARE_HANDLER(gpio_portb)
23DECLARE_HANDLER(gpio_portc)
24DECLARE_HANDLER(gpio_portd)
25DECLARE_HANDLER(gpio_porte)
26DECLARE_HANDLER(uart0)
27DECLARE_HANDLER(uart1)
28DECLARE_HANDLER(spi0)
29DECLARE_HANDLER(i2c0)
30DECLARE_HANDLER(pwm0_fault)
31DECLARE_HANDLER(pwm0_generator0)
32DECLARE_HANDLER(pwm0_generator1)
33DECLARE_HANDLER(pwm0_generator2)
34DECLARE_HANDLER(qei0)
35DECLARE_HANDLER(adc0_sequence0)
36DECLARE_HANDLER(adc0_sequence1)
37DECLARE_HANDLER(adc0_sequence2)
38DECLARE_HANDLER(adc0_sequence3)
39DECLARE_HANDLER(watchdog_timer)
40DECLARE_HANDLER(timer0a)
41DECLARE_HANDLER(timer0b)
42DECLARE_HANDLER(timer1a)
43DECLARE_HANDLER(timer1b)
44DECLARE_HANDLER(timer2a)
45DECLARE_HANDLER(timer2b)
46DECLARE_HANDLER(analog_comparator0)
47DECLARE_HANDLER(analog_comparator1)
48DECLARE_HANDLER(system_ctrl)
49DECLARE_HANDLER(flash_ctrl)
50DECLARE_HANDLER(gpio_portf)
51DECLARE_HANDLER(uart2)
52DECLARE_HANDLER(spi1)
53DECLARE_HANDLER(timer3a)
54DECLARE_HANDLER(timer3b)
55DECLARE_HANDLER(i2c1)
56DECLARE_HANDLER(qei1)
57DECLARE_HANDLER(can0)
58DECLARE_HANDLER(can1)
59DECLARE_HANDLER(hibernation)
60DECLARE_HANDLER(usb0)
61DECLARE_HANDLER(pwm0_generator3)
62DECLARE_HANDLER(udma_software)
63DECLARE_HANDLER(udma_error)
64DECLARE_HANDLER(adc1_sequence0)
65DECLARE_HANDLER(adc1_sequence1)
66DECLARE_HANDLER(adc1_sequence2)
67DECLARE_HANDLER(adc1_sequence3)
68DECLARE_HANDLER(spi2)
69DECLARE_HANDLER(spi3)
70DECLARE_HANDLER(uart3)
71DECLARE_HANDLER(uart4)
72DECLARE_HANDLER(uart5)
73DECLARE_HANDLER(uart6)
74DECLARE_HANDLER(uart7)
75DECLARE_HANDLER(i2c2)
76DECLARE_HANDLER(i2c3)
77DECLARE_HANDLER(timer4a)
78DECLARE_HANDLER(timer4b)
79DECLARE_HANDLER(timer5a)
80DECLARE_HANDLER(timer5b)
81DECLARE_HANDLER(wide_timer0a)
82DECLARE_HANDLER(wide_timer0b)
83DECLARE_HANDLER(wide_timer1a)
84DECLARE_HANDLER(wide_timer1b)
85DECLARE_HANDLER(wide_timer2a)
86DECLARE_HANDLER(wide_timer2b)
87DECLARE_HANDLER(wide_timer3a)
88DECLARE_HANDLER(wide_timer3b)
89DECLARE_HANDLER(wide_timer4a)
90DECLARE_HANDLER(wide_timer4b)
91DECLARE_HANDLER(wide_timer5a)
92DECLARE_HANDLER(wide_timer5b)
93DECLARE_HANDLER(system_exception)
94DECLARE_HANDLER(pwm1_generator0)
95DECLARE_HANDLER(pwm1_generator1)
96DECLARE_HANDLER(pwm1_generator2)
97DECLARE_HANDLER(pwm1_generator3)
98DECLARE_HANDLER(pwm1_fault)
99
100__attribute__((used, weak, alias("default_reset_handler"))) void
101reset_handler(void);
102
103__attribute__((section(".interrupt_table"))) void (*const _vector_table[])(
104    void) = {
105    (void (*)(void))0x20008000,
106    reset_handler,
107    nonmaskable_interrupt_handler,
108    hardfault_handler,
109    memory_management_fault_handler,
110    bus_fault_handler,
111    usage_fault_handler,
112    0,
113    0,
114    0,
115    0,
116    svcall_handler,
117    debug_monitor_handler,
118    0,
119    pendsv_handler,
120    systick_handler,
121    gpio_porta_handler,
122    gpio_portb_handler,
123    gpio_portc_handler,
124    gpio_portd_handler,
125    gpio_porte_handler,
126    uart0_handler,
127    uart1_handler,
128    spi0_handler,
129    i2c0_handler,
130    pwm0_fault_handler,
131    pwm0_generator0_handler,
132    pwm0_generator1_handler,
133    pwm0_generator2_handler,
134    qei0_handler,
135    adc0_sequence0_handler,
136    adc0_sequence1_handler,
137    adc0_sequence2_handler,
138    adc0_sequence3_handler,
139    watchdog_timer_handler,
140    timer0a_handler,
141    timer0b_handler,
142    timer1a_handler,
143    timer1b_handler,
144    timer2a_handler,
145    timer2b_handler,
146    analog_comparator0_handler,
147    analog_comparator1_handler,
148    0,
149    system_ctrl_handler,
150    flash_ctrl_handler,
151    gpio_portf_handler,
152    0,
153    0,
154    uart2_handler,
155    spi1_handler,
156    timer3a_handler,
157    timer3b_handler,
158    i2c1_handler,
159    qei1_handler,
160    can0_handler,
161    can1_handler,
162    0,
163    0,
164    hibernation_handler,
165    usb0_handler,
166    pwm0_generator3_handler,
167    udma_software_handler,
168    udma_error_handler,
169    adc1_sequence0_handler,
170    adc1_sequence1_handler,
171    adc1_sequence2_handler,
172    adc1_sequence3_handler,
173    0,
174    0,
175    0,
176    0,
177    0,
178    spi2_handler,
179    spi3_handler,
180    uart3_handler,
181    uart4_handler,
182    uart5_handler,
183    uart6_handler,
184    uart7_handler,
185    0,
186    0,
187    0,
188    0,
189    i2c2_handler,
190    i2c3_handler,
191    timer4a_handler,
192    timer4b_handler,
193    0,
194    0,
195    0,
196    0,
197    0,
198    0,
199    0,
200    0,
201    0,
202    0,
203    0,
204    0,
205    0,
206    0,
207    0,
208    0,
209    0,
210    0,
211    0,
212    timer5a_handler,
213    timer5b_handler,
214    wide_timer0a_handler,
215    wide_timer0b_handler,
216    wide_timer1a_handler,
217    wide_timer1b_handler,
218    wide_timer2a_handler,
219    wide_timer2b_handler,
220    wide_timer3a_handler,
221    wide_timer3b_handler,
222    wide_timer4a_handler,
223    wide_timer4b_handler,
224    wide_timer5a_handler,
225    wide_timer5b_handler,
226    system_exception_handler,
227    0,
228    0,
229    0,
230    0,
231    0,
232    0,
233    0,
234    0,
235    0,
236    0,
237    0,
238    0,
239    0,
240    0,
241    0,
242    0,
243    0,
244    0,
245    0,
246    0,
247    0,
248    0,
249    0,
250    0,
251    0,
252    0,
253    0,
254    pwm1_generator0_handler,
255    pwm1_generator1_handler,
256    pwm1_generator2_handler,
257    pwm1_generator3_handler,
258    pwm1_fault_handler,
259};
260
261extern int main(void);
262extern uint32_t _bss;
263extern uint32_t _ebss;
264extern uint32_t _etext;
265extern uint32_t _data;
266extern uint32_t _edata;
267volatile uint32_t* const CPACR = (uint32_t*)0xE000ED88;
268
269void default_reset_handler(void) {
270    uint32_t* src = &_etext;
271    uint32_t* dest = &_data;
272    while (dest < &_edata) { *dest++ = *src++; }
273
274    dest = &_bss;
275    while (dest < &_ebss) { *dest++ = 0; }
276
277    *CPACR |= 0xF << 20;
278
279    main();
280    while (1) {}
281}
282
283void disable_interrupts(void) {
284    __asm("CPSID  I\n");
285}
286
287void enable_interrupts(void) {
288    __asm("CPSIE  I\n");
289}
290
291void start_critical(void) {
292    __asm("MRS    R0, PRIMASK\n"
293          "CPSID  I\n");
294}
295
296void end_critical(void) {
297    __asm("MSR    PRIMASK, R0\n");
298}
299
300void wait_for_interrupts(void) {
301    __asm("WFI\n");
302}