123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335 |
- #ifndef NRFX_ATOMIC_INTERNAL_H__
- #define NRFX_ATOMIC_INTERNAL_H__
- #include <nrfx.h>
- #ifdef __cplusplus
- extern "C" {
- #endif
- #if ((__CORTEX_M >= 0x03U) || (__CORTEX_SC >= 300U)) == 0
- #error "Unsupported core version"
- #endif
- #if defined ( __CC_ARM )
- static __asm uint32_t nrfx_atomic_internal_mov(nrfx_atomic_u32_t * p_ptr,
- uint32_t value,
- uint32_t * p_new)
- {
-
- push {r4, r5}
- mov r4, r0
- loop_mov
- ldrex r0, [r4]
- mov r5, r1
- strex r3, r5, [r4]
- cmp r3, #0
- bne loop_mov
- str r5, [r2]
- pop {r4, r5}
- bx lr
- }
- static __asm uint32_t nrfx_atomic_internal_orr(nrfx_atomic_u32_t * p_ptr,
- uint32_t value,
- uint32_t * p_new)
- {
- push {r4, r5}
- mov r4, r0
- loop_orr
- ldrex r0, [r4]
- orr r5, r0, r1
- strex r3, r5, [r4]
- cmp r3, #0
- bne loop_orr
- str r5, [r2]
- pop {r4, r5}
- bx lr
- }
- static __asm uint32_t nrfx_atomic_internal_and(nrfx_atomic_u32_t * p_ptr,
- uint32_t value,
- uint32_t * p_new)
- {
- push {r4, r5}
- mov r4, r0
- loop_and
- ldrex r0, [r4]
- and r5, r0, r1
- strex r3, r5, [r4]
- cmp r3, #0
- bne loop_and
- str r5, [r2]
- pop {r4, r5}
- bx lr
- }
- static __asm uint32_t nrfx_atomic_internal_eor(nrfx_atomic_u32_t * p_ptr,
- uint32_t value,
- uint32_t * p_new)
- {
- push {r4, r5}
- mov r4, r0
- loop_eor
- ldrex r0, [r4]
- eor r5, r0, r1
- strex r3, r5, [r4]
- cmp r3, #0
- bne loop_eor
- str r5, [r2]
- pop {r4, r5}
- bx lr
- }
- static __asm uint32_t nrfx_atomic_internal_add(nrfx_atomic_u32_t * p_ptr,
- uint32_t value,
- uint32_t * p_new)
- {
- push {r4, r5}
- mov r4, r0
- loop_add
- ldrex r0, [r4]
- add r5, r0, r1
- strex r3, r5, [r4]
- cmp r3, #0
- bne loop_add
- str r5, [r2]
- pop {r4, r5}
- bx lr
- }
- static __asm uint32_t nrfx_atomic_internal_sub(nrfx_atomic_u32_t * p_ptr,
- uint32_t value,
- uint32_t * p_new)
- {
- push {r4, r5}
- mov r4, r0
- loop_sub
- ldrex r0, [r4]
- sub r5, r0, r1
- strex r3, r5, [r4]
- cmp r3, #0
- bne loop_sub
- str r5, [r2]
- pop {r4, r5}
- bx lr
- }
- static __asm bool nrfx_atomic_internal_cmp_exch(nrfx_atomic_u32_t * p_data,
- uint32_t * p_expected,
- uint32_t value)
- {
- #define RET_REG r0
- #define P_EXPC r1
- #define VALUE r2
- #define STR_RES r3
- #define P_DATA r4
- #define EXPC_VAL r5
- #define ACT_VAL r6
- push {r4-r6}
- mov P_DATA, r0
- mov RET_REG, #0
- loop_cmp_exch
- ldrex ACT_VAL, [P_DATA]
- ldr EXPC_VAL, [P_EXPC]
- cmp ACT_VAL, EXPC_VAL
- ittee eq
- strexeq STR_RES, VALUE, [P_DATA]
- moveq RET_REG, #1
- strexne STR_RES, ACT_VAL, [P_DATA]
- strne ACT_VAL, [P_EXPC]
- cmp STR_RES, #0
- itt ne
- movne RET_REG, #0
- bne loop_cmp_exch
- pop {r4-r6}
- bx lr
- #undef RET_REG
- #undef P_EXPC
- #undef VALUE
- #undef STR_RES
- #undef P_DATA
- #undef EXPC_VAL
- #undef ACT_VAL
- }
- static __asm uint32_t nrfx_atomic_internal_sub_hs(nrfx_atomic_u32_t * p_ptr,
- uint32_t value,
- uint32_t * p_new)
- {
- push {r4, r5}
- mov r4, r0
- loop_sub_ge
- ldrex r0, [r4]
- cmp r0, r1
- ite hs
- subhs r5, r0, r1
- movlo r5, r0
- strex r3, r5, [r4]
- cmp r3, #0
- bne loop_sub_ge
- str r5, [r2]
- pop {r4, r5}
- bx lr
- }
- #define NRFX_ATOMIC_OP(asm_op, old_val, new_val, ptr, value) \
- old_val = nrfx_atomic_internal_##asm_op(ptr, value, &new_val)
- #elif defined ( __ICCARM__ ) || defined ( __GNUC__ )
- #define NRFX_ATOMIC_OP(asm_op, old_val, new_val, ptr, value) \
- { \
- uint32_t tmp_reg
- __ASM volatile( \
- "1: ldrex %["#old_val"], [%["#ptr"]]\n" \
- NRFX_ATOMIC_OP_##asm_op(new_val, old_val, value) \
- " strex %[tmp_reg], %["#new_val"], [%["#ptr"]]\n" \
- " teq %[tmp_reg], #0\n" \
- " bne.n 1b" \
- : \
- [old_val] "=&r" (old_val), \
- [new_val] "=&r" (new_val), \
- [tmp_reg] "=&r" (tmp_reg) \
- : \
- [ptr] "r" (ptr), \
- [value] "r" (value) \
- : "cc")
- (void)tmp_reg
- }
- #define NRFX_ATOMIC_OP_mov(new_val, old_val, value) "mov %["#new_val"], %["#value"]\n"
- #define NRFX_ATOMIC_OP_orr(new_val, old_val, value) "orr %["#new_val"], %["#old_val"], %["#value"]\n"
- #define NRFX_ATOMIC_OP_and(new_val, old_val, value) "and %["#new_val"], %["#old_val"], %["#value"]\n"
- #define NRFX_ATOMIC_OP_eor(new_val, old_val, value) "eor %["#new_val"], %["#old_val"], %["#value"]\n"
- #define NRFX_ATOMIC_OP_add(new_val, old_val, value) "add %["#new_val"], %["#old_val"], %["#value"]\n"
- #define NRFX_ATOMIC_OP_sub(new_val, old_val, value) "sub %["#new_val"], %["#old_val"], %["#value"]\n"
- #define NRFX_ATOMIC_OP_sub_hs(new_val, old_val, value) \
- "cmp %["#old_val"], %["#value"]\n " \
- "ite hs\n" \
- "subhs %["#new_val"], %["#old_val"], %["#value"]\n" \
- "movlo %["#new_val"], %["#old_val"]\n"
- static inline bool nrfx_atomic_internal_cmp_exch(nrfx_atomic_u32_t * p_data,
- uint32_t * p_expected,
- uint32_t value)
- {
- bool res = false
-
- uint32_t tmp_reg
- uint32_t act_val = 0
- uint32_t exp_val = 0
- __ASM volatile(
- "1: ldrex %[act_val], [%[ptr]]\n"
- " ldr %[exp_val], [%[expc]]\n"
- " cmp %[act_val], %[exp_val]\n"
- " ittee eq\n"
- " strexeq %[tmp_reg], %[value], [%[ptr]]\n"
- " moveq %[res], #1\n"
- " strexne %[tmp_reg], %[act_val], [%[ptr]]\n"
- " strne %[act_val], [%[expc]]\n"
- " cmp %[tmp_reg], #0\n"
- " itt ne\n"
- " movne %[res], #0\n"
- " bne.n 1b"
- :
- [res] "=&r" (res),
- [exp_val] "=&r" (exp_val),
- [act_val] "=&r" (act_val),
- [tmp_reg] "=&r" (tmp_reg)
- :
- "0" (res),
- "1" (exp_val),
- "2" (act_val),
- [expc] "r" (p_expected),
- [ptr] "r" (p_data),
- [value] "r" (value)
- : "cc")
- (void)tmp_reg
- return res
- }
- #else
- #error "Unsupported compiler"
- #endif
- #ifdef __cplusplus
- }
- #endif
- #endif // NRFX_ATOMIC_INTERNAL_H__
|