160 lines
4.9 KiB
C
160 lines
4.9 KiB
C
/*
|
|
* Copyright (c) 2006-2023, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2023-03-14 WangShun first version
|
|
*/
|
|
|
|
#include <rtthread.h>
|
|
|
|
rt_atomic_t rt_hw_atomic_exchange(volatile rt_atomic_t *ptr, rt_atomic_t val)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoswap.w %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoswap.d %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_add(volatile rt_atomic_t *ptr, rt_atomic_t val)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoadd.w %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoadd.d %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_sub(volatile rt_atomic_t *ptr, rt_atomic_t val)
|
|
{
|
|
rt_atomic_t result;
|
|
val = -val;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoadd.w %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoadd.d %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_xor(volatile rt_atomic_t *ptr, rt_atomic_t val)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoxor.w %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoxor.d %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_and(volatile rt_atomic_t *ptr, rt_atomic_t val)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoand.w %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoand.d %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_or(volatile rt_atomic_t *ptr, rt_atomic_t val)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoor.w %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoor.d %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_load(volatile rt_atomic_t *ptr)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoxor.w %0, x0, (%1)" : "=r"(result) : "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoxor.d %0, x0, (%1)" : "=r"(result) : "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
void rt_hw_atomic_store(volatile rt_atomic_t *ptr, rt_atomic_t val)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoswap.w %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoswap.d %0, %1, (%2)" : "=r"(result) : "r"(val), "r"(ptr) : "memory");
|
|
#endif
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_flag_test_and_set(volatile rt_atomic_t *ptr)
|
|
{
|
|
rt_atomic_t result;
|
|
rt_atomic_t temp = 1;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoor.w %0, %1, (%2)" : "=r"(result) : "r"(temp), "r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoor.d %0, %1, (%2)" : "=r"(result) : "r"(temp), "r"(ptr) : "memory");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
void rt_hw_atomic_flag_clear(volatile rt_atomic_t *ptr)
|
|
{
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile ("amoand.w %0, x0, (%1)" : "=r"(result) :"r"(ptr) : "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile ("amoand.d %0, x0, (%1)" : "=r"(result) :"r"(ptr) : "memory");
|
|
#endif
|
|
}
|
|
|
|
rt_atomic_t rt_hw_atomic_compare_exchange_strong(volatile rt_atomic_t *ptr, volatile rt_atomic_t *old, rt_atomic_t new)
|
|
{
|
|
rt_atomic_t tmp = *old;
|
|
rt_atomic_t result;
|
|
#if __riscv_xlen == 32
|
|
asm volatile(
|
|
" fence iorw, ow\n"
|
|
"1: lr.w.aq %[result], (%[ptr])\n"
|
|
" bne %[result], %[tmp], 2f\n"
|
|
" sc.w.rl %[tmp], %[new], (%[ptr])\n"
|
|
" bnez %[tmp], 1b\n"
|
|
" li %[result], 1\n"
|
|
" j 3f\n"
|
|
" 2:sw %[result], (%[old])\n"
|
|
" li %[result], 0\n"
|
|
" 3:\n"
|
|
: [result]"+r" (result), [tmp]"+r" (tmp), [ptr]"+r" (ptr)
|
|
: [new]"r" (new), [old]"r"(old)
|
|
: "memory");
|
|
#elif __riscv_xlen == 64
|
|
asm volatile(
|
|
" fence iorw, ow\n"
|
|
"1: lr.d.aq %[result], (%[ptr])\n"
|
|
" bne %[result], %[tmp], 2f\n"
|
|
" sc.d.rl %[tmp], %[new], (%[ptr])\n"
|
|
" bnez %[tmp], 1b\n"
|
|
" li %[result], 1\n"
|
|
" j 3f\n"
|
|
" 2:sd %[result], (%[old])\n"
|
|
" li %[result], 0\n"
|
|
" 3:\n"
|
|
: [result]"+r" (result), [tmp]"+r" (tmp), [ptr]"+r" (ptr)
|
|
: [new]"r" (new), [old]"r"(old)
|
|
: "memory");
|
|
#endif
|
|
return result;
|
|
}
|