/*
 * File      : stack.c
 * This file is part of RT-Thread RTOS
 * COPYRIGHT (C) 2009, RT-Thread Development Team
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
 * http://www.rt-thread.org/license/LICENSE
 *
 * Change Logs:
 * Date           Author       Notes
 * 2010-06-29     lgnq         the first version
 *
 * For       : NEC V850E
 * Toolchain : IAR Embedded Workbench for V850 v3.71
*/

#include <rtthread.h>

/**
 * This function will initialize thread stack
 *
 * @param tentry the entry of thread
 * @param parameter the parameter of entry
 * @param stack_addr the beginning stack address
 * @param texit the function will be called when thread exit
 *
 * @return stack address
 */
rt_uint8_t *rt_hw_stack_init(void *tentry, void *parameter, rt_uint8_t *stack_addr, void *texit)
{
    rt_uint32_t *stk;     
   
    stk    = (rt_uint32_t *)stack_addr;          /* Load stack pointer                                      */   
    *(--stk) = (rt_uint32_t) 0x23232323;         /* r23 */   
    *(--stk) = (rt_uint32_t) 0x24242424;         /* r24 */   
    *(--stk) = (rt_uint32_t) 0x25252525;         /* r25 */   
    *(--stk) = (rt_uint32_t) 0x26262626;         /* r26 */   
    *(--stk) = (rt_uint32_t) 0x27272727;         /* r27 */   
    *(--stk) = (rt_uint32_t) 0x28282828;         /* r28 */   
    *(--stk) = (rt_uint32_t) 0x29292929;         /* r29 */   
    *(--stk) = (rt_uint32_t) 0x30303030;         /* r30 */   
    *(--stk) = (rt_uint32_t) 0x31313131;         /* r31 */   
    *(--stk) = (rt_uint32_t) 0x00000000;         /* Task PSW = Interrupts enabled                                 */   
    *(--stk) = (rt_uint32_t) tentry;             /* Task's PC */   
    *(--stk) = (rt_uint32_t) 0x16161616;         /* r16 */   
    *(--stk) = (rt_uint32_t) 0x15151515;         /* r15 */   
    *(--stk) = (rt_uint32_t) 0x14141414;         /* r14 */   
    *(--stk) = (rt_uint32_t) 0x13131313;         /* r13 */   
    *(--stk) = (rt_uint32_t) 0x12121212;         /* r12 */   
    *(--stk) = (rt_uint32_t) 0x11111111;         /* r11 */   
    *(--stk) = (rt_uint32_t) 0x10101010;         /* r10 */   
    *(--stk) = (rt_uint32_t) 0x09090909;         /* r9 */   
    *(--stk) = (rt_uint32_t) 0x08080808;         /* r8 */   
    *(--stk) = (rt_uint32_t) 0x07070707;         /* r7 */   
    *(--stk) = (rt_uint32_t) 0x06060606;         /* r6 */   
    *(--stk) = (rt_uint32_t) 0x05050505;         /* r5 */   
    *(--stk) = (rt_uint32_t) 0x02020202;         /* r2 */   
    *(--stk) = (rt_uint32_t) parameter;          /* r1 */   
    return ((rt_uint8_t *)stk); 
}