Linux Audio

Check our new training course

Loading...
  1#ifndef _ASM_POWERPC_ATOMIC_H_
  2#define _ASM_POWERPC_ATOMIC_H_
  3
  4/*
  5 * PowerPC atomic operations
  6 */
  7
  8#include <linux/types.h>
  9
 10#ifdef __KERNEL__
 11#include <linux/compiler.h>
 12#include <asm/synch.h>
 13#include <asm/asm-compat.h>
 14#include <asm/system.h>
 15
 16#define ATOMIC_INIT(i)		{ (i) }
 17
 18static __inline__ int atomic_read(const atomic_t *v)
 19{
 20	int t;
 21
 22	__asm__ __volatile__("lwz%U1%X1 %0,%1" : "=r"(t) : "m"(v->counter));
 23
 24	return t;
 25}
 26
 27static __inline__ void atomic_set(atomic_t *v, int i)
 28{
 29	__asm__ __volatile__("stw%U0%X0 %1,%0" : "=m"(v->counter) : "r"(i));
 30}
 31
 32static __inline__ void atomic_add(int a, atomic_t *v)
 33{
 34	int t;
 35
 36	__asm__ __volatile__(
 37"1:	lwarx	%0,0,%3		# atomic_add\n\
 38	add	%0,%2,%0\n"
 39	PPC405_ERR77(0,%3)
 40"	stwcx.	%0,0,%3 \n\
 41	bne-	1b"
 42	: "=&r" (t), "+m" (v->counter)
 43	: "r" (a), "r" (&v->counter)
 44	: "cc");
 45}
 46
 47static __inline__ int atomic_add_return(int a, atomic_t *v)
 48{
 49	int t;
 50
 51	__asm__ __volatile__(
 52	PPC_RELEASE_BARRIER
 53"1:	lwarx	%0,0,%2		# atomic_add_return\n\
 54	add	%0,%1,%0\n"
 55	PPC405_ERR77(0,%2)
 56"	stwcx.	%0,0,%2 \n\
 57	bne-	1b"
 58	PPC_ACQUIRE_BARRIER
 59	: "=&r" (t)
 60	: "r" (a), "r" (&v->counter)
 61	: "cc", "memory");
 62
 63	return t;
 64}
 65
 66#define atomic_add_negative(a, v)	(atomic_add_return((a), (v)) < 0)
 67
 68static __inline__ void atomic_sub(int a, atomic_t *v)
 69{
 70	int t;
 71
 72	__asm__ __volatile__(
 73"1:	lwarx	%0,0,%3		# atomic_sub\n\
 74	subf	%0,%2,%0\n"
 75	PPC405_ERR77(0,%3)
 76"	stwcx.	%0,0,%3 \n\
 77	bne-	1b"
 78	: "=&r" (t), "+m" (v->counter)
 79	: "r" (a), "r" (&v->counter)
 80	: "cc");
 81}
 82
 83static __inline__ int atomic_sub_return(int a, atomic_t *v)
 84{
 85	int t;
 86
 87	__asm__ __volatile__(
 88	PPC_RELEASE_BARRIER
 89"1:	lwarx	%0,0,%2		# atomic_sub_return\n\
 90	subf	%0,%1,%0\n"
 91	PPC405_ERR77(0,%2)
 92"	stwcx.	%0,0,%2 \n\
 93	bne-	1b"
 94	PPC_ACQUIRE_BARRIER
 95	: "=&r" (t)
 96	: "r" (a), "r" (&v->counter)
 97	: "cc", "memory");
 98
 99	return t;
100}
101
102static __inline__ void atomic_inc(atomic_t *v)
103{
104	int t;
105
106	__asm__ __volatile__(
107"1:	lwarx	%0,0,%2		# atomic_inc\n\
108	addic	%0,%0,1\n"
109	PPC405_ERR77(0,%2)
110"	stwcx.	%0,0,%2 \n\
111	bne-	1b"
112	: "=&r" (t), "+m" (v->counter)
113	: "r" (&v->counter)
114	: "cc", "xer");
115}
116
117static __inline__ int atomic_inc_return(atomic_t *v)
118{
119	int t;
120
121	__asm__ __volatile__(
122	PPC_RELEASE_BARRIER
123"1:	lwarx	%0,0,%1		# atomic_inc_return\n\
124	addic	%0,%0,1\n"
125	PPC405_ERR77(0,%1)
126"	stwcx.	%0,0,%1 \n\
127	bne-	1b"
128	PPC_ACQUIRE_BARRIER
129	: "=&r" (t)
130	: "r" (&v->counter)
131	: "cc", "xer", "memory");
132
133	return t;
134}
135
136/*
137 * atomic_inc_and_test - increment and test
138 * @v: pointer of type atomic_t
139 *
140 * Atomically increments @v by 1
141 * and returns true if the result is zero, or false for all
142 * other cases.
143 */
144#define atomic_inc_and_test(v) (atomic_inc_return(v) == 0)
145
146static __inline__ void atomic_dec(atomic_t *v)
147{
148	int t;
149
150	__asm__ __volatile__(
151"1:	lwarx	%0,0,%2		# atomic_dec\n\
152	addic	%0,%0,-1\n"
153	PPC405_ERR77(0,%2)\
154"	stwcx.	%0,0,%2\n\
155	bne-	1b"
156	: "=&r" (t), "+m" (v->counter)
157	: "r" (&v->counter)
158	: "cc", "xer");
159}
160
161static __inline__ int atomic_dec_return(atomic_t *v)
162{
163	int t;
164
165	__asm__ __volatile__(
166	PPC_RELEASE_BARRIER
167"1:	lwarx	%0,0,%1		# atomic_dec_return\n\
168	addic	%0,%0,-1\n"
169	PPC405_ERR77(0,%1)
170"	stwcx.	%0,0,%1\n\
171	bne-	1b"
172	PPC_ACQUIRE_BARRIER
173	: "=&r" (t)
174	: "r" (&v->counter)
175	: "cc", "xer", "memory");
176
177	return t;
178}
179
180#define atomic_cmpxchg(v, o, n) (cmpxchg(&((v)->counter), (o), (n)))
181#define atomic_xchg(v, new) (xchg(&((v)->counter), new))
182
183/**
184 * __atomic_add_unless - add unless the number is a given value
185 * @v: pointer of type atomic_t
186 * @a: the amount to add to v...
187 * @u: ...unless v is equal to u.
188 *
189 * Atomically adds @a to @v, so long as it was not @u.
190 * Returns the old value of @v.
191 */
192static __inline__ int __atomic_add_unless(atomic_t *v, int a, int u)
193{
194	int t;
195
196	__asm__ __volatile__ (
197	PPC_RELEASE_BARRIER
198"1:	lwarx	%0,0,%1		# __atomic_add_unless\n\
199	cmpw	0,%0,%3 \n\
200	beq-	2f \n\
201	add	%0,%2,%0 \n"
202	PPC405_ERR77(0,%2)
203"	stwcx.	%0,0,%1 \n\
204	bne-	1b \n"
205	PPC_ACQUIRE_BARRIER
206"	subf	%0,%2,%0 \n\
2072:"
208	: "=&r" (t)
209	: "r" (&v->counter), "r" (a), "r" (u)
210	: "cc", "memory");
211
212	return t;
213}
214
215
216#define atomic_sub_and_test(a, v)	(atomic_sub_return((a), (v)) == 0)
217#define atomic_dec_and_test(v)		(atomic_dec_return((v)) == 0)
218
219/*
220 * Atomically test *v and decrement if it is greater than 0.
221 * The function returns the old value of *v minus 1, even if
222 * the atomic variable, v, was not decremented.
223 */
224static __inline__ int atomic_dec_if_positive(atomic_t *v)
225{
226	int t;
227
228	__asm__ __volatile__(
229	PPC_RELEASE_BARRIER
230"1:	lwarx	%0,0,%1		# atomic_dec_if_positive\n\
231	cmpwi	%0,1\n\
232	addi	%0,%0,-1\n\
233	blt-	2f\n"
234	PPC405_ERR77(0,%1)
235"	stwcx.	%0,0,%1\n\
236	bne-	1b"
237	PPC_ACQUIRE_BARRIER
238	"\n\
2392:"	: "=&b" (t)
240	: "r" (&v->counter)
241	: "cc", "memory");
242
243	return t;
244}
245
246#define smp_mb__before_atomic_dec()     smp_mb()
247#define smp_mb__after_atomic_dec()      smp_mb()
248#define smp_mb__before_atomic_inc()     smp_mb()
249#define smp_mb__after_atomic_inc()      smp_mb()
250
251#ifdef __powerpc64__
252
253#define ATOMIC64_INIT(i)	{ (i) }
254
255static __inline__ long atomic64_read(const atomic64_t *v)
256{
257	long t;
258
259	__asm__ __volatile__("ld%U1%X1 %0,%1" : "=r"(t) : "m"(v->counter));
260
261	return t;
262}
263
264static __inline__ void atomic64_set(atomic64_t *v, long i)
265{
266	__asm__ __volatile__("std%U0%X0 %1,%0" : "=m"(v->counter) : "r"(i));
267}
268
269static __inline__ void atomic64_add(long a, atomic64_t *v)
270{
271	long t;
272
273	__asm__ __volatile__(
274"1:	ldarx	%0,0,%3		# atomic64_add\n\
275	add	%0,%2,%0\n\
276	stdcx.	%0,0,%3 \n\
277	bne-	1b"
278	: "=&r" (t), "+m" (v->counter)
279	: "r" (a), "r" (&v->counter)
280	: "cc");
281}
282
283static __inline__ long atomic64_add_return(long a, atomic64_t *v)
284{
285	long t;
286
287	__asm__ __volatile__(
288	PPC_RELEASE_BARRIER
289"1:	ldarx	%0,0,%2		# atomic64_add_return\n\
290	add	%0,%1,%0\n\
291	stdcx.	%0,0,%2 \n\
292	bne-	1b"
293	PPC_ACQUIRE_BARRIER
294	: "=&r" (t)
295	: "r" (a), "r" (&v->counter)
296	: "cc", "memory");
297
298	return t;
299}
300
301#define atomic64_add_negative(a, v)	(atomic64_add_return((a), (v)) < 0)
302
303static __inline__ void atomic64_sub(long a, atomic64_t *v)
304{
305	long t;
306
307	__asm__ __volatile__(
308"1:	ldarx	%0,0,%3		# atomic64_sub\n\
309	subf	%0,%2,%0\n\
310	stdcx.	%0,0,%3 \n\
311	bne-	1b"
312	: "=&r" (t), "+m" (v->counter)
313	: "r" (a), "r" (&v->counter)
314	: "cc");
315}
316
317static __inline__ long atomic64_sub_return(long a, atomic64_t *v)
318{
319	long t;
320
321	__asm__ __volatile__(
322	PPC_RELEASE_BARRIER
323"1:	ldarx	%0,0,%2		# atomic64_sub_return\n\
324	subf	%0,%1,%0\n\
325	stdcx.	%0,0,%2 \n\
326	bne-	1b"
327	PPC_ACQUIRE_BARRIER
328	: "=&r" (t)
329	: "r" (a), "r" (&v->counter)
330	: "cc", "memory");
331
332	return t;
333}
334
335static __inline__ void atomic64_inc(atomic64_t *v)
336{
337	long t;
338
339	__asm__ __volatile__(
340"1:	ldarx	%0,0,%2		# atomic64_inc\n\
341	addic	%0,%0,1\n\
342	stdcx.	%0,0,%2 \n\
343	bne-	1b"
344	: "=&r" (t), "+m" (v->counter)
345	: "r" (&v->counter)
346	: "cc", "xer");
347}
348
349static __inline__ long atomic64_inc_return(atomic64_t *v)
350{
351	long t;
352
353	__asm__ __volatile__(
354	PPC_RELEASE_BARRIER
355"1:	ldarx	%0,0,%1		# atomic64_inc_return\n\
356	addic	%0,%0,1\n\
357	stdcx.	%0,0,%1 \n\
358	bne-	1b"
359	PPC_ACQUIRE_BARRIER
360	: "=&r" (t)
361	: "r" (&v->counter)
362	: "cc", "xer", "memory");
363
364	return t;
365}
366
367/*
368 * atomic64_inc_and_test - increment and test
369 * @v: pointer of type atomic64_t
370 *
371 * Atomically increments @v by 1
372 * and returns true if the result is zero, or false for all
373 * other cases.
374 */
375#define atomic64_inc_and_test(v) (atomic64_inc_return(v) == 0)
376
377static __inline__ void atomic64_dec(atomic64_t *v)
378{
379	long t;
380
381	__asm__ __volatile__(
382"1:	ldarx	%0,0,%2		# atomic64_dec\n\
383	addic	%0,%0,-1\n\
384	stdcx.	%0,0,%2\n\
385	bne-	1b"
386	: "=&r" (t), "+m" (v->counter)
387	: "r" (&v->counter)
388	: "cc", "xer");
389}
390
391static __inline__ long atomic64_dec_return(atomic64_t *v)
392{
393	long t;
394
395	__asm__ __volatile__(
396	PPC_RELEASE_BARRIER
397"1:	ldarx	%0,0,%1		# atomic64_dec_return\n\
398	addic	%0,%0,-1\n\
399	stdcx.	%0,0,%1\n\
400	bne-	1b"
401	PPC_ACQUIRE_BARRIER
402	: "=&r" (t)
403	: "r" (&v->counter)
404	: "cc", "xer", "memory");
405
406	return t;
407}
408
409#define atomic64_sub_and_test(a, v)	(atomic64_sub_return((a), (v)) == 0)
410#define atomic64_dec_and_test(v)	(atomic64_dec_return((v)) == 0)
411
412/*
413 * Atomically test *v and decrement if it is greater than 0.
414 * The function returns the old value of *v minus 1.
415 */
416static __inline__ long atomic64_dec_if_positive(atomic64_t *v)
417{
418	long t;
419
420	__asm__ __volatile__(
421	PPC_RELEASE_BARRIER
422"1:	ldarx	%0,0,%1		# atomic64_dec_if_positive\n\
423	addic.	%0,%0,-1\n\
424	blt-	2f\n\
425	stdcx.	%0,0,%1\n\
426	bne-	1b"
427	PPC_ACQUIRE_BARRIER
428	"\n\
4292:"	: "=&r" (t)
430	: "r" (&v->counter)
431	: "cc", "xer", "memory");
432
433	return t;
434}
435
436#define atomic64_cmpxchg(v, o, n) (cmpxchg(&((v)->counter), (o), (n)))
437#define atomic64_xchg(v, new) (xchg(&((v)->counter), new))
438
439/**
440 * atomic64_add_unless - add unless the number is a given value
441 * @v: pointer of type atomic64_t
442 * @a: the amount to add to v...
443 * @u: ...unless v is equal to u.
444 *
445 * Atomically adds @a to @v, so long as it was not @u.
446 * Returns the old value of @v.
447 */
448static __inline__ int atomic64_add_unless(atomic64_t *v, long a, long u)
449{
450	long t;
451
452	__asm__ __volatile__ (
453	PPC_RELEASE_BARRIER
454"1:	ldarx	%0,0,%1		# __atomic_add_unless\n\
455	cmpd	0,%0,%3 \n\
456	beq-	2f \n\
457	add	%0,%2,%0 \n"
458"	stdcx.	%0,0,%1 \n\
459	bne-	1b \n"
460	PPC_ACQUIRE_BARRIER
461"	subf	%0,%2,%0 \n\
4622:"
463	: "=&r" (t)
464	: "r" (&v->counter), "r" (a), "r" (u)
465	: "cc", "memory");
466
467	return t != u;
468}
469
470#define atomic64_inc_not_zero(v) atomic64_add_unless((v), 1, 0)
471
472#endif /* __powerpc64__ */
473
474#endif /* __KERNEL__ */
475#endif /* _ASM_POWERPC_ATOMIC_H_ */