1 /*
2 * File : stack.c
3 * COPYRIGHT (C) 2008 - 2016, RT-Thread Development Team
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 * Change Logs:
20 * Date Author Notes
21 * 2010-05-17 swkyer first version
22 * 2010-07-07 Bernard porting to Ingenic CPU
23 */
24 #include <rtthread.h>
25
26 /**
27 * @addtogroup Ingenic
28 */
29 /*@{*/
30
31 extern rt_uint32_t cp0_get_cause(void);
32 extern rt_uint32_t cp0_get_status(void);
33 extern rt_uint32_t cp0_get_hi(void);
34 extern rt_uint32_t cp0_get_lo(void);
35
36 /**
37 * This function will initialize thread stack
38 *
39 * @param tentry the entry of thread
40 * @param parameter the parameter of entry
41 * @param stack_addr the beginning stack address
42 * @param texit the function will be called when thread exit
43 *
44 * @return stack address
45 */
rt_hw_stack_init(void * tentry,void * parameter,rt_uint8_t * stack_addr,void * texit)46 rt_uint8_t *rt_hw_stack_init(void *tentry, void *parameter, rt_uint8_t *stack_addr, void *texit)
47 {
48 rt_uint32_t *stk;
49 static rt_uint32_t g_sr = 0;
50
51 if (g_sr == 0)
52 {
53 g_sr = cp0_get_status();
54 g_sr &= 0xfffffffe;
55 g_sr |= 0x0403;
56 }
57
58 /** Start at stack top */
59 stk = (rt_uint32_t *)stack_addr;
60 *(stk) = (rt_uint32_t) tentry; /* pc: Entry Point */
61 *(--stk) = (rt_uint32_t) 0xeeee; /* c0_cause */
62 *(--stk) = (rt_uint32_t) 0xffff; /* c0_badvaddr */
63 *(--stk) = (rt_uint32_t) cp0_get_lo(); /* lo */
64 *(--stk) = (rt_uint32_t) cp0_get_hi(); /* hi */
65 *(--stk) = (rt_uint32_t) g_sr; /* C0_SR: HW2 = En, IE = En */
66 *(--stk) = (rt_uint32_t) texit; /* ra */
67 *(--stk) = (rt_uint32_t) 0x0000001e; /* s8 */
68 *(--stk) = (rt_uint32_t) stack_addr; /* sp */
69 *(--stk) = (rt_uint32_t) 0x0000001c; /* gp */
70 *(--stk) = (rt_uint32_t) 0x0000001b; /* k1 */
71 *(--stk) = (rt_uint32_t) 0x0000001a; /* k0 */
72 *(--stk) = (rt_uint32_t) 0x00000019; /* t9 */
73 *(--stk) = (rt_uint32_t) 0x00000018; /* t8 */
74 *(--stk) = (rt_uint32_t) 0x00000017; /* s7 */
75 *(--stk) = (rt_uint32_t) 0x00000016; /* s6 */
76 *(--stk) = (rt_uint32_t) 0x00000015; /* s5 */
77 *(--stk) = (rt_uint32_t) 0x00000014; /* s4 */
78 *(--stk) = (rt_uint32_t) 0x00000013; /* s3 */
79 *(--stk) = (rt_uint32_t) 0x00000012; /* s2 */
80 *(--stk) = (rt_uint32_t) 0x00000011; /* s1 */
81 *(--stk) = (rt_uint32_t) 0x00000010; /* s0 */
82 *(--stk) = (rt_uint32_t) 0x0000000f; /* t7 */
83 *(--stk) = (rt_uint32_t) 0x0000000e; /* t6 */
84 *(--stk) = (rt_uint32_t) 0x0000000d; /* t5 */
85 *(--stk) = (rt_uint32_t) 0x0000000c; /* t4 */
86 *(--stk) = (rt_uint32_t) 0x0000000b; /* t3 */
87 *(--stk) = (rt_uint32_t) 0x0000000a; /* t2 */
88 *(--stk) = (rt_uint32_t) 0x00000009; /* t1 */
89 *(--stk) = (rt_uint32_t) 0x00000008; /* t0 */
90 *(--stk) = (rt_uint32_t) 0x00000007; /* a3 */
91 *(--stk) = (rt_uint32_t) 0x00000006; /* a2 */
92 *(--stk) = (rt_uint32_t) 0x00000005; /* a1 */
93 *(--stk) = (rt_uint32_t) parameter; /* a0 */
94 *(--stk) = (rt_uint32_t) 0x00000003; /* v1 */
95 *(--stk) = (rt_uint32_t) 0x00000002; /* v0 */
96 *(--stk) = (rt_uint32_t) 0x00000001; /* at */
97 *(--stk) = (rt_uint32_t) 0x00000000; /* zero */
98
99 /* return task's current stack address */
100 return (rt_uint8_t *)stk;
101 }
102
103 /*@}*/
104