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