123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687 |
- #ifndef __CORE_CMINSTR_H
- #define __CORE_CMINSTR_H
- #if defined ( __CC_ARM )
- #if (__ARMCC_VERSION < 400677)
- #error "Please use ARM Compiler Toolchain V4.0.677 or later!"
- #endif
- #define __NOP __nop
- #define __WFI __wfi
- #define __WFE __wfe
- #define __SEV __sev
- #define __ISB() __isb(0xF)
- #define __DSB() __dsb(0xF)
- #define __DMB() __dmb(0xF)
- #define __REV __rev
- #ifndef __NO_EMBEDDED_ASM
- __attribute__((section(".rev16_text"))) __STATIC_INLINE __ASM uint32_t __REV16(uint32_t value)
- {
- rev16 r0, r0
- bx lr
- }
- #endif
- #ifndef __NO_EMBEDDED_ASM
- __attribute__((section(".revsh_text"))) __STATIC_INLINE __ASM int32_t __REVSH(int32_t value)
- {
- revsh r0, r0
- bx lr
- }
- #endif
- #define __ROR __ror
- #define __BKPT(value) __breakpoint(value)
- #if (__CORTEX_M >= 0x03)
- #define __RBIT __rbit
- #define __LDREXB(ptr) ((uint8_t ) __ldrex(ptr))
- #define __LDREXH(ptr) ((uint16_t) __ldrex(ptr))
- #define __LDREXW(ptr) ((uint32_t ) __ldrex(ptr))
- #define __STREXB(value, ptr) __strex(value, ptr)
- #define __STREXH(value, ptr) __strex(value, ptr)
- #define __STREXW(value, ptr) __strex(value, ptr)
- #define __CLREX __clrex
- #define __SSAT __ssat
- #define __USAT __usat
- #define __CLZ __clz
- #endif
- #elif defined ( __GNUC__ )
- #if defined (__thumb__) && !defined (__thumb2__)
- #define __CMSIS_GCC_OUT_REG(r) "=l" (r)
- #define __CMSIS_GCC_USE_REG(r) "l" (r)
- #else
- #define __CMSIS_GCC_OUT_REG(r) "=r" (r)
- #define __CMSIS_GCC_USE_REG(r) "r" (r)
- #endif
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __NOP(void)
- {
- __ASM volatile ("nop");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __WFI(void)
- {
- __ASM volatile ("wfi");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __WFE(void)
- {
- __ASM volatile ("wfe");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __SEV(void)
- {
- __ASM volatile ("sev");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __ISB(void)
- {
- __ASM volatile ("isb");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __DSB(void)
- {
- __ASM volatile ("dsb");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __DMB(void)
- {
- __ASM volatile ("dmb");
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __REV(uint32_t value)
- {
- #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 5)
- return __builtin_bswap32(value);
- #else
- uint32_t result;
- __ASM volatile ("rev %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
- return(result);
- #endif
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __REV16(uint32_t value)
- {
- uint32_t result;
- __ASM volatile ("rev16 %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE int32_t __REVSH(int32_t value)
- {
- #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
- return (short)__builtin_bswap16(value);
- #else
- uint32_t result;
- __ASM volatile ("revsh %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
- return(result);
- #endif
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __ROR(uint32_t op1, uint32_t op2)
- {
- return (op1 >> op2) | (op1 << (32 - op2));
- }
- #define __BKPT(value) __ASM volatile ("bkpt "#value)
- #if (__CORTEX_M >= 0x03)
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __RBIT(uint32_t value)
- {
- uint32_t result;
- __ASM volatile ("rbit %0, %1" : "=r" (result) : "r" (value) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint8_t __LDREXB(volatile uint8_t *addr)
- {
- uint32_t result;
- #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
- __ASM volatile ("ldrexb %0, %1" : "=r" (result) : "Q" (*addr) );
- #else
-
- __ASM volatile ("ldrexb %0, [%1]" : "=r" (result) : "r" (addr) : "memory" );
- #endif
- return ((uint8_t) result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint16_t __LDREXH(volatile uint16_t *addr)
- {
- uint32_t result;
- #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
- __ASM volatile ("ldrexh %0, %1" : "=r" (result) : "Q" (*addr) );
- #else
-
- __ASM volatile ("ldrexh %0, [%1]" : "=r" (result) : "r" (addr) : "memory" );
- #endif
- return ((uint16_t) result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __LDREXW(volatile uint32_t *addr)
- {
- uint32_t result;
- __ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __STREXB(uint8_t value, volatile uint8_t *addr)
- {
- uint32_t result;
- __ASM volatile ("strexb %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" ((uint32_t)value) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __STREXH(uint16_t value, volatile uint16_t *addr)
- {
- uint32_t result;
- __ASM volatile ("strexh %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" ((uint32_t)value) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __STREXW(uint32_t value, volatile uint32_t *addr)
- {
- uint32_t result;
- __ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
- return(result);
- }
- __attribute__( ( always_inline ) ) __STATIC_INLINE void __CLREX(void)
- {
- __ASM volatile ("clrex" ::: "memory");
- }
- #define __SSAT(ARG1,ARG2) \
- ({ \
- uint32_t __RES, __ARG1 = (ARG1); \
- __ASM ("ssat %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
- __RES; \
- })
- #define __USAT(ARG1,ARG2) \
- ({ \
- uint32_t __RES, __ARG1 = (ARG1); \
- __ASM ("usat %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
- __RES; \
- })
- __attribute__( ( always_inline ) ) __STATIC_INLINE uint8_t __CLZ(uint32_t value)
- {
- uint32_t result;
- __ASM volatile ("clz %0, %1" : "=r" (result) : "r" (value) );
- return ((uint8_t) result);
- }
- #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
|