X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fcpu%2Fframe.h;h=63d341cf1db379d159d3f4b0d99e162ece2a9e5f;hb=fb5863ca8d0db3ff2e84721f7c902b031157ebb0;hp=117667e45e1f855a76f8ad1f0c1e740e15101b7b;hpb=40896f7f61cb41a2bac0ceb519e5022e84e22c93;p=bertos.git diff --git a/bertos/cpu/frame.h b/bertos/cpu/frame.h index 117667e4..63d341cf 100644 --- a/bertos/cpu/frame.h +++ b/bertos/cpu/frame.h @@ -174,36 +174,25 @@ } #define asm_switch_context cm3_preempt_switch_context - #define CPU_PUSH_CALL_FRAME(sp, func) \ - do { \ - CPU_PUSH_WORD((sp), 0x01000000); /* xPSR */ \ - CPU_PUSH_WORD((sp), (cpu_stack_t)(func)); /* pc */ \ - CPU_PUSH_WORD((sp), 0); /* lr */ \ - CPU_PUSH_WORD((sp), 0); /* ip */ \ - CPU_PUSH_WORD((sp), 0); /* r3 */ \ - CPU_PUSH_WORD((sp), 0); /* r2 */ \ - CPU_PUSH_WORD((sp), 0); /* r1 */ \ - CPU_PUSH_WORD((sp), 0); /* r0 */ \ - CPU_PUSH_WORD((sp), 0xfffffffd); /* lr_exc */ \ - } while (0); - #define CPU_CREATE_NEW_STACK(stack) \ do { \ size_t i; \ /* Initialize process stack frame */ \ - CPU_PUSH_CALL_FRAME(stack, proc_entry); \ + CPU_PUSH_WORD((stack), 0x01000000); /* xPSR */ \ + CPU_PUSH_WORD((stack), (cpu_stack_t)proc_entry); /* pc */ \ + CPU_PUSH_WORD((stack), 0); /* lr */ \ + CPU_PUSH_WORD((stack), 0); /* ip */ \ + CPU_PUSH_WORD((stack), 0); /* r3 */ \ + CPU_PUSH_WORD((stack), 0); /* r2 */ \ + CPU_PUSH_WORD((stack), 0); /* r1 */ \ + CPU_PUSH_WORD((stack), 0); /* r0 */ \ + CPU_PUSH_WORD((stack), 0xfffffffd); /* lr_exc */ \ /* Push a clean set of CPU registers for asm_switch_context() */ \ for (i = 0; i < CPU_SAVED_REGS_CNT; i++) \ CPU_PUSH_WORD(stack, CPU_REG_INIT_VALUE(i)); \ CPU_PUSH_WORD(stack, IRQ_PRIO_DISABLED); \ } while (0) - #else /* !CONFIG_KERN_PREEMPT */ - #define CPU_PUSH_CALL_FRAME(sp, func) \ - do { \ - CPU_PUSH_WORD((sp), 0x01000000); /* xPSR */ \ - CPU_PUSH_WORD((sp), (cpu_stack_t)(func)); /* pc */ \ - } while (0); #endif /* CONFIG_KERN_PREEMPT */ #elif CPU_AVR @@ -251,7 +240,9 @@ CPU_PUSH_WORD((sp), 0); /* CR -> 4(SP) */ \ } while (0) -#else +#endif + +#ifndef CPU_PUSH_CALL_FRAME #define CPU_PUSH_CALL_FRAME(sp, func) \ CPU_PUSH_WORD((sp), (cpu_stack_t)(func)) #endif