1 /* SPDX-License-Identifier: GPL-2.0-only */
3 * Based on arch/arm/include/asm/atomic.h
5 * Copyright (C) 1996 Russell King.
6 * Copyright (C) 2002 Deep Blue Solutions Ltd.
7 * Copyright (C) 2012 ARM Ltd.
10 #ifndef __ASM_ATOMIC_LSE_H
11 #define __ASM_ATOMIC_LSE_H
13 #define ATOMIC_OP(op, asm_op) \
14 static inline void __lse_atomic_##op(int i, atomic_t *v) \
18 " " #asm_op " %w[i], %[v]\n" \
19 : [i] "+r" (i), [v] "+Q" (v->counter) \
23 ATOMIC_OP(andnot, stclr)
30 #define ATOMIC_FETCH_OP(name, mb, op, asm_op, cl...) \
31 static inline int __lse_atomic_fetch_##op##name(int i, atomic_t *v) \
35 " " #asm_op #mb " %w[i], %w[i], %[v]" \
36 : [i] "+r" (i), [v] "+Q" (v->counter) \
43 #define ATOMIC_FETCH_OPS(op, asm_op) \
44 ATOMIC_FETCH_OP(_relaxed, , op, asm_op) \
45 ATOMIC_FETCH_OP(_acquire, a, op, asm_op, "memory") \
46 ATOMIC_FETCH_OP(_release, l, op, asm_op, "memory") \
47 ATOMIC_FETCH_OP( , al, op, asm_op, "memory")
49 ATOMIC_FETCH_OPS(andnot, ldclr)
50 ATOMIC_FETCH_OPS(or, ldset)
51 ATOMIC_FETCH_OPS(xor, ldeor)
52 ATOMIC_FETCH_OPS(add, ldadd)
54 #undef ATOMIC_FETCH_OP
55 #undef ATOMIC_FETCH_OPS
57 #define ATOMIC_OP_ADD_RETURN(name, mb, cl...) \
58 static inline int __lse_atomic_add_return##name(int i, atomic_t *v) \
64 " ldadd" #mb " %w[i], %w[tmp], %[v]\n" \
65 " add %w[i], %w[i], %w[tmp]" \
66 : [i] "+r" (i), [v] "+Q" (v->counter), [tmp] "=&r" (tmp) \
73 ATOMIC_OP_ADD_RETURN(_relaxed, )
74 ATOMIC_OP_ADD_RETURN(_acquire, a, "memory")
75 ATOMIC_OP_ADD_RETURN(_release, l, "memory")
76 ATOMIC_OP_ADD_RETURN( , al, "memory")
78 #undef ATOMIC_OP_ADD_RETURN
80 static inline void __lse_atomic_and(int i, atomic_t *v)
86 : [i] "+&r" (i), [v] "+Q" (v->counter)
90 #define ATOMIC_FETCH_OP_AND(name, mb, cl...) \
91 static inline int __lse_atomic_fetch_and##name(int i, atomic_t *v) \
95 " mvn %w[i], %w[i]\n" \
96 " ldclr" #mb " %w[i], %w[i], %[v]" \
97 : [i] "+&r" (i), [v] "+Q" (v->counter) \
104 ATOMIC_FETCH_OP_AND(_relaxed, )
105 ATOMIC_FETCH_OP_AND(_acquire, a, "memory")
106 ATOMIC_FETCH_OP_AND(_release, l, "memory")
107 ATOMIC_FETCH_OP_AND( , al, "memory")
109 #undef ATOMIC_FETCH_OP_AND
111 static inline void __lse_atomic_sub(int i, atomic_t *v)
115 " neg %w[i], %w[i]\n"
117 : [i] "+&r" (i), [v] "+Q" (v->counter)
121 #define ATOMIC_OP_SUB_RETURN(name, mb, cl...) \
122 static inline int __lse_atomic_sub_return##name(int i, atomic_t *v) \
128 " neg %w[i], %w[i]\n" \
129 " ldadd" #mb " %w[i], %w[tmp], %[v]\n" \
130 " add %w[i], %w[i], %w[tmp]" \
131 : [i] "+&r" (i), [v] "+Q" (v->counter), [tmp] "=&r" (tmp) \
138 ATOMIC_OP_SUB_RETURN(_relaxed, )
139 ATOMIC_OP_SUB_RETURN(_acquire, a, "memory")
140 ATOMIC_OP_SUB_RETURN(_release, l, "memory")
141 ATOMIC_OP_SUB_RETURN( , al, "memory")
143 #undef ATOMIC_OP_SUB_RETURN
145 #define ATOMIC_FETCH_OP_SUB(name, mb, cl...) \
146 static inline int __lse_atomic_fetch_sub##name(int i, atomic_t *v) \
150 " neg %w[i], %w[i]\n" \
151 " ldadd" #mb " %w[i], %w[i], %[v]" \
152 : [i] "+&r" (i), [v] "+Q" (v->counter) \
159 ATOMIC_FETCH_OP_SUB(_relaxed, )
160 ATOMIC_FETCH_OP_SUB(_acquire, a, "memory")
161 ATOMIC_FETCH_OP_SUB(_release, l, "memory")
162 ATOMIC_FETCH_OP_SUB( , al, "memory")
164 #undef ATOMIC_FETCH_OP_SUB
166 #define ATOMIC64_OP(op, asm_op) \
167 static inline void __lse_atomic64_##op(s64 i, atomic64_t *v) \
171 " " #asm_op " %[i], %[v]\n" \
172 : [i] "+r" (i), [v] "+Q" (v->counter) \
176 ATOMIC64_OP(andnot, stclr)
177 ATOMIC64_OP(or, stset)
178 ATOMIC64_OP(xor, steor)
179 ATOMIC64_OP(add, stadd)
183 #define ATOMIC64_FETCH_OP(name, mb, op, asm_op, cl...) \
184 static inline long __lse_atomic64_fetch_##op##name(s64 i, atomic64_t *v)\
188 " " #asm_op #mb " %[i], %[i], %[v]" \
189 : [i] "+r" (i), [v] "+Q" (v->counter) \
196 #define ATOMIC64_FETCH_OPS(op, asm_op) \
197 ATOMIC64_FETCH_OP(_relaxed, , op, asm_op) \
198 ATOMIC64_FETCH_OP(_acquire, a, op, asm_op, "memory") \
199 ATOMIC64_FETCH_OP(_release, l, op, asm_op, "memory") \
200 ATOMIC64_FETCH_OP( , al, op, asm_op, "memory")
202 ATOMIC64_FETCH_OPS(andnot, ldclr)
203 ATOMIC64_FETCH_OPS(or, ldset)
204 ATOMIC64_FETCH_OPS(xor, ldeor)
205 ATOMIC64_FETCH_OPS(add, ldadd)
207 #undef ATOMIC64_FETCH_OP
208 #undef ATOMIC64_FETCH_OPS
210 #define ATOMIC64_OP_ADD_RETURN(name, mb, cl...) \
211 static inline long __lse_atomic64_add_return##name(s64 i, atomic64_t *v)\
217 " ldadd" #mb " %[i], %x[tmp], %[v]\n" \
218 " add %[i], %[i], %x[tmp]" \
219 : [i] "+r" (i), [v] "+Q" (v->counter), [tmp] "=&r" (tmp) \
226 ATOMIC64_OP_ADD_RETURN(_relaxed, )
227 ATOMIC64_OP_ADD_RETURN(_acquire, a, "memory")
228 ATOMIC64_OP_ADD_RETURN(_release, l, "memory")
229 ATOMIC64_OP_ADD_RETURN( , al, "memory")
231 #undef ATOMIC64_OP_ADD_RETURN
233 static inline void __lse_atomic64_and(s64 i, atomic64_t *v)
239 : [i] "+&r" (i), [v] "+Q" (v->counter)
243 #define ATOMIC64_FETCH_OP_AND(name, mb, cl...) \
244 static inline long __lse_atomic64_fetch_and##name(s64 i, atomic64_t *v) \
248 " mvn %[i], %[i]\n" \
249 " ldclr" #mb " %[i], %[i], %[v]" \
250 : [i] "+&r" (i), [v] "+Q" (v->counter) \
257 ATOMIC64_FETCH_OP_AND(_relaxed, )
258 ATOMIC64_FETCH_OP_AND(_acquire, a, "memory")
259 ATOMIC64_FETCH_OP_AND(_release, l, "memory")
260 ATOMIC64_FETCH_OP_AND( , al, "memory")
262 #undef ATOMIC64_FETCH_OP_AND
264 static inline void __lse_atomic64_sub(s64 i, atomic64_t *v)
270 : [i] "+&r" (i), [v] "+Q" (v->counter)
274 #define ATOMIC64_OP_SUB_RETURN(name, mb, cl...) \
275 static inline long __lse_atomic64_sub_return##name(s64 i, atomic64_t *v)\
281 " neg %[i], %[i]\n" \
282 " ldadd" #mb " %[i], %x[tmp], %[v]\n" \
283 " add %[i], %[i], %x[tmp]" \
284 : [i] "+&r" (i), [v] "+Q" (v->counter), [tmp] "=&r" (tmp) \
291 ATOMIC64_OP_SUB_RETURN(_relaxed, )
292 ATOMIC64_OP_SUB_RETURN(_acquire, a, "memory")
293 ATOMIC64_OP_SUB_RETURN(_release, l, "memory")
294 ATOMIC64_OP_SUB_RETURN( , al, "memory")
296 #undef ATOMIC64_OP_SUB_RETURN
298 #define ATOMIC64_FETCH_OP_SUB(name, mb, cl...) \
299 static inline long __lse_atomic64_fetch_sub##name(s64 i, atomic64_t *v) \
303 " neg %[i], %[i]\n" \
304 " ldadd" #mb " %[i], %[i], %[v]" \
305 : [i] "+&r" (i), [v] "+Q" (v->counter) \
312 ATOMIC64_FETCH_OP_SUB(_relaxed, )
313 ATOMIC64_FETCH_OP_SUB(_acquire, a, "memory")
314 ATOMIC64_FETCH_OP_SUB(_release, l, "memory")
315 ATOMIC64_FETCH_OP_SUB( , al, "memory")
317 #undef ATOMIC64_FETCH_OP_SUB
319 static inline s64 __lse_atomic64_dec_if_positive(atomic64_t *v)
325 "1: ldr %x[tmp], %[v]\n"
326 " subs %[ret], %x[tmp], #1\n"
328 " casal %x[tmp], %[ret], %[v]\n"
329 " sub %x[tmp], %x[tmp], #1\n"
330 " sub %x[tmp], %x[tmp], %[ret]\n"
331 " cbnz %x[tmp], 1b\n"
333 : [ret] "+&r" (v), [v] "+Q" (v->counter), [tmp] "=&r" (tmp)
340 #define __CMPXCHG_CASE(w, sfx, name, sz, mb, cl...) \
341 static __always_inline u##sz \
342 __lse__cmpxchg_case_##name##sz(volatile void *ptr, \
346 register unsigned long x0 asm ("x0") = (unsigned long)ptr; \
347 register u##sz x1 asm ("x1") = old; \
348 register u##sz x2 asm ("x2") = new; \
353 " mov %" #w "[tmp], %" #w "[old]\n" \
354 " cas" #mb #sfx "\t%" #w "[tmp], %" #w "[new], %[v]\n" \
355 " mov %" #w "[ret], %" #w "[tmp]" \
356 : [ret] "+r" (x0), [v] "+Q" (*(unsigned long *)ptr), \
358 : [old] "r" (x1), [new] "r" (x2) \
364 __CMPXCHG_CASE(w, b, , 8, )
365 __CMPXCHG_CASE(w, h, , 16, )
366 __CMPXCHG_CASE(w, , , 32, )
367 __CMPXCHG_CASE(x, , , 64, )
368 __CMPXCHG_CASE(w, b, acq_, 8, a, "memory")
369 __CMPXCHG_CASE(w, h, acq_, 16, a, "memory")
370 __CMPXCHG_CASE(w, , acq_, 32, a, "memory")
371 __CMPXCHG_CASE(x, , acq_, 64, a, "memory")
372 __CMPXCHG_CASE(w, b, rel_, 8, l, "memory")
373 __CMPXCHG_CASE(w, h, rel_, 16, l, "memory")
374 __CMPXCHG_CASE(w, , rel_, 32, l, "memory")
375 __CMPXCHG_CASE(x, , rel_, 64, l, "memory")
376 __CMPXCHG_CASE(w, b, mb_, 8, al, "memory")
377 __CMPXCHG_CASE(w, h, mb_, 16, al, "memory")
378 __CMPXCHG_CASE(w, , mb_, 32, al, "memory")
379 __CMPXCHG_CASE(x, , mb_, 64, al, "memory")
381 #undef __CMPXCHG_CASE
383 #define __CMPXCHG_DBL(name, mb, cl...) \
384 static __always_inline long \
385 __lse__cmpxchg_double##name(unsigned long old1, \
386 unsigned long old2, \
387 unsigned long new1, \
388 unsigned long new2, \
389 volatile void *ptr) \
391 unsigned long oldval1 = old1; \
392 unsigned long oldval2 = old2; \
393 register unsigned long x0 asm ("x0") = old1; \
394 register unsigned long x1 asm ("x1") = old2; \
395 register unsigned long x2 asm ("x2") = new1; \
396 register unsigned long x3 asm ("x3") = new2; \
397 register unsigned long x4 asm ("x4") = (unsigned long)ptr; \
401 " casp" #mb "\t%[old1], %[old2], %[new1], %[new2], %[v]\n"\
402 " eor %[old1], %[old1], %[oldval1]\n" \
403 " eor %[old2], %[old2], %[oldval2]\n" \
404 " orr %[old1], %[old1], %[old2]" \
405 : [old1] "+&r" (x0), [old2] "+&r" (x1), \
406 [v] "+Q" (*(__uint128_t *)ptr) \
407 : [new1] "r" (x2), [new2] "r" (x3), [ptr] "r" (x4), \
408 [oldval1] "r" (oldval1), [oldval2] "r" (oldval2) \
415 __CMPXCHG_DBL(_mb, al, "memory")
419 #endif /* __ASM_ATOMIC_LSE_H */