121 lines
4.3 KiB
C
121 lines
4.3 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Change Logs:
|
||
|
|
* Date Author Notes
|
||
|
|
* 2021-11-16 Dystopia the first version
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <rtthread.h>
|
||
|
|
#include <c66xx.h>
|
||
|
|
|
||
|
|
extern rt_uint32_t rt_hw_get_current_dp(void);
|
||
|
|
|
||
|
|
/**
|
||
|
|
* @addtogroup C66xx
|
||
|
|
*/
|
||
|
|
/*@{*/
|
||
|
|
|
||
|
|
/**
|
||
|
|
* 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_hw_thread_stack_register *thread_context = RT_NULL;
|
||
|
|
rt_uint32_t stk = 0;
|
||
|
|
|
||
|
|
stack_addr += sizeof(rt_uint32_t);
|
||
|
|
stack_addr = (rt_uint8_t *)RT_ALIGN_DOWN((rt_uint32_t)stack_addr, 8);
|
||
|
|
stk = (rt_uint32_t)stack_addr;
|
||
|
|
thread_context = (rt_hw_thread_stack_register *)(stk - sizeof(rt_hw_thread_stack_register));
|
||
|
|
|
||
|
|
thread_context->pc = (rt_uint32_t)tentry;
|
||
|
|
thread_context->csr = 0x0103;
|
||
|
|
thread_context->tsr = 0x3;
|
||
|
|
thread_context->orig_a4 = 1;
|
||
|
|
thread_context->ilc = 0;
|
||
|
|
thread_context->rilc = 0;
|
||
|
|
|
||
|
|
thread_context->hw_register.b17 = 0xB17;
|
||
|
|
thread_context->hw_register.b16 = 0xB16;
|
||
|
|
thread_context->hw_register.b19 = 0xB19;
|
||
|
|
thread_context->hw_register.b18 = 0xB18;
|
||
|
|
thread_context->hw_register.b21 = 0xB21;
|
||
|
|
thread_context->hw_register.b20 = 0xB20;
|
||
|
|
thread_context->hw_register.b23 = 0xB23;
|
||
|
|
thread_context->hw_register.b22 = 0xB22;
|
||
|
|
thread_context->hw_register.b25 = 0xB25;
|
||
|
|
thread_context->hw_register.b24 = 0xB24;
|
||
|
|
thread_context->hw_register.b27 = 0xB27;
|
||
|
|
thread_context->hw_register.b26 = 0xB26;
|
||
|
|
thread_context->hw_register.b29 = 0xB29;
|
||
|
|
thread_context->hw_register.b28 = 0xB28;
|
||
|
|
thread_context->hw_register.b31 = 0xB31;
|
||
|
|
thread_context->hw_register.b30 = 0xB30;
|
||
|
|
|
||
|
|
thread_context->hw_register.b1 = 0xB01;
|
||
|
|
thread_context->hw_register.b0 = 0xB00;
|
||
|
|
thread_context->hw_register.b3 = (rt_uint32_t)texit;
|
||
|
|
thread_context->hw_register.b2 = 0xB02;
|
||
|
|
thread_context->hw_register.b5 = 0xB05;
|
||
|
|
thread_context->hw_register.b4 = 0xB04;
|
||
|
|
thread_context->hw_register.b7 = 0xB07;
|
||
|
|
thread_context->hw_register.b6 = 0xB06;
|
||
|
|
thread_context->hw_register.b9 = 0xB09;
|
||
|
|
thread_context->hw_register.b8 = 0xB08;
|
||
|
|
thread_context->hw_register.b11 = 0xB11;
|
||
|
|
thread_context->hw_register.b10 = 0xB10;
|
||
|
|
thread_context->hw_register.b13 = 0xB13;
|
||
|
|
thread_context->hw_register.b12 = 0xB12;
|
||
|
|
|
||
|
|
thread_context->hw_register.a17 = 0xA17;
|
||
|
|
thread_context->hw_register.a16 = 0xA16;
|
||
|
|
thread_context->hw_register.a19 = 0xA19;
|
||
|
|
thread_context->hw_register.a18 = 0xA18;
|
||
|
|
thread_context->hw_register.a21 = 0xA21;
|
||
|
|
thread_context->hw_register.a20 = 0xA20;
|
||
|
|
thread_context->hw_register.a23 = 0xA23;
|
||
|
|
thread_context->hw_register.a22 = 0xA22;
|
||
|
|
thread_context->hw_register.a25 = 0xA25;
|
||
|
|
thread_context->hw_register.a24 = 0xA24;
|
||
|
|
thread_context->hw_register.a27 = 0xA27;
|
||
|
|
thread_context->hw_register.a26 = 0xA26;
|
||
|
|
thread_context->hw_register.a29 = 0xA29;
|
||
|
|
thread_context->hw_register.a28 = 0xA28;
|
||
|
|
thread_context->hw_register.a31 = 0xA31;
|
||
|
|
thread_context->hw_register.a30 = 0xA30;
|
||
|
|
|
||
|
|
thread_context->hw_register.a1 = 0xA01;
|
||
|
|
thread_context->hw_register.a0 = 0xA00;
|
||
|
|
thread_context->hw_register.a3 = 0xA03;
|
||
|
|
thread_context->hw_register.a2 = 0xA02;
|
||
|
|
thread_context->hw_register.a5 = 0xA05;
|
||
|
|
thread_context->hw_register.a4 = (rt_uint32_t)parameter;
|
||
|
|
thread_context->hw_register.a7 = 0xA07;
|
||
|
|
thread_context->hw_register.a6 = 0xA06;
|
||
|
|
thread_context->hw_register.a9 = 0xA09;
|
||
|
|
thread_context->hw_register.a8 = 0xA08;
|
||
|
|
thread_context->hw_register.a11 = 0xA11;
|
||
|
|
thread_context->hw_register.a10 = 0xA10;
|
||
|
|
thread_context->hw_register.a13 = 0xA13;
|
||
|
|
thread_context->hw_register.a12 = 0xA12;
|
||
|
|
|
||
|
|
thread_context->hw_register.a15 = 0xA15;
|
||
|
|
thread_context->hw_register.a14 = 0xA14;
|
||
|
|
thread_context->hw_register.dp = rt_hw_get_current_dp();
|
||
|
|
thread_context->hw_register.sp = (rt_uint32_t)stk;
|
||
|
|
|
||
|
|
/* return task's current stack address */
|
||
|
|
return (rt_uint8_t *)thread_context - 8;
|
||
|
|
}
|