summaryrefslogtreecommitdiff
path: root/libcpu/nds32
diff options
context:
space:
mode:
Diffstat (limited to 'libcpu/nds32')
-rw-r--r--libcpu/nds32/cpuport.c404
1 files changed, 202 insertions, 202 deletions
diff --git a/libcpu/nds32/cpuport.c b/libcpu/nds32/cpuport.c
index ca1462150c..af113f673b 100644
--- a/libcpu/nds32/cpuport.c
+++ b/libcpu/nds32/cpuport.c
@@ -1,202 +1,202 @@
-/*
- * File : cpuport.c
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License along
- * with this program; if not, write to the Free Software Foundation, Inc.,
- * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
- *
- * Change Logs:
- * Date Author Notes
- * 2017-08-25 Archer first version
- */
-
-#include <rtthread.h>
-
-#include "nds32.h"
-
-/*
- * Initialise the stack of a task to look exactly as if a call to
- * SAVE_CONTEXT had been called.
- *
- * See header file for description.
- *
- *
- * Stack Layout:
- * High |-----------------|
- * | $R5 |
- * |-----------------|
- * | . |
- * | . |
- * |-----------------|
- * | $R0 |
- * |-----------------|
- * | $R30 (LP) |
- * |-----------------|
- * | $R29 (GP) |
- * |-----------------|
- * | $R28 (FP) |
- * |-----------------|
- * | $R15 $R27 |
- * |-----------------|
- * | $R10 $R26 |
- * |-----------------|
- * | . |
- * | . |
- * |-----------------|
- * | $R6 |
- * |-----------------|
- * | $IFC_LP | (Option)
- * |-----------------|
- * | $LC/$LE/$LB | (Option)
- * | (ZOL) |
- * |-----------------|
- * | $IPSW |
- * |-----------------|
- * | $IPC |
- * |-----------------|
- * | Dummy word | (Option, only exist when IFC & ZOL both configured)
- * |-----------------|
- * | $FPU | (Option)
- * |-----------------|
- * Low
- *
- */
-
-struct stack_frame
-{
- rt_uint32_t topOfStack[34];
-};
-
-/* flag in interrupt handling */
-rt_uint32_t rt_interrupt_from_thread, rt_interrupt_to_thread;
-rt_uint32_t rt_thread_switch_interrupt_flag;
-/* exception hook */
-static rt_err_t (*rt_exception_hook)(void *context) = RT_NULL;
-
-rt_base_t rt_hw_interrupt_disable(void)
-{
- rt_base_t level = __nds32__mfsr(NDS32_SR_PSW);
-
- GIE_DISABLE();
-
- return level;
-}
-
-void rt_hw_interrupt_enable(rt_base_t level)
-{
- if (level & PSW_mskGIE)
- GIE_ENABLE();
-}
-
-/* For relax support, must initial $gp at task init*/
-extern uint32_t _SDA_BASE_ __attribute__ ((weak));
-
-/**************************************************************
- * 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_int32_t i;
- rt_uint32_t *pxTopOfStack;
-
- pxTopOfStack = (rt_uint32_t *)RT_ALIGN_DOWN((rt_uint32_t)stack_addr, 4);
-
- /* Simulate the stack frame as it would be created by a context switch */
- /* R0 ~ R5 registers */
- for (i = 5; i >= 1; i--) /* R5, R4, R3, R2 and R1. */
- *--pxTopOfStack = (rt_uint32_t)0x01010101UL * i;
- *--pxTopOfStack = (rt_uint32_t)parameter; /* R0 : Argument */
-
- /* R6 ~ R30 registers */
- *--pxTopOfStack = (rt_uint32_t)texit; /* R30: $LP */
- *--pxTopOfStack = (rt_uint32_t)&_SDA_BASE_; /* R29: $GP */
- *--pxTopOfStack = (rt_uint32_t)0x2828282828; /* R28: $FP */
-#ifdef __NDS32_REDUCE_REGS__
- *--pxTopOfStack = (rt_uint32_t)0x1515151515; /* R15 */
- for (i = 10; i >= 6; i--) /* R10 ~ R6 */
- *--pxTopOfStack = (rt_uint32_t)0x01010101UL * i;
-#else
- for (i = 27; i >= 6; i--) /* R27 ~ R6 */
- *--pxTopOfStack = (rt_uint32_t)0x01010101UL * i;
-#endif
-
- /* IFC system register */
-#ifdef __TARGET_IFC_EXT
- *--pxTopOfStack = (rt_uint32_t)0x0; /* $IFC_LP */
-#endif
-
- /* ZOL system registers */
-#ifdef __TARGET_ZOL_EXT
- *--pxTopOfStack = (rt_uint32_t)0x0; /* $LC */
- *--pxTopOfStack = (rt_uint32_t)0x0; /* $LE */
- *--pxTopOfStack = (rt_uint32_t)0x0; /* $LB */
-#endif
-
- /* IPSW and IPC system registers */
- /* Default IPSW: enable GIE, set CPL to 7, clear IFCON */
- i = (__nds32__mfsr(NDS32_SR_PSW) | PSW_mskGIE | PSW_mskCPL) & ~PSW_mskIFCON;
- *--pxTopOfStack = (rt_uint32_t)i; /* $IPSW */
- *--pxTopOfStack = (rt_uint32_t)tentry; /* $IPC */
-
- /* Dummy word for 8-byte stack alignment */
-#if defined(__TARGET_IFC_EXT) && defined(__TARGET_ZOL_EXT)
- *--pxTopOfStack = (rt_uint32_t)0xFFFFFFFF; /* Dummy */
-#endif
-
- /* FPU registers */
-#ifdef __TARGET_FPU_EXT
- for (i = 0; i < FPU_REGS; i++)
- *--pxTopOfStack = (rt_uint32_t)0x0; /* FPU */
-#endif
-
- return (rt_uint8_t *)pxTopOfStack;
-}
-
-/**
- * This function set the hook, which is invoked on fault exception handling.
- *
- * @param exception_handle the exception handling hook function.
- */
-void rt_hw_exception_install(rt_err_t (*exception_handle)(void* context))
-{
- rt_exception_hook = exception_handle;
-}
-
-#ifdef RT_USING_CPU_FFS
-/**
- * This function finds the first bit set (beginning with the least significant bit)
- * in value and return the index of that bit.
- *
- * Bits are numbered starting at 1 (the least significant bit). A return value of
- * zero from any of these functions means that the argument was zero.
- *
- * @return return the index of the first bit set. If value is 0, then this function
- * shall return 0.
- */
-#if defined(__GNUC__)
-int __rt_ffs(int value)
-{
- return __builtin_ffs(value);
-}
-#endif
-
-#endif
+/*
+ * File : cpuport.c
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ *
+ * Change Logs:
+ * Date Author Notes
+ * 2017-08-25 Archer first version
+ */
+
+#include <rtthread.h>
+
+#include "nds32.h"
+
+/*
+ * Initialise the stack of a task to look exactly as if a call to
+ * SAVE_CONTEXT had been called.
+ *
+ * See header file for description.
+ *
+ *
+ * Stack Layout:
+ * High |-----------------|
+ * | $R5 |
+ * |-----------------|
+ * | . |
+ * | . |
+ * |-----------------|
+ * | $R0 |
+ * |-----------------|
+ * | $R30 (LP) |
+ * |-----------------|
+ * | $R29 (GP) |
+ * |-----------------|
+ * | $R28 (FP) |
+ * |-----------------|
+ * | $R15 $R27 |
+ * |-----------------|
+ * | $R10 $R26 |
+ * |-----------------|
+ * | . |
+ * | . |
+ * |-----------------|
+ * | $R6 |
+ * |-----------------|
+ * | $IFC_LP | (Option)
+ * |-----------------|
+ * | $LC/$LE/$LB | (Option)
+ * | (ZOL) |
+ * |-----------------|
+ * | $IPSW |
+ * |-----------------|
+ * | $IPC |
+ * |-----------------|
+ * | Dummy word | (Option, only exist when IFC & ZOL both configured)
+ * |-----------------|
+ * | $FPU | (Option)
+ * |-----------------|
+ * Low
+ *
+ */
+
+struct stack_frame
+{
+ rt_uint32_t topOfStack[34];
+};
+
+/* flag in interrupt handling */
+rt_uint32_t rt_interrupt_from_thread, rt_interrupt_to_thread;
+rt_uint32_t rt_thread_switch_interrupt_flag;
+/* exception hook */
+static rt_err_t (*rt_exception_hook)(void *context) = RT_NULL;
+
+rt_base_t rt_hw_interrupt_disable(void)
+{
+ rt_base_t level = __nds32__mfsr(NDS32_SR_PSW);
+
+ GIE_DISABLE();
+
+ return level;
+}
+
+void rt_hw_interrupt_enable(rt_base_t level)
+{
+ if (level & PSW_mskGIE)
+ GIE_ENABLE();
+}
+
+/* For relax support, must initial $gp at task init*/
+extern uint32_t _SDA_BASE_ __attribute__ ((weak));
+
+/**************************************************************
+ * 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_int32_t i;
+ rt_uint32_t *pxTopOfStack;
+
+ pxTopOfStack = (rt_uint32_t *)RT_ALIGN_DOWN((rt_uint32_t)stack_addr, 4);
+
+ /* Simulate the stack frame as it would be created by a context switch */
+ /* R0 ~ R5 registers */
+ for (i = 5; i >= 1; i--) /* R5, R4, R3, R2 and R1. */
+ *--pxTopOfStack = (rt_uint32_t)0x01010101UL * i;
+ *--pxTopOfStack = (rt_uint32_t)parameter; /* R0 : Argument */
+
+ /* R6 ~ R30 registers */
+ *--pxTopOfStack = (rt_uint32_t)texit; /* R30: $LP */
+ *--pxTopOfStack = (rt_uint32_t)&_SDA_BASE_; /* R29: $GP */
+ *--pxTopOfStack = (rt_uint32_t)0x2828282828; /* R28: $FP */
+#ifdef __NDS32_REDUCE_REGS__
+ *--pxTopOfStack = (rt_uint32_t)0x1515151515; /* R15 */
+ for (i = 10; i >= 6; i--) /* R10 ~ R6 */
+ *--pxTopOfStack = (rt_uint32_t)0x01010101UL * i;
+#else
+ for (i = 27; i >= 6; i--) /* R27 ~ R6 */
+ *--pxTopOfStack = (rt_uint32_t)0x01010101UL * i;
+#endif
+
+ /* IFC system register */
+#ifdef __TARGET_IFC_EXT
+ *--pxTopOfStack = (rt_uint32_t)0x0; /* $IFC_LP */
+#endif
+
+ /* ZOL system registers */
+#ifdef __TARGET_ZOL_EXT
+ *--pxTopOfStack = (rt_uint32_t)0x0; /* $LC */
+ *--pxTopOfStack = (rt_uint32_t)0x0; /* $LE */
+ *--pxTopOfStack = (rt_uint32_t)0x0; /* $LB */
+#endif
+
+ /* IPSW and IPC system registers */
+ /* Default IPSW: enable GIE, set CPL to 7, clear IFCON */
+ i = (__nds32__mfsr(NDS32_SR_PSW) | PSW_mskGIE | PSW_mskCPL) & ~PSW_mskIFCON;
+ *--pxTopOfStack = (rt_uint32_t)i; /* $IPSW */
+ *--pxTopOfStack = (rt_uint32_t)tentry; /* $IPC */
+
+ /* Dummy word for 8-byte stack alignment */
+#if defined(__TARGET_IFC_EXT) && defined(__TARGET_ZOL_EXT)
+ *--pxTopOfStack = (rt_uint32_t)0xFFFFFFFF; /* Dummy */
+#endif
+
+ /* FPU registers */
+#ifdef __TARGET_FPU_EXT
+ for (i = 0; i < FPU_REGS; i++)
+ *--pxTopOfStack = (rt_uint32_t)0x0; /* FPU */
+#endif
+
+ return (rt_uint8_t *)pxTopOfStack;
+}
+
+/**
+ * This function set the hook, which is invoked on fault exception handling.
+ *
+ * @param exception_handle the exception handling hook function.
+ */
+void rt_hw_exception_install(rt_err_t (*exception_handle)(void* context))
+{
+ rt_exception_hook = exception_handle;
+}
+
+#ifdef RT_USING_CPU_FFS
+/**
+ * This function finds the first bit set (beginning with the least significant bit)
+ * in value and return the index of that bit.
+ *
+ * Bits are numbered starting at 1 (the least significant bit). A return value of
+ * zero from any of these functions means that the argument was zero.
+ *
+ * @return return the index of the first bit set. If value is 0, then this function
+ * shall return 0.
+ */
+#if defined(__GNUC__)
+int __rt_ffs(int value)
+{
+ return __builtin_ffs(value);
+}
+#endif
+
+#endif
generated by cgit v1.3.1 (git 2.54.0) at 2026-10-30 18:35:12 +0000