-#define cli() asm("cpsid i")
-#define sei() asm("cpsie i")
-
-#define ao_arch_init_stack(task, start) do { \
- uint32_t *sp = (uint32_t *) (task->stack + AO_STACK_SIZE); \
- uint16_t a = (uint16_t) start; \
- int i; \
- \
- /* Return address */ \
- ARM_PUSH32(sp, a); \
- \
- /* Invalid link register */ \
- ARM_PUSH32(sp, 0xffffffff); \
- \
- /* Clear register values */ \
- i = 13; \
- while (i--) \
- ARM_PUSH32(sp, 0); \
- \
- /* PSR with interrupts enabled */ \
- ARM_PUSH32(sp, 0x01000000); \
- task->sp = sp; \
-} while (0);
-
-#define ao_arch_save_regs() do { \
- asm("push {r0-r12,lr}\n"); \
- cli(); \
- asm("mrs r0,psr" "\n\t" "push {r0}"); \
- sei(); \
- } while (0)
-
-#define ao_arch_save_stack() do { \
- uint32_t sp; \
- asm("mov %0,sp" : "=&r" (sp) ); \
- ao_cur_task->sp = (uint32_t *) (sp); \
- } while (0)
-
-#define ao_arch_isr_stack() /* nothing */
-
-#define ao_arch_cpu_idle() do { \
- asm("wfi"); \
- } while (0)
-
-#define ao_arch_restore_stack() do { \
- uint32_t sp; \
- sp = (uint32_t) ao_cur_task->sp; \
- cli(); \
- asm("mov sp, %0" : : "r" (sp) ); \
- asm("pop {r0}" "\n\t" "msr psr,r0"); \
- asm("pop {r0-r12,lr}\n"); \
- asm("bx lr"); \
- } while(0)
-
-#define ao_arch_critical(b) do { cli(); do { b } while (0); sei(); } while (0)
-
-#define AO_ARM_NUM_ADC 12
-
-struct ao_adc {
- uint16_t tick; /* tick when the sample was read */
- uint16_t adc[AO_ARM_NUM_ADC]; /* samples */
-};