87 lines
2.6 KiB
C
87 lines
2.6 KiB
C
|
/* SPDX-License-Identifier: GPL-2.0 */
|
||
|
|
#ifndef __ASM_SH_ATOMIC_GRB_H
|
||
|
|
#define __ASM_SH_ATOMIC_GRB_H
|
||
|
|
|
||
|
|
#define ATOMIC_OP(op) \
|
||
|
|
static inline void atomic_##op(int i, atomic_t *v) \
|
||
|
|
{ \
|
||
|
|
int tmp; \
|
||
|
|
\
|
||
|
|
__asm__ __volatile__ ( \
|
||
|
|
" .align 2 \n\t" \
|
||
|
|
" mova 1f, r0 \n\t" /* r0 = end point */ \
|
||
|
|
" mov r15, r1 \n\t" /* r1 = saved sp */ \
|
||
|
|
" mov #-6, r15 \n\t" /* LOGIN: r15 = size */ \
|
||
|
|
" mov.l @%1, %0 \n\t" /* load old value */ \
|
||
|
|
" " #op " %2, %0 \n\t" /* $op */ \
|
||
|
|
" mov.l %0, @%1 \n\t" /* store new value */ \
|
||
|
|
"1: mov r1, r15 \n\t" /* LOGOUT */ \
|
||
|
|
: "=&r" (tmp), \
|
||
|
|
"+r" (v) \
|
||
|
|
: "r" (i) \
|
||
|
|
: "memory" , "r0", "r1"); \
|
||
|
|
} \
|
||
|
|
|
||
|
|
#define ATOMIC_OP_RETURN(op) \
|
||
|
|
static inline int atomic_##op##_return(int i, atomic_t *v) \
|
||
|
|
{ \
|
||
|
|
int tmp; \
|
||
|
|
\
|
||
|
|
__asm__ __volatile__ ( \
|
||
|
|
" .align 2 \n\t" \
|
||
|
|
" mova 1f, r0 \n\t" /* r0 = end point */ \
|
||
|
|
" mov r15, r1 \n\t" /* r1 = saved sp */ \
|
||
|
|
" mov #-6, r15 \n\t" /* LOGIN: r15 = size */ \
|
||
|
|
" mov.l @%1, %0 \n\t" /* load old value */ \
|
||
|
|
" " #op " %2, %0 \n\t" /* $op */ \
|
||
|
|
" mov.l %0, @%1 \n\t" /* store new value */ \
|
||
|
|
"1: mov r1, r15 \n\t" /* LOGOUT */ \
|
||
|
|
: "=&r" (tmp), \
|
||
|
|
"+r" (v) \
|
||
|
|
: "r" (i) \
|
||
|
|
: "memory" , "r0", "r1"); \
|
||
|
|
\
|
||
|
|
return tmp; \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define ATOMIC_FETCH_OP(op) \
|
||
|
|
static inline int atomic_fetch_##op(int i, atomic_t *v) \
|
||
|
|
{ \
|
||
|
|
int res, tmp; \
|
||
|
|
\
|
||
|
|
__asm__ __volatile__ ( \
|
||
|
|
" .align 2 \n\t" \
|
||
|
|
" mova 1f, r0 \n\t" /* r0 = end point */ \
|
||
|
|
" mov r15, r1 \n\t" /* r1 = saved sp */ \
|
||
|
|
" mov #-6, r15 \n\t" /* LOGIN: r15 = size */ \
|
||
|
|
" mov.l @%2, %0 \n\t" /* load old value */ \
|
||
|
|
" mov %0, %1 \n\t" /* save old value */ \
|
||
|
|
" " #op " %3, %0 \n\t" /* $op */ \
|
||
|
|
" mov.l %0, @%2 \n\t" /* store new value */ \
|
||
|
|
"1: mov r1, r15 \n\t" /* LOGOUT */ \
|
||
|
|
: "=&r" (tmp), "=&r" (res), "+r" (v) \
|
||
|
|
: "r" (i) \
|
||
|
|
: "memory" , "r0", "r1"); \
|
||
|
|
\
|
||
|
|
return res; \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define ATOMIC_OPS(op) ATOMIC_OP(op) ATOMIC_OP_RETURN(op) ATOMIC_FETCH_OP(op)
|
||
|
|
|
||
|
|
ATOMIC_OPS(add)
|
||
|
|
ATOMIC_OPS(sub)
|
||
|
|
|
||
|
|
#undef ATOMIC_OPS
|
||
|
|
#define ATOMIC_OPS(op) ATOMIC_OP(op) ATOMIC_FETCH_OP(op)
|
||
|
|
|
||
|
|
ATOMIC_OPS(and)
|
||
|
|
ATOMIC_OPS(or)
|
||
|
|
ATOMIC_OPS(xor)
|
||
|
|
|
||
|
|
#undef ATOMIC_OPS
|
||
|
|
#undef ATOMIC_FETCH_OP
|
||
|
|
#undef ATOMIC_OP_RETURN
|
||
|
|
#undef ATOMIC_OP
|
||
|
|
|
||
|
|
#endif /* __ASM_SH_ATOMIC_GRB_H */
|