git.gag.com Git - fw/altos/blob - 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 #define AO_STACK_SIZE   116
  41
  42 /* Various definitions to make GCC look more like SDCC */
  43
  44 #define ao_arch_naked_declare   __attribute__((naked))
  45 #define ao_arch_naked_define
  46 #define __pdata
  47 #define __data
  48 #define __xdata
  49 #define __code const
  50 #define __reentrant
  51 #define __critical
  52 #define __interrupt(n)
  53 #define __at(n)
  54
  55 #define ao_arch_reboot()        /* XXX */
  56
  57 #define ao_arch_nop()           asm("nop")
  58
  59 #define ao_arch_interrupt(n)    /* nothing */
  60
  61 #undef putchar
  62 #undef getchar
  63 #define putchar(c)      ao_putchar(c)
  64 #define getchar         ao_getchar
  65
  66 extern void putchar(char c);
  67 extern char getchar(void);
  68 extern void ao_avr_stdio_init(void);
  69
  70 extern const uint16_t ao_serial_number;
  71
  72 #define AVR_PUSH8(stack, val)   (*((stack)--) = (val))
  73
  74 extern uint8_t  ao_cpu_sleep_disable;
  75
  76 #define ao_arch_task_globals    uint8_t ao_cpu_sleep_disable;
  77
  78 #define ao_arch_task_members\
  79         uint8_t *sp;                    /* saved stack pointer */
  80
  81 #define ao_arch_init_stack(task, start) do {                    \
  82         uint8_t         *sp = task->stack + AO_STACK_SIZE - 1;  \
  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->sp = 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                 sei();                                                  \
 110         } while (0)
 111
 112 #define ao_arch_save_stack() do {                                       \
 113                 uint8_t sp_l, sp_h;                                     \
 114                 asm("in %0,__SP_L__" : "=&r" (sp_l) );                  \
 115                 asm("in %0,__SP_H__" : "=&r" (sp_h) );                  \
 116                 ao_cur_task->sp = (uint8_t *) ((uint16_t) sp_l | ((uint16_t) sp_h << 8)); \
 117         } while (0)
 118
 119 #define ao_arch_isr_stack()     /* nothing */
 120
 121 #define ao_arch_cpu_idle() do {                 \
 122                 if (!ao_cpu_sleep_disable)      \
 123                         sleep_cpu();            \
 124         } while (0)
 125
 126 #define ao_arch_restore_stack() do { \
 127                 uint8_t sp_l, sp_h;                                     \
 128                 sp_l = (uint16_t) ao_cur_task->sp;                      \
 129                 sp_h = ((uint16_t) ao_cur_task->sp) >> 8;               \
 130                 cli();                                                  \
 131                 asm("out __SP_H__,%0" : : "r" (sp_h) );                 \
 132                 asm("out __SP_L__,%0" : : "r" (sp_l) );                 \
 133                 asm("pop r0"    "\n\t"                                  \
 134                     "out __SREG__, r0");                                \
 135                 asm("pop r0" "\n\t" "pop r1" "\n\t" "pop r2" "\n\t" "pop r3" "\n\t" "pop r4"); \
 136                 asm("pop r5" "\n\t" "pop r6" "\n\t" "pop r7" "\n\t" "pop r8" "\n\t" "pop r9"); \
 137                 asm("pop r10" "\n\t" "pop r11" "\n\t" "pop r12" "\n\t" "pop r13" "\n\t" "pop r14"); \
 138                 asm("pop r15" "\n\t" "pop r16" "\n\t" "pop r17" "\n\t" "pop r18" "\n\t" "pop r19"); \
 139                 asm("pop r20" "\n\t" "pop r21" "\n\t" "pop r22" "\n\t" "pop r23" "\n\t" "pop r24"); \
 140                 asm("pop r25" "\n\t" "pop r26" "\n\t" "pop r27" "\n\t" "pop r28" "\n\t" "pop r29"); \
 141                 asm("pop r30" "\n\t" "pop r31");                        \
 142                 asm("ret");                                             \
 143         } while(0)
 144
 145 #define ao_arch_critical(b) do { cli(); do { b } while (0); sei(); } while (0)
 146
 147 #define AO_TELESCIENCE_NUM_ADC  12
 148
 149 #endif /* _AO_ARCH_H_ */
 150