1
2
3
4
5
6
7
8#ifndef _ASM_RISCV_ATOMIC_H
9#define _ASM_RISCV_ATOMIC_H
10
11#ifdef CONFIG_GENERIC_ATOMIC64
12# include <asm-generic/atomic64.h>
13#else
14# if (__riscv_xlen < 64)
15# error "64-bit atomics require XLEN to be at least 64"
16# endif
17#endif
18
19#include <asm/cmpxchg.h>
20#include <asm/barrier.h>
21
22#define ATOMIC_INIT(i) { (i) }
23
24#define __atomic_acquire_fence() \
25 __asm__ __volatile__(RISCV_ACQUIRE_BARRIER "" ::: "memory")
26
27#define __atomic_release_fence() \
28 __asm__ __volatile__(RISCV_RELEASE_BARRIER "" ::: "memory");
29
30static __always_inline int atomic_read(const atomic_t *v)
31{
32 return READ_ONCE(v->counter);
33}
34static __always_inline void atomic_set(atomic_t *v, int i)
35{
36 WRITE_ONCE(v->counter, i);
37}
38
39#ifndef CONFIG_GENERIC_ATOMIC64
40#define ATOMIC64_INIT(i) { (i) }
41static __always_inline s64 atomic64_read(const atomic64_t *v)
42{
43 return READ_ONCE(v->counter);
44}
45static __always_inline void atomic64_set(atomic64_t *v, s64 i)
46{
47 WRITE_ONCE(v->counter, i);
48}
49#endif
50
51
52
53
54
55
56#define ATOMIC_OP(op, asm_op, I, asm_type, c_type, prefix) \
57static __always_inline \
58void atomic##prefix##_##op(c_type i, atomic##prefix##_t *v) \
59{ \
60 __asm__ __volatile__ ( \
61 " amo" #asm_op "." #asm_type " zero, %1, %0" \
62 : "+A" (v->counter) \
63 : "r" (I) \
64 : "memory"); \
65} \
66
67#ifdef CONFIG_GENERIC_ATOMIC64
68#define ATOMIC_OPS(op, asm_op, I) \
69 ATOMIC_OP (op, asm_op, I, w, int, )
70#else
71#define ATOMIC_OPS(op, asm_op, I) \
72 ATOMIC_OP (op, asm_op, I, w, int, ) \
73 ATOMIC_OP (op, asm_op, I, d, s64, 64)
74#endif
75
76ATOMIC_OPS(add, add, i)
77ATOMIC_OPS(sub, add, -i)
78ATOMIC_OPS(and, and, i)
79ATOMIC_OPS( or, or, i)
80ATOMIC_OPS(xor, xor, i)
81
82#undef ATOMIC_OP
83#undef ATOMIC_OPS
84
85
86
87
88
89
90#define ATOMIC_FETCH_OP(op, asm_op, I, asm_type, c_type, prefix) \
91static __always_inline \
92c_type atomic##prefix##_fetch_##op##_relaxed(c_type i, \
93 atomic##prefix##_t *v) \
94{ \
95 register c_type ret; \
96 __asm__ __volatile__ ( \
97 " amo" #asm_op "." #asm_type " %1, %2, %0" \
98 : "+A" (v->counter), "=r" (ret) \
99 : "r" (I) \
100 : "memory"); \
101 return ret; \
102} \
103static __always_inline \
104c_type atomic##prefix##_fetch_##op(c_type i, atomic##prefix##_t *v) \
105{ \
106 register c_type ret; \
107 __asm__ __volatile__ ( \
108 " amo" #asm_op "." #asm_type ".aqrl %1, %2, %0" \
109 : "+A" (v->counter), "=r" (ret) \
110 : "r" (I) \
111 : "memory"); \
112 return ret; \
113}
114
115#define ATOMIC_OP_RETURN(op, asm_op, c_op, I, asm_type, c_type, prefix) \
116static __always_inline \
117c_type atomic##prefix##_##op##_return_relaxed(c_type i, \
118 atomic##prefix##_t *v) \
119{ \
120 return atomic##prefix##_fetch_##op##_relaxed(i, v) c_op I; \
121} \
122static __always_inline \
123c_type atomic##prefix##_##op##_return(c_type i, atomic##prefix##_t *v) \
124{ \
125 return atomic##prefix##_fetch_##op(i, v) c_op I; \
126}
127
128#ifdef CONFIG_GENERIC_ATOMIC64
129#define ATOMIC_OPS(op, asm_op, c_op, I) \
130 ATOMIC_FETCH_OP( op, asm_op, I, w, int, ) \
131 ATOMIC_OP_RETURN(op, asm_op, c_op, I, w, int, )
132#else
133#define ATOMIC_OPS(op, asm_op, c_op, I) \
134 ATOMIC_FETCH_OP( op, asm_op, I, w, int, ) \
135 ATOMIC_OP_RETURN(op, asm_op, c_op, I, w, int, ) \
136 ATOMIC_FETCH_OP( op, asm_op, I, d, s64, 64) \
137 ATOMIC_OP_RETURN(op, asm_op, c_op, I, d, s64, 64)
138#endif
139
140ATOMIC_OPS(add, add, +, i)
141ATOMIC_OPS(sub, add, +, -i)
142
143#define atomic_add_return_relaxed atomic_add_return_relaxed
144#define atomic_sub_return_relaxed atomic_sub_return_relaxed
145#define atomic_add_return atomic_add_return
146#define atomic_sub_return atomic_sub_return
147
148#define atomic_fetch_add_relaxed atomic_fetch_add_relaxed
149#define atomic_fetch_sub_relaxed atomic_fetch_sub_relaxed
150#define atomic_fetch_add atomic_fetch_add
151#define atomic_fetch_sub atomic_fetch_sub
152
153#ifndef CONFIG_GENERIC_ATOMIC64
154#define atomic64_add_return_relaxed atomic64_add_return_relaxed
155#define atomic64_sub_return_relaxed atomic64_sub_return_relaxed
156#define atomic64_add_return atomic64_add_return
157#define atomic64_sub_return atomic64_sub_return
158
159#define atomic64_fetch_add_relaxed atomic64_fetch_add_relaxed
160#define atomic64_fetch_sub_relaxed atomic64_fetch_sub_relaxed
161#define atomic64_fetch_add atomic64_fetch_add
162#define atomic64_fetch_sub atomic64_fetch_sub
163#endif
164
165#undef ATOMIC_OPS
166
167#ifdef CONFIG_GENERIC_ATOMIC64
168#define ATOMIC_OPS(op, asm_op, I) \
169 ATOMIC_FETCH_OP(op, asm_op, I, w, int, )
170#else
171#define ATOMIC_OPS(op, asm_op, I) \
172 ATOMIC_FETCH_OP(op, asm_op, I, w, int, ) \
173 ATOMIC_FETCH_OP(op, asm_op, I, d, s64, 64)
174#endif
175
176ATOMIC_OPS(and, and, i)
177ATOMIC_OPS( or, or, i)
178ATOMIC_OPS(xor, xor, i)
179
180#define atomic_fetch_and_relaxed atomic_fetch_and_relaxed
181#define atomic_fetch_or_relaxed atomic_fetch_or_relaxed
182#define atomic_fetch_xor_relaxed atomic_fetch_xor_relaxed
183#define atomic_fetch_and atomic_fetch_and
184#define atomic_fetch_or atomic_fetch_or
185#define atomic_fetch_xor atomic_fetch_xor
186
187#ifndef CONFIG_GENERIC_ATOMIC64
188#define atomic64_fetch_and_relaxed atomic64_fetch_and_relaxed
189#define atomic64_fetch_or_relaxed atomic64_fetch_or_relaxed
190#define atomic64_fetch_xor_relaxed atomic64_fetch_xor_relaxed
191#define atomic64_fetch_and atomic64_fetch_and
192#define atomic64_fetch_or atomic64_fetch_or
193#define atomic64_fetch_xor atomic64_fetch_xor
194#endif
195
196#undef ATOMIC_OPS
197
198#undef ATOMIC_FETCH_OP
199#undef ATOMIC_OP_RETURN
200
201
202static __always_inline int atomic_fetch_add_unless(atomic_t *v, int a, int u)
203{
204 int prev, rc;
205
206 __asm__ __volatile__ (
207 "0: lr.w %[p], %[c]\n"
208 " beq %[p], %[u], 1f\n"
209 " add %[rc], %[p], %[a]\n"
210 " sc.w.rl %[rc], %[rc], %[c]\n"
211 " bnez %[rc], 0b\n"
212 " fence rw, rw\n"
213 "1:\n"
214 : [p]"=&r" (prev), [rc]"=&r" (rc), [c]"+A" (v->counter)
215 : [a]"r" (a), [u]"r" (u)
216 : "memory");
217 return prev;
218}
219#define atomic_fetch_add_unless atomic_fetch_add_unless
220
221#ifndef CONFIG_GENERIC_ATOMIC64
222static __always_inline s64 atomic64_fetch_add_unless(atomic64_t *v, s64 a, s64 u)
223{
224 s64 prev;
225 long rc;
226
227 __asm__ __volatile__ (
228 "0: lr.d %[p], %[c]\n"
229 " beq %[p], %[u], 1f\n"
230 " add %[rc], %[p], %[a]\n"
231 " sc.d.rl %[rc], %[rc], %[c]\n"
232 " bnez %[rc], 0b\n"
233 " fence rw, rw\n"
234 "1:\n"
235 : [p]"=&r" (prev), [rc]"=&r" (rc), [c]"+A" (v->counter)
236 : [a]"r" (a), [u]"r" (u)
237 : "memory");
238 return prev;
239}
240#define atomic64_fetch_add_unless atomic64_fetch_add_unless
241#endif
242
243
244
245
246
247#define ATOMIC_OP(c_t, prefix, size) \
248static __always_inline \
249c_t atomic##prefix##_xchg_relaxed(atomic##prefix##_t *v, c_t n) \
250{ \
251 return __xchg_relaxed(&(v->counter), n, size); \
252} \
253static __always_inline \
254c_t atomic##prefix##_xchg_acquire(atomic##prefix##_t *v, c_t n) \
255{ \
256 return __xchg_acquire(&(v->counter), n, size); \
257} \
258static __always_inline \
259c_t atomic##prefix##_xchg_release(atomic##prefix##_t *v, c_t n) \
260{ \
261 return __xchg_release(&(v->counter), n, size); \
262} \
263static __always_inline \
264c_t atomic##prefix##_xchg(atomic##prefix##_t *v, c_t n) \
265{ \
266 return __xchg(&(v->counter), n, size); \
267} \
268static __always_inline \
269c_t atomic##prefix##_cmpxchg_relaxed(atomic##prefix##_t *v, \
270 c_t o, c_t n) \
271{ \
272 return __cmpxchg_relaxed(&(v->counter), o, n, size); \
273} \
274static __always_inline \
275c_t atomic##prefix##_cmpxchg_acquire(atomic##prefix##_t *v, \
276 c_t o, c_t n) \
277{ \
278 return __cmpxchg_acquire(&(v->counter), o, n, size); \
279} \
280static __always_inline \
281c_t atomic##prefix##_cmpxchg_release(atomic##prefix##_t *v, \
282 c_t o, c_t n) \
283{ \
284 return __cmpxchg_release(&(v->counter), o, n, size); \
285} \
286static __always_inline \
287c_t atomic##prefix##_cmpxchg(atomic##prefix##_t *v, c_t o, c_t n) \
288{ \
289 return __cmpxchg(&(v->counter), o, n, size); \
290}
291
292#ifdef CONFIG_GENERIC_ATOMIC64
293#define ATOMIC_OPS() \
294 ATOMIC_OP(int, , 4)
295#else
296#define ATOMIC_OPS() \
297 ATOMIC_OP(int, , 4) \
298 ATOMIC_OP(s64, 64, 8)
299#endif
300
301ATOMIC_OPS()
302
303#define atomic_xchg_relaxed atomic_xchg_relaxed
304#define atomic_xchg_acquire atomic_xchg_acquire
305#define atomic_xchg_release atomic_xchg_release
306#define atomic_xchg atomic_xchg
307#define atomic_cmpxchg_relaxed atomic_cmpxchg_relaxed
308#define atomic_cmpxchg_acquire atomic_cmpxchg_acquire
309#define atomic_cmpxchg_release atomic_cmpxchg_release
310#define atomic_cmpxchg atomic_cmpxchg
311
312#undef ATOMIC_OPS
313#undef ATOMIC_OP
314
315static __always_inline int atomic_sub_if_positive(atomic_t *v, int offset)
316{
317 int prev, rc;
318
319 __asm__ __volatile__ (
320 "0: lr.w %[p], %[c]\n"
321 " sub %[rc], %[p], %[o]\n"
322 " bltz %[rc], 1f\n"
323 " sc.w.rl %[rc], %[rc], %[c]\n"
324 " bnez %[rc], 0b\n"
325 " fence rw, rw\n"
326 "1:\n"
327 : [p]"=&r" (prev), [rc]"=&r" (rc), [c]"+A" (v->counter)
328 : [o]"r" (offset)
329 : "memory");
330 return prev - offset;
331}
332
333#define atomic_dec_if_positive(v) atomic_sub_if_positive(v, 1)
334
335#ifndef CONFIG_GENERIC_ATOMIC64
336static __always_inline s64 atomic64_sub_if_positive(atomic64_t *v, s64 offset)
337{
338 s64 prev;
339 long rc;
340
341 __asm__ __volatile__ (
342 "0: lr.d %[p], %[c]\n"
343 " sub %[rc], %[p], %[o]\n"
344 " bltz %[rc], 1f\n"
345 " sc.d.rl %[rc], %[rc], %[c]\n"
346 " bnez %[rc], 0b\n"
347 " fence rw, rw\n"
348 "1:\n"
349 : [p]"=&r" (prev), [rc]"=&r" (rc), [c]"+A" (v->counter)
350 : [o]"r" (offset)
351 : "memory");
352 return prev - offset;
353}
354
355#define atomic64_dec_if_positive(v) atomic64_sub_if_positive(v, 1)
356#endif
357
358#endif
359