/*
 * File      : cpuport.c
 * This file is part of RT-Thread RTOS
 * COPYRIGHT (C) 2009 - 2011, 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
 * 2011-02-23     Bernard      the first version
 */

#include <rtthread.h>

extern volatile rt_uint8_t rt_interrupt_nest;

/* switch flag on interrupt and thread pointer to save switch record */
rt_uint32_t rt_interrupt_from_thread;
rt_uint32_t rt_interrupt_to_thread;
rt_uint32_t rt_thread_switch_interrupt_flag;

/**
 * This function will initialize hardware interrupt
 */
void rt_hw_interrupt_init(void)
{
    /* init interrupt nest, and context in thread sp */
    rt_interrupt_nest = 0;
    rt_interrupt_from_thread = 0;
    rt_interrupt_to_thread = 0;
    rt_thread_switch_interrupt_flag = 0;
}

/**
 * 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); 
}

void rt_hw_context_switch(rt_uint32_t from, rt_uint32_t to)
{
    rt_interrupt_from_thread = from;
    rt_interrupt_to_thread = to;
    asm("trap 0x10");    
}

void rt_hw_context_switch_interrupt(rt_uint32_t from, rt_uint32_t to)
{
    if (rt_thread_switch_interrupt_flag != 1)
    {
        rt_thread_switch_interrupt_flag = 1;
        rt_interrupt_from_thread = from;        
    }
    rt_interrupt_to_thread = to;  
}