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 */ 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