64 lines
2.1 KiB
C
64 lines
2.1 KiB
C
/*
|
|
* Copyright (c) 2006-2023, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2021-05-12 RT-Thread init
|
|
* 2023-07-13 GuEe-GUI append fpu: Q16 ~ Q31
|
|
*/
|
|
#include <board.h>
|
|
#include <rtthread.h>
|
|
#include <cpuport.h>
|
|
|
|
#include <armv8.h>
|
|
|
|
#define INITIAL_SPSR_EL1 (PSTATE_EL1 | SP_ELx)
|
|
|
|
/**
|
|
* 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_ubase_t *stk;
|
|
|
|
/* The AAPCS64 requires 128-bit (16 byte) stack alignment */
|
|
stk = (rt_ubase_t*)RT_ALIGN_DOWN((rt_ubase_t)stack_addr, 16);
|
|
|
|
for (int i = 0; i < 32; ++i)
|
|
{
|
|
stk -= sizeof(rt_uint128_t) / sizeof(rt_ubase_t);
|
|
|
|
*(rt_uint128_t *)stk = (rt_uint128_t) { 0 };
|
|
}
|
|
|
|
*(--stk) = (rt_ubase_t)texit; /* X20, 2nd param */
|
|
*(--stk) = (rt_ubase_t)tentry; /* X19, 1st param */
|
|
*(--stk) = (rt_ubase_t)22; /* X22 */
|
|
*(--stk) = (rt_ubase_t)parameter; /* X21, 3rd param */
|
|
*(--stk) = (rt_ubase_t)24; /* X24 */
|
|
*(--stk) = (rt_ubase_t)23; /* X23 */
|
|
*(--stk) = (rt_ubase_t)26; /* X26 */
|
|
*(--stk) = (rt_ubase_t)25; /* X25 */
|
|
*(--stk) = (rt_ubase_t)28; /* X28 */
|
|
*(--stk) = (rt_ubase_t)27; /* X27 */
|
|
*(--stk) = (rt_ubase_t)0; /* sp_el0 */
|
|
*(--stk) = (rt_ubase_t)0; /* X29 - addr 0 as AAPCS64 specified */
|
|
*(--stk) = (rt_ubase_t)0; /* FPSR */
|
|
*(--stk) = (rt_ubase_t)0; /* FPCR */
|
|
*(--stk) = INITIAL_SPSR_EL1; /* Save Processor States */
|
|
*(--stk) = (rt_ubase_t)_thread_start; /* Exception return address. */
|
|
|
|
/* return task's current stack address */
|
|
return (rt_uint8_t *)stk;
|
|
}
|