altos: add GCC/SDCC compat macros, init_stack, save_context and GCC stdio hooks

[fw/altos] / src / cc1111 / ao_arch.h

diff --git a/src/cc1111/ao_arch.h b/src/cc1111/ao_arch.h
index 585fffe52b5ddf0ccae93761e3f5ea84287ce902..35fd66f8e416ea3960128e393a683c0a487edac3 100644 (file)
--- a/src/cc1111/ao_arch.h
+++ b/src/cc1111/ao_arch.h
@@ -24,9 +24,108 @@
 
 #include "cc1111.h"
 
+/* Convert a __data pointer into an __xdata pointer */
+#define DATA_TO_XDATA(a)       ((void __xdata *) ((uint8_t) (a) | 0xff00))
+
+/* Stack runs from above the allocated __data space to 0xfe, which avoids
+ * writing to 0xff as that triggers the stack overflow indicator
+ */
+#define AO_STACK_START 0x90
+#define AO_STACK_END   0xfe
+#define AO_STACK_SIZE  (AO_STACK_END - AO_STACK_START + 1)
+
 #define ao_arch_reboot() do {                                  \
        WDCTL = WDCTL_EN | WDCTL_MODE_WATCHDOG | WDCTL_INT_64;  \
        ao_delay(AO_SEC_TO_TICKS(2));                           \
        } while (0)
        
+#define ao_arch_nop()  _asm nop _endasm
+#define ao_arch_interrupt(n)   __interrupt n
+
+#define ao_arch_naked_declare  __naked
+#define ao_arch_naked_define   __naked
+
+/* CC1111-specific drivers */
+
+/*
+ * ao_romconfig.c
+ */
+
+#define AO_ROMCONFIG_VERSION   2
+
+extern __code __at (0x00a0) uint16_t ao_romconfig_version;
+extern __code __at (0x00a2) uint16_t ao_romconfig_check;
+extern __code __at (0x00a4) uint16_t ao_serial_number;
+extern __code __at (0x00a6) uint32_t ao_radio_cal;
+
+#ifndef HAS_USB
+#error Please define HAS_USB
+#endif
+
+#if HAS_USB
+extern __code __at (0x00aa) uint8_t ao_usb_descriptors [];
+#endif
+
+/* Initialize stack */
+#define ao_arch_init_stack(task, start) {                      \
+       uint8_t __xdata *stack = task->stack;                   \
+       uint8_t t;                                              \
+       *stack++ = ((uint16_t) start);          /* 0 */         \
+       *stack++ = ((uint16_t) start) >> 8;     /* 1 */         \
+                                                               \
+       /* and the stuff saved by ao_switch */                  \
+       *stack++ = 0;                           /* 2 acc */     \
+       *stack++ = 0x80;                        /* 3 IE */      \
+                                                               \
+       /*  4 DPL                                               \
+        *  5 DPH                                               \
+        *  6 B                                                 \
+        *  7 R2                                                \
+        *  8 R3                                                \
+        *  9 R4                                                \
+        * 10 R5                                                \
+        * 11 R6                                                \
+        * 12 R7                                                \
+        * 13 R0                                                \
+        * 14 R1                                                \
+        * 15 PSW                                               \
+        * 16 BP                                                \
+        */                                                     \
+       for (t = 0; t < 13; t++)                                \
+               *stack++ = 0;                                   \
+       task->stack_count = 17;                                 \
+       }
+
+
+  
+/* Save current context */
+
+#define ao_arch_save_context() \
+       _asm \
+               /* Push ACC first, as when restoring the context it must be restored \
+                * last (it is used to set the IE register). */ \
+               push    ACC \
+               /* Store the IE register then enable interrupts. */ \
+               push    _IEN0 \
+               setb    _EA \
+               push    DPL \
+               push    DPH \
+               push    b \
+               push    ar2 \
+               push    ar3 \
+               push    ar4 \
+               push    ar5 \
+               push    ar6 \
+               push    ar7 \
+               push    ar0 \
+               push    ar1 \
+               push    PSW \
+       _endasm; \
+       PSW = 0; \
+       _asm \
+               push    _bp \
+       _endasm
+
+
+
 #endif /* _AO_ARCH_H_ */