xref: /nrf52832-nimble/rt-thread/libcpu/arm/am335x/stack.c (revision 104654410c56c573564690304ae786df310c91fc)
1*10465441SEvalZero /*
2*10465441SEvalZero  * Copyright (c) 2006-2018, RT-Thread Development Team
3*10465441SEvalZero  *
4*10465441SEvalZero  * SPDX-License-Identifier: Apache-2.0
5*10465441SEvalZero  *
6*10465441SEvalZero  * Change Logs:
7*10465441SEvalZero  * Date           Author       Notes
8*10465441SEvalZero  * 2011-09-23     Bernard      the first version
9*10465441SEvalZero  * 2011-10-05     Bernard      add thumb mode
10*10465441SEvalZero  */
11*10465441SEvalZero #include <rtthread.h>
12*10465441SEvalZero #include "am33xx.h"
13*10465441SEvalZero 
14*10465441SEvalZero /**
15*10465441SEvalZero  * @addtogroup AM33xx
16*10465441SEvalZero  */
17*10465441SEvalZero /*@{*/
18*10465441SEvalZero 
19*10465441SEvalZero /**
20*10465441SEvalZero  * This function will initialize thread stack
21*10465441SEvalZero  *
22*10465441SEvalZero  * @param tentry the entry of thread
23*10465441SEvalZero  * @param parameter the parameter of entry
24*10465441SEvalZero  * @param stack_addr the beginning stack address
25*10465441SEvalZero  * @param texit the function will be called when thread exit
26*10465441SEvalZero  *
27*10465441SEvalZero  * @return stack address
28*10465441SEvalZero  */
rt_hw_stack_init(void * tentry,void * parameter,rt_uint8_t * stack_addr,void * texit)29*10465441SEvalZero rt_uint8_t *rt_hw_stack_init(void *tentry, void *parameter,
30*10465441SEvalZero                              rt_uint8_t *stack_addr, void *texit)
31*10465441SEvalZero {
32*10465441SEvalZero     rt_uint32_t *stk;
33*10465441SEvalZero 
34*10465441SEvalZero     stack_addr += sizeof(rt_uint32_t);
35*10465441SEvalZero     stack_addr  = (rt_uint8_t *)RT_ALIGN_DOWN((rt_uint32_t)stack_addr, 8);
36*10465441SEvalZero     stk      = (rt_uint32_t *)stack_addr;
37*10465441SEvalZero 
38*10465441SEvalZero     *(--stk) = (rt_uint32_t)tentry;         /* entry point */
39*10465441SEvalZero     *(--stk) = (rt_uint32_t)texit;          /* lr */
40*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r12 */
41*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r11 */
42*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r10 */
43*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r9 */
44*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r8 */
45*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r7 */
46*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r6 */
47*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r5 */
48*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r4 */
49*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r3 */
50*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r2 */
51*10465441SEvalZero     *(--stk) = 0xdeadbeef;                  /* r1 */
52*10465441SEvalZero     *(--stk) = (rt_uint32_t)parameter;      /* r0 : argument */
53*10465441SEvalZero 
54*10465441SEvalZero     /* cpsr */
55*10465441SEvalZero     if ((rt_uint32_t)tentry & 0x01)
56*10465441SEvalZero         *(--stk) = SVCMODE | 0x20;          /* thumb mode */
57*10465441SEvalZero     else
58*10465441SEvalZero         *(--stk) = SVCMODE;                 /* arm mode   */
59*10465441SEvalZero 
60*10465441SEvalZero     /* return task's current stack address */
61*10465441SEvalZero     return (rt_uint8_t *)stk;
62*10465441SEvalZero }
63*10465441SEvalZero 
64*10465441SEvalZero /*@}*/
65