diff --git a/libcpu/arm/armv6/stack.c b/libcpu/arm/armv6/stack.c
index ceb04f0985..d84bb60d39 100644
--- a/libcpu/arm/armv6/stack.c
+++ b/libcpu/arm/armv6/stack.c
@@ -50,8 +50,10 @@ rt_uint8_t *rt_hw_stack_init(void *tentry, void *parameter,
 {
 	rt_uint32_t *stk;
 
+	stack_addr += sizeof(rt_uint32_t);
+	stack_addr  = (rt_uint8_t *)RT_ALIGN_DOWN((rt_uint32_t)stack_addr, 8);
 	stk 	 = (rt_uint32_t*)stack_addr;
-	*(stk) 	 = (rt_uint32_t)tentry;			/* entry point */
+	*(--stk) 	 = (rt_uint32_t)tentry;			/* entry point */
 	*(--stk) = (rt_uint32_t)texit;			/* lr */
 	*(--stk) = 0;							/* r12 */
 	*(--stk) = 0;							/* r11 */