altos/test: Adjust CRC error rate after FEC fix
[fw/altos] / src / avr / ao_arch.h
1 /*
2  * Copyright © 2011 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License along
15  * with this program; if not, write to the Free Software Foundation, Inc.,
16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
17  */
18
19 #ifndef _AO_ARCH_H_
20 #define _AO_ARCH_H_
21
22 #include <stdio.h>
23 #include <avr/io.h>
24 #include <avr/interrupt.h>
25 #include <avr/sleep.h>
26
27 #ifdef AVR_DEMO
28 #define TEENSY 1
29 #endif
30
31 #if TEENSY
32 #define F_CPU 16000000UL        // 16 MHz
33 #else
34 #define F_CPU  8000000UL        // 8 MHz
35 #endif
36
37 /*
38  * AVR definitions and code fragments for AltOS
39  */
40
41 #ifndef AO_STACK_SIZE
42 #define AO_STACK_SIZE   116
43 #endif
44
45 #define AO_PORT_TYPE    uint8_t
46
47 /* Various definitions to make GCC look more like SDCC */
48
49 #define ao_arch_naked_declare   __attribute__((naked))
50 #define ao_arch_naked_define
51 #define __interrupt(n)
52 #define __at(n)
53
54 #define ao_arch_reboot()        /* XXX */
55
56 #define ao_arch_nop()           asm("nop")
57
58 #define ao_arch_interrupt(n)    /* nothing */
59
60 #undef putchar
61 #undef getchar
62 #define putchar(c)      ao_putchar(c)
63 #define getchar         ao_getchar
64
65 extern void putchar(char c);
66 extern char getchar(void);
67 extern void ao_avr_stdio_init(void);
68
69 #define AO_ROMCONFIG_VERSION    2
70
71 #define AO_ROMCONFIG_SYMBOL(a) const
72
73 extern AO_ROMCONFIG_SYMBOL(0) uint16_t ao_serial_number;
74
75 #define AVR_PUSH8(stack, val)   (*((stack)--) = (val))
76
77 extern uint8_t  ao_cpu_sleep_disable;
78
79 #define ao_arch_task_globals    uint8_t ao_cpu_sleep_disable;
80
81 #define ao_arch_init_stack(task, sp, start)                             \
82         do {                                                            \
83                 uint16_t        a = (uint16_t) start;                   \
84                 int             i;                                      \
85                                                                         \
86                 /* Return address */                                    \
87                 AVR_PUSH8(sp, a);                                       \
88                 AVR_PUSH8(sp, (a >> 8));                                \
89                                                                         \
90                 /* Clear register values */                             \
91                 i = 32;                                                 \
92                 while (i--)                                             \
93                         AVR_PUSH8(sp, 0);                               \
94                                                                         \
95                 /* SREG with interrupts enabled */                      \
96                 AVR_PUSH8(sp, 0x80);                                    \
97                 task->sp8 = sp;                                         \
98         } while (0);
99         
100 #define ao_arch_save_regs() do {                                        \
101                 asm("push r31" "\n\t" "push r30");                      \
102                 asm("push r29" "\n\t" "push r28" "\n\t" "push r27" "\n\t" "push r26" "\n\t" "push r25"); \
103                 asm("push r24" "\n\t" "push r23" "\n\t" "push r22" "\n\t" "push r21" "\n\t" "push r20"); \
104                 asm("push r19" "\n\t" "push r18" "\n\t" "push r17" "\n\t" "push r16" "\n\t" "push r15"); \
105                 asm("push r14" "\n\t" "push r13" "\n\t" "push r12" "\n\t" "push r11" "\n\t" "push r10"); \
106                 asm("push r9" "\n\t" "push r8" "\n\t" "push r7" "\n\t" "push r6" "\n\t" "push r5"); \
107                 asm("push r4" "\n\t" "push r3" "\n\t" "push r2" "\n\t" "push r1" "\n\t" "push r0"); \
108                 asm("in r0, __SREG__" "\n\t" "push r0");                \
109         } while (0)
110
111 #define ao_arch_save_stack() do {                                       \
112                 uint8_t sp_l, sp_h;                                     \
113                 asm("in %0,__SP_L__" : "=&r" (sp_l) );                  \
114                 asm("in %0,__SP_H__" : "=&r" (sp_h) );                  \
115                 ao_cur_task->sp8 = (uint8_t *) ((uint16_t) sp_l | ((uint16_t) sp_h << 8)); \
116         } while (0)
117
118 #define ao_arch_isr_stack()     /* nothing */
119
120 /* Idle the CPU (if possible) waiting for an interrupt. Enabling
121  * interrupts and sleeping the CPU must be adjacent to eliminate race
122  * conditions. In all cases, we execute a single nop with interrupts
123  * enabled
124  */
125 #define ao_arch_wait_interrupt() do {           \
126                 if (!ao_cpu_sleep_disable) {    \
127                         sleep_enable();         \
128                         sei();                  \
129                         sleep_cpu();            \
130                         sleep_disable();        \
131                 } else {                        \
132                         sei();                  \
133                 }                               \
134                 ao_arch_nop();                  \
135                 cli();                          \
136         } while (0)
137
138 #define ao_arch_restore_stack() do { \
139                 uint8_t sp_l, sp_h;                                     \
140                 sp_l = (uint16_t) ao_cur_task->sp8;                     \
141                 sp_h = ((uint16_t) ao_cur_task->sp8) >> 8;              \
142                 asm("out __SP_H__,%0" : : "r" (sp_h) );                 \
143                 asm("out __SP_L__,%0" : : "r" (sp_l) );                 \
144                 asm("pop r0"    "\n\t"                                  \
145                     "out __SREG__, r0");                                \
146                 asm("pop r0" "\n\t" "pop r1" "\n\t" "pop r2" "\n\t" "pop r3" "\n\t" "pop r4"); \
147                 asm("pop r5" "\n\t" "pop r6" "\n\t" "pop r7" "\n\t" "pop r8" "\n\t" "pop r9"); \
148                 asm("pop r10" "\n\t" "pop r11" "\n\t" "pop r12" "\n\t" "pop r13" "\n\t" "pop r14"); \
149                 asm("pop r15" "\n\t" "pop r16" "\n\t" "pop r17" "\n\t" "pop r18" "\n\t" "pop r19"); \
150                 asm("pop r20" "\n\t" "pop r21" "\n\t" "pop r22" "\n\t" "pop r23" "\n\t" "pop r24"); \
151                 asm("pop r25" "\n\t" "pop r26" "\n\t" "pop r27" "\n\t" "pop r28" "\n\t" "pop r29"); \
152                 asm("pop r30" "\n\t" "pop r31");                        \
153                 asm("ret");                                             \
154         } while(0)
155
156 #define ao_arch_critical(b) do { cli(); do { b } while (0); sei(); } while (0)
157
158 #define ao_arch_block_interrupts()      cli()
159 #define ao_arch_release_interrupts()    sei()
160
161 #define AO_TELESCIENCE_NUM_ADC  12
162
163 #endif /* _AO_ARCH_H_ */
164