123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637 |
- #ifndef __CORE_CMFUNC_H
- #define __CORE_CMFUNC_H
- #if defined ( __CC_ARM )
- #if (__ARMCC_VERSION < 400677)
- #error "Please use ARM Compiler Toolchain V4.0.677 or later!"
- #endif
- __STATIC_INLINE uint32_t __get_CONTROL(void)
- {
- register uint32_t __regControl __ASM("control");
- return(__regControl);
- }
- __STATIC_INLINE void __set_CONTROL(uint32_t control)
- {
- register uint32_t __regControl __ASM("control");
- __regControl = control;
- }
- __STATIC_INLINE uint32_t __get_IPSR(void)
- {
- register uint32_t __regIPSR __ASM("ipsr");
- return(__regIPSR);
- }
- __STATIC_INLINE uint32_t __get_APSR(void)
- {
- register uint32_t __regAPSR __ASM("apsr");
- return(__regAPSR);
- }
- __STATIC_INLINE uint32_t __get_xPSR(void)
- {
- register uint32_t __regXPSR __ASM("xpsr");
- return(__regXPSR);
- }
- __STATIC_INLINE uint32_t __get_PSP(void)
- {
- register uint32_t __regProcessStackPointer __ASM("psp");
- return(__regProcessStackPointer);
- }
- __STATIC_INLINE void __set_PSP(uint32_t topOfProcStack)
- {
- register uint32_t __regProcessStackPointer __ASM("psp");
- __regProcessStackPointer = topOfProcStack;
- }
- __STATIC_INLINE uint32_t __get_MSP(void)
- {
- register uint32_t __regMainStackPointer __ASM("msp");
- return(__regMainStackPointer);
- }
- __STATIC_INLINE void __set_MSP(uint32_t topOfMainStack)
- {
- register uint32_t __regMainStackPointer __ASM("msp");
- __regMainStackPointer = topOfMainStack;
- }
- __STATIC_INLINE uint32_t __get_PRIMASK(void)
- {
- register uint32_t __regPriMask __ASM("primask");
- return(__regPriMask);
- }
- __STATIC_INLINE void __set_PRIMASK(uint32_t priMask)
- {
- register uint32_t __regPriMask __ASM("primask");
- __regPriMask = (priMask);
- }
- #if (__CORTEX_M >= 0x03) || (__CORTEX_SC >= 300)
- #define __enable_fault_irq __enable_fiq
- #define __disable_fault_irq __disable_fiq
- __STATIC_INLINE uint32_t __get_BASEPRI(void)
- {
- register uint32_t __regBasePri __ASM("basepri");
- return(__regBasePri);
- }
- __STATIC_INLINE void __set_BASEPRI(uint32_t basePri)
- {
- register uint32_t __regBasePri __ASM("basepri");
- __regBasePri = (basePri & 0xff);
- }
- __STATIC_INLINE uint32_t __get_FAULTMASK(void)
- {
- register uint32_t __regFaultMask __ASM("faultmask");
- return(__regFaultMask);
- }
- __STATIC_INLINE void __set_FAULTMASK(uint32_t faultMask)
- {
- register uint32_t __regFaultMask __ASM("faultmask");
- __regFaultMask = (faultMask & (uint32_t)1);
- }
- #endif
- #if (__CORTEX_M == 0x04) || (__CORTEX_M == 0x07)
- __STATIC_INLINE uint32_t __get_FPSCR(void)
- {
- #if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
- register uint32_t __regfpscr __ASM("fpscr");
- return(__regfpscr);
- #else
- return(0);
- #endif
- }
- __STATIC_INLINE void __set_FPSCR(uint32_t fpscr)
- {
- #if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
- register uint32_t __regfpscr __ASM("fpscr");
- __regfpscr = (fpscr);
- #endif
- }
- #endif
- #elif defined ( __GNUC__ )
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __enable_irq(void)
- {
- __ASM volatile ("cpsie i" : : : "memory");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __disable_irq(void)
- {
- __ASM volatile ("cpsid i" : : : "memory");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_CONTROL(void)
- {
- uint32_t result;
- __ASM volatile ("MRS %0, control" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __set_CONTROL(uint32_t control)
- {
- __ASM volatile ("MSR control, %0" : : "r" (control) : "memory");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_IPSR(void)
- {
- uint32_t result;
- __ASM volatile ("MRS %0, ipsr" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_APSR(void)
- {
- uint32_t result;
- __ASM volatile ("MRS %0, apsr" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_xPSR(void)
- {
- uint32_t result;
- __ASM volatile ("MRS %0, xpsr" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_PSP(void)
- {
- register uint32_t result;
- __ASM volatile ("MRS %0, psp\n" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __set_PSP(uint32_t topOfProcStack)
- {
- __ASM volatile ("MSR psp, %0\n" : : "r" (topOfProcStack) : "sp");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_MSP(void)
- {
- register uint32_t result;
- __ASM volatile ("MRS %0, msp\n" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __set_MSP(uint32_t topOfMainStack)
- {
- __ASM volatile ("MSR msp, %0\n" : : "r" (topOfMainStack) : "sp");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_PRIMASK(void)
- {
- uint32_t result;
- __ASM volatile ("MRS %0, primask" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __set_PRIMASK(uint32_t priMask)
- {
- __ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
- }
- #if (__CORTEX_M >= 0x03)
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __enable_fault_irq(void)
- {
- __ASM volatile ("cpsie f" : : : "memory");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __disable_fault_irq(void)
- {
- __ASM volatile ("cpsid f" : : : "memory");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_BASEPRI(void)
- {
- uint32_t result;
- __ASM volatile ("MRS %0, basepri_max" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __set_BASEPRI(uint32_t value)
- {
- __ASM volatile ("MSR basepri, %0" : : "r" (value) : "memory");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_FAULTMASK(void)
- {
- uint32_t result;
- __ASM volatile ("MRS %0, faultmask" : "=r" (result) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __set_FAULTMASK(uint32_t faultMask)
- {
- __ASM volatile ("MSR faultmask, %0" : : "r" (faultMask) : "memory");
- }
- #endif
- #if (__CORTEX_M == 0x04) || (__CORTEX_M == 0x07)
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __get_FPSCR(void)
- {
- #if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
- uint32_t result;
-
- __ASM volatile ("");
- __ASM volatile ("VMRS %0, fpscr" : "=r" (result) );
- __ASM volatile ("");
- return(result);
- #else
- return(0);
- #endif
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __set_FPSCR(uint32_t fpscr)
- {
- #if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
-
- __ASM volatile ("");
- __ASM volatile ("VMSR fpscr, %0" : : "r" (fpscr) : "vfpcc");
- __ASM volatile ("");
- #endif
- }
- #endif
- #elif defined ( __ICCARM__ )
- #include <cmsis_iar.h>
- #elif defined ( __TMS470__ )
- #include <cmsis_ccs.h>
- #elif defined ( __TASKING__ )
- #elif defined ( __CSMC__ )
- #include <cmsis_csm.h>
- #endif
- #endif
|