原始版本

RT_Thread/libcpu/aarch64/common/stack.c

@@ -0,0 +1,63 @@
+/*
+ * 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;
+}