libs/rt-thread
libs
/
rt-thread
4
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

[libcpu] code cleanup for nds32.

This commit is contained in:
bernard 2017-10-09 18:06:58 +08:00
parent 9373766b96
commit f8a1bf6fd8
1 changed files with 202 additions and 202 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

404
libcpu/nds32/cpuport.c
View File

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