diff options
Diffstat (limited to 'libcpu/arm/arm926/stack.c')
| -rw-r--r-- | libcpu/arm/arm926/stack.c | 7 |
1 files changed, 5 insertions, 2 deletions
diff --git a/libcpu/arm/arm926/stack.c b/libcpu/arm/arm926/stack.c index ba3a11d208..53508e5acf 100644 --- a/libcpu/arm/arm926/stack.c +++ b/libcpu/arm/arm926/stack.c @@ -66,8 +66,11 @@ rt_uint8_t *rt_hw_stack_init(void *tentry, void *parameter, *(--stk) = 0; /* r2 */ *(--stk) = 0; /* r1 */ *(--stk) = (rt_uint32_t)parameter; /* r0 : argument */ - *(--stk) = SVCMODE; /* cpsr */ - *(--stk) = SVCMODE; /* spsr */ + /* cpsr */ + if ((rt_uint32_t)tentry & 0x01) + *(--stk) = SVCMODE | 0x20; /* thumb mode */ + else + *(--stk) = SVCMODE; /* arm mode */ /* return task's current stack address */ return (rt_uint8_t *)stk; |