Linux Audio

Check our new training course

Loading...
v3.1
  1/*
  2 * This file is subject to the terms and conditions of the GNU General Public
  3 * License.  See the file "COPYING" in the main directory of this archive
  4 * for more details.
  5 *
  6 * Copyright (C) 1999, 2000, 06 Ralf Baechle (ralf@linux-mips.org)
  7 * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
  8 */
  9#ifndef _ASM_SPINLOCK_H
 10#define _ASM_SPINLOCK_H
 11
 12#include <linux/compiler.h>
 13
 14#include <asm/barrier.h>
 
 
 15#include <asm/war.h>
 16
 17/*
 18 * Your basic SMP spinlocks, allowing only a single CPU anywhere
 19 *
 20 * Simple spin lock operations.  There are two variants, one clears IRQ's
 21 * on the local processor, one does not.
 22 *
 23 * These are fair FIFO ticket locks
 24 *
 25 * (the type definitions are in asm/spinlock_types.h)
 26 */
 27
 28
 29/*
 30 * Ticket locks are conceptually two parts, one indicating the current head of
 31 * the queue, and the other indicating the current tail. The lock is acquired
 32 * by atomically noting the tail and incrementing it by one (thus adding
 33 * ourself to the queue and noting our position), then waiting until the head
 34 * becomes equal to the the initial value of the tail.
 35 */
 36
 37static inline int arch_spin_is_locked(arch_spinlock_t *lock)
 38{
 39	u32 counters = ACCESS_ONCE(lock->lock);
 40
 41	return ((counters >> 16) ^ counters) & 0xffff;
 42}
 43
 
 
 
 
 
 44#define arch_spin_lock_flags(lock, flags) arch_spin_lock(lock)
 45#define arch_spin_unlock_wait(x) \
 46	while (arch_spin_is_locked(x)) { cpu_relax(); }
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 47
 48static inline int arch_spin_is_contended(arch_spinlock_t *lock)
 49{
 50	u32 counters = ACCESS_ONCE(lock->lock);
 51
 52	return (((counters >> 16) - counters) & 0xffff) > 1;
 53}
 54#define arch_spin_is_contended	arch_spin_is_contended
 55
 56static inline void arch_spin_lock(arch_spinlock_t *lock)
 57{
 58	int my_ticket;
 59	int tmp;
 60	int inc = 0x10000;
 61
 62	if (R10000_LLSC_WAR) {
 63		__asm__ __volatile__ (
 64		"	.set push		# arch_spin_lock	\n"
 65		"	.set noreorder					\n"
 66		"							\n"
 67		"1:	ll	%[ticket], %[ticket_ptr]		\n"
 68		"	addu	%[my_ticket], %[ticket], %[inc]		\n"
 69		"	sc	%[my_ticket], %[ticket_ptr]		\n"
 70		"	beqzl	%[my_ticket], 1b			\n"
 71		"	 nop						\n"
 72		"	srl	%[my_ticket], %[ticket], 16		\n"
 73		"	andi	%[ticket], %[ticket], 0xffff		\n"
 74		"	andi	%[my_ticket], %[my_ticket], 0xffff	\n"
 75		"	bne	%[ticket], %[my_ticket], 4f		\n"
 76		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
 77		"2:							\n"
 78		"	.subsection 2					\n"
 79		"4:	andi	%[ticket], %[ticket], 0xffff		\n"
 80		"	sll	%[ticket], 5				\n"
 81		"							\n"
 82		"6:	bnez	%[ticket], 6b				\n"
 83		"	 subu	%[ticket], 1				\n"
 84		"							\n"
 85		"	lhu	%[ticket], %[serving_now_ptr]		\n"
 86		"	beq	%[ticket], %[my_ticket], 2b		\n"
 87		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
 88		"	b	4b					\n"
 89		"	 subu	%[ticket], %[ticket], 1			\n"
 90		"	.previous					\n"
 91		"	.set pop					\n"
 92		: [ticket_ptr] "+m" (lock->lock),
 93		  [serving_now_ptr] "+m" (lock->h.serving_now),
 94		  [ticket] "=&r" (tmp),
 95		  [my_ticket] "=&r" (my_ticket)
 96		: [inc] "r" (inc));
 97	} else {
 98		__asm__ __volatile__ (
 99		"	.set push		# arch_spin_lock	\n"
100		"	.set noreorder					\n"
101		"							\n"
102		"1:	ll	%[ticket], %[ticket_ptr]		\n"
103		"	addu	%[my_ticket], %[ticket], %[inc]		\n"
104		"	sc	%[my_ticket], %[ticket_ptr]		\n"
105		"	beqz	%[my_ticket], 1b			\n"
106		"	 srl	%[my_ticket], %[ticket], 16		\n"
107		"	andi	%[ticket], %[ticket], 0xffff		\n"
108		"	andi	%[my_ticket], %[my_ticket], 0xffff	\n"
109		"	bne	%[ticket], %[my_ticket], 4f		\n"
110		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
111		"2:							\n"
112		"	.subsection 2					\n"
113		"4:	andi	%[ticket], %[ticket], 0x1fff		\n"
114		"	sll	%[ticket], 5				\n"
115		"							\n"
116		"6:	bnez	%[ticket], 6b				\n"
117		"	 subu	%[ticket], 1				\n"
118		"							\n"
119		"	lhu	%[ticket], %[serving_now_ptr]		\n"
120		"	beq	%[ticket], %[my_ticket], 2b		\n"
121		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
122		"	b	4b					\n"
123		"	 subu	%[ticket], %[ticket], 1			\n"
124		"	.previous					\n"
125		"	.set pop					\n"
126		: [ticket_ptr] "+m" (lock->lock),
127		  [serving_now_ptr] "+m" (lock->h.serving_now),
128		  [ticket] "=&r" (tmp),
129		  [my_ticket] "=&r" (my_ticket)
130		: [inc] "r" (inc));
131	}
132
133	smp_llsc_mb();
134}
135
136static inline void arch_spin_unlock(arch_spinlock_t *lock)
137{
138	unsigned int serving_now = lock->h.serving_now + 1;
139	wmb();
140	lock->h.serving_now = (u16)serving_now;
141	nudge_writes();
142}
143
144static inline unsigned int arch_spin_trylock(arch_spinlock_t *lock)
145{
146	int tmp, tmp2, tmp3;
147	int inc = 0x10000;
148
149	if (R10000_LLSC_WAR) {
150		__asm__ __volatile__ (
151		"	.set push		# arch_spin_trylock	\n"
152		"	.set noreorder					\n"
153		"							\n"
154		"1:	ll	%[ticket], %[ticket_ptr]		\n"
155		"	srl	%[my_ticket], %[ticket], 16		\n"
156		"	andi	%[my_ticket], %[my_ticket], 0xffff	\n"
157		"	andi	%[now_serving], %[ticket], 0xffff	\n"
158		"	bne	%[my_ticket], %[now_serving], 3f	\n"
159		"	 addu	%[ticket], %[ticket], %[inc]		\n"
160		"	sc	%[ticket], %[ticket_ptr]		\n"
161		"	beqzl	%[ticket], 1b				\n"
162		"	 li	%[ticket], 1				\n"
163		"2:							\n"
164		"	.subsection 2					\n"
165		"3:	b	2b					\n"
166		"	 li	%[ticket], 0				\n"
167		"	.previous					\n"
168		"	.set pop					\n"
169		: [ticket_ptr] "+m" (lock->lock),
170		  [ticket] "=&r" (tmp),
171		  [my_ticket] "=&r" (tmp2),
172		  [now_serving] "=&r" (tmp3)
173		: [inc] "r" (inc));
174	} else {
175		__asm__ __volatile__ (
176		"	.set push		# arch_spin_trylock	\n"
177		"	.set noreorder					\n"
178		"							\n"
179		"1:	ll	%[ticket], %[ticket_ptr]		\n"
180		"	srl	%[my_ticket], %[ticket], 16		\n"
181		"	andi	%[my_ticket], %[my_ticket], 0xffff	\n"
182		"	andi	%[now_serving], %[ticket], 0xffff	\n"
183		"	bne	%[my_ticket], %[now_serving], 3f	\n"
184		"	 addu	%[ticket], %[ticket], %[inc]		\n"
185		"	sc	%[ticket], %[ticket_ptr]		\n"
186		"	beqz	%[ticket], 1b				\n"
187		"	 li	%[ticket], 1				\n"
188		"2:							\n"
189		"	.subsection 2					\n"
190		"3:	b	2b					\n"
191		"	 li	%[ticket], 0				\n"
192		"	.previous					\n"
193		"	.set pop					\n"
194		: [ticket_ptr] "+m" (lock->lock),
195		  [ticket] "=&r" (tmp),
196		  [my_ticket] "=&r" (tmp2),
197		  [now_serving] "=&r" (tmp3)
198		: [inc] "r" (inc));
199	}
200
201	smp_llsc_mb();
202
203	return tmp;
204}
205
206/*
207 * Read-write spinlocks, allowing multiple readers but only one writer.
208 *
209 * NOTE! it is quite common to have readers in interrupts but no interrupt
210 * writers. For those circumstances we can "mix" irq-safe locks - any writer
211 * needs to get a irq-safe write-lock, but readers can get non-irqsafe
212 * read-locks.
213 */
214
215/*
216 * read_can_lock - would read_trylock() succeed?
217 * @lock: the rwlock in question.
218 */
219#define arch_read_can_lock(rw)	((rw)->lock >= 0)
220
221/*
222 * write_can_lock - would write_trylock() succeed?
223 * @lock: the rwlock in question.
224 */
225#define arch_write_can_lock(rw)	(!(rw)->lock)
226
227static inline void arch_read_lock(arch_rwlock_t *rw)
228{
229	unsigned int tmp;
230
231	if (R10000_LLSC_WAR) {
232		__asm__ __volatile__(
233		"	.set	noreorder	# arch_read_lock	\n"
234		"1:	ll	%1, %2					\n"
235		"	bltz	%1, 1b					\n"
236		"	 addu	%1, 1					\n"
237		"	sc	%1, %0					\n"
238		"	beqzl	%1, 1b					\n"
239		"	 nop						\n"
240		"	.set	reorder					\n"
241		: "=m" (rw->lock), "=&r" (tmp)
242		: "m" (rw->lock)
243		: "memory");
244	} else {
245		__asm__ __volatile__(
246		"	.set	noreorder	# arch_read_lock	\n"
247		"1:	ll	%1, %2					\n"
248		"	bltz	%1, 3f					\n"
249		"	 addu	%1, 1					\n"
250		"2:	sc	%1, %0					\n"
251		"	beqz	%1, 1b					\n"
252		"	 nop						\n"
253		"	.subsection 2					\n"
254		"3:	ll	%1, %2					\n"
255		"	bltz	%1, 3b					\n"
256		"	 addu	%1, 1					\n"
257		"	b	2b					\n"
258		"	 nop						\n"
259		"	.previous					\n"
260		"	.set	reorder					\n"
261		: "=m" (rw->lock), "=&r" (tmp)
262		: "m" (rw->lock)
263		: "memory");
264	}
265
266	smp_llsc_mb();
267}
268
269/* Note the use of sub, not subu which will make the kernel die with an
270   overflow exception if we ever try to unlock an rwlock that is already
271   unlocked or is being held by a writer.  */
272static inline void arch_read_unlock(arch_rwlock_t *rw)
273{
274	unsigned int tmp;
275
276	smp_mb__before_llsc();
277
278	if (R10000_LLSC_WAR) {
279		__asm__ __volatile__(
280		"1:	ll	%1, %2		# arch_read_unlock	\n"
281		"	sub	%1, 1					\n"
282		"	sc	%1, %0					\n"
283		"	beqzl	%1, 1b					\n"
284		: "=m" (rw->lock), "=&r" (tmp)
285		: "m" (rw->lock)
286		: "memory");
287	} else {
288		__asm__ __volatile__(
289		"	.set	noreorder	# arch_read_unlock	\n"
290		"1:	ll	%1, %2					\n"
291		"	sub	%1, 1					\n"
292		"	sc	%1, %0					\n"
293		"	beqz	%1, 2f					\n"
294		"	 nop						\n"
295		"	.subsection 2					\n"
296		"2:	b	1b					\n"
297		"	 nop						\n"
298		"	.previous					\n"
299		"	.set	reorder					\n"
300		: "=m" (rw->lock), "=&r" (tmp)
301		: "m" (rw->lock)
302		: "memory");
303	}
304}
305
306static inline void arch_write_lock(arch_rwlock_t *rw)
307{
308	unsigned int tmp;
309
310	if (R10000_LLSC_WAR) {
311		__asm__ __volatile__(
312		"	.set	noreorder	# arch_write_lock	\n"
313		"1:	ll	%1, %2					\n"
314		"	bnez	%1, 1b					\n"
315		"	 lui	%1, 0x8000				\n"
316		"	sc	%1, %0					\n"
317		"	beqzl	%1, 1b					\n"
318		"	 nop						\n"
319		"	.set	reorder					\n"
320		: "=m" (rw->lock), "=&r" (tmp)
321		: "m" (rw->lock)
322		: "memory");
323	} else {
324		__asm__ __volatile__(
325		"	.set	noreorder	# arch_write_lock	\n"
326		"1:	ll	%1, %2					\n"
327		"	bnez	%1, 3f					\n"
328		"	 lui	%1, 0x8000				\n"
329		"2:	sc	%1, %0					\n"
330		"	beqz	%1, 3f					\n"
331		"	 nop						\n"
332		"	.subsection 2					\n"
333		"3:	ll	%1, %2					\n"
334		"	bnez	%1, 3b					\n"
335		"	 lui	%1, 0x8000				\n"
336		"	b	2b					\n"
337		"	 nop						\n"
338		"	.previous					\n"
339		"	.set	reorder					\n"
340		: "=m" (rw->lock), "=&r" (tmp)
341		: "m" (rw->lock)
342		: "memory");
343	}
344
345	smp_llsc_mb();
346}
347
348static inline void arch_write_unlock(arch_rwlock_t *rw)
349{
350	smp_mb();
351
352	__asm__ __volatile__(
353	"				# arch_write_unlock	\n"
354	"	sw	$0, %0					\n"
355	: "=m" (rw->lock)
356	: "m" (rw->lock)
357	: "memory");
358}
359
360static inline int arch_read_trylock(arch_rwlock_t *rw)
361{
362	unsigned int tmp;
363	int ret;
364
365	if (R10000_LLSC_WAR) {
366		__asm__ __volatile__(
367		"	.set	noreorder	# arch_read_trylock	\n"
368		"	li	%2, 0					\n"
369		"1:	ll	%1, %3					\n"
370		"	bltz	%1, 2f					\n"
371		"	 addu	%1, 1					\n"
372		"	sc	%1, %0					\n"
373		"	.set	reorder					\n"
374		"	beqzl	%1, 1b					\n"
375		"	 nop						\n"
376		__WEAK_LLSC_MB
377		"	li	%2, 1					\n"
378		"2:							\n"
379		: "=m" (rw->lock), "=&r" (tmp), "=&r" (ret)
380		: "m" (rw->lock)
381		: "memory");
382	} else {
383		__asm__ __volatile__(
384		"	.set	noreorder	# arch_read_trylock	\n"
385		"	li	%2, 0					\n"
386		"1:	ll	%1, %3					\n"
387		"	bltz	%1, 2f					\n"
388		"	 addu	%1, 1					\n"
389		"	sc	%1, %0					\n"
390		"	beqz	%1, 1b					\n"
391		"	 nop						\n"
392		"	.set	reorder					\n"
393		__WEAK_LLSC_MB
394		"	li	%2, 1					\n"
395		"2:							\n"
396		: "=m" (rw->lock), "=&r" (tmp), "=&r" (ret)
397		: "m" (rw->lock)
398		: "memory");
399	}
400
401	return ret;
402}
403
404static inline int arch_write_trylock(arch_rwlock_t *rw)
405{
406	unsigned int tmp;
407	int ret;
408
409	if (R10000_LLSC_WAR) {
410		__asm__ __volatile__(
411		"	.set	noreorder	# arch_write_trylock	\n"
412		"	li	%2, 0					\n"
413		"1:	ll	%1, %3					\n"
414		"	bnez	%1, 2f					\n"
415		"	 lui	%1, 0x8000				\n"
416		"	sc	%1, %0					\n"
417		"	beqzl	%1, 1b					\n"
418		"	 nop						\n"
419		__WEAK_LLSC_MB
420		"	li	%2, 1					\n"
421		"	.set	reorder					\n"
422		"2:							\n"
423		: "=m" (rw->lock), "=&r" (tmp), "=&r" (ret)
424		: "m" (rw->lock)
425		: "memory");
426	} else {
427		__asm__ __volatile__(
428		"	.set	noreorder	# arch_write_trylock	\n"
429		"	li	%2, 0					\n"
430		"1:	ll	%1, %3					\n"
431		"	bnez	%1, 2f					\n"
432		"	lui	%1, 0x8000				\n"
433		"	sc	%1, %0					\n"
434		"	beqz	%1, 3f					\n"
435		"	 li	%2, 1					\n"
436		"2:							\n"
437		__WEAK_LLSC_MB
438		"	.subsection 2					\n"
439		"3:	b	1b					\n"
440		"	 li	%2, 0					\n"
441		"	.previous					\n"
442		"	.set	reorder					\n"
443		: "=m" (rw->lock), "=&r" (tmp), "=&r" (ret)
444		: "m" (rw->lock)
445		: "memory");
446	}
447
448	return ret;
449}
450
451#define arch_read_lock_flags(lock, flags) arch_read_lock(lock)
452#define arch_write_lock_flags(lock, flags) arch_write_lock(lock)
453
454#define arch_spin_relax(lock)	cpu_relax()
455#define arch_read_relax(lock)	cpu_relax()
456#define arch_write_relax(lock)	cpu_relax()
457
458#endif /* _ASM_SPINLOCK_H */
v4.10.11
  1/*
  2 * This file is subject to the terms and conditions of the GNU General Public
  3 * License.  See the file "COPYING" in the main directory of this archive
  4 * for more details.
  5 *
  6 * Copyright (C) 1999, 2000, 06 Ralf Baechle (ralf@linux-mips.org)
  7 * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
  8 */
  9#ifndef _ASM_SPINLOCK_H
 10#define _ASM_SPINLOCK_H
 11
 12#include <linux/compiler.h>
 13
 14#include <asm/barrier.h>
 15#include <asm/processor.h>
 16#include <asm/compiler.h>
 17#include <asm/war.h>
 18
 19/*
 20 * Your basic SMP spinlocks, allowing only a single CPU anywhere
 21 *
 22 * Simple spin lock operations.	 There are two variants, one clears IRQ's
 23 * on the local processor, one does not.
 24 *
 25 * These are fair FIFO ticket locks
 26 *
 27 * (the type definitions are in asm/spinlock_types.h)
 28 */
 29
 30
 31/*
 32 * Ticket locks are conceptually two parts, one indicating the current head of
 33 * the queue, and the other indicating the current tail. The lock is acquired
 34 * by atomically noting the tail and incrementing it by one (thus adding
 35 * ourself to the queue and noting our position), then waiting until the head
 36 * becomes equal to the the initial value of the tail.
 37 */
 38
 39static inline int arch_spin_is_locked(arch_spinlock_t *lock)
 40{
 41	u32 counters = ACCESS_ONCE(lock->lock);
 42
 43	return ((counters >> 16) ^ counters) & 0xffff;
 44}
 45
 46static inline int arch_spin_value_unlocked(arch_spinlock_t lock)
 47{
 48	return lock.h.serving_now == lock.h.ticket;
 49}
 50
 51#define arch_spin_lock_flags(lock, flags) arch_spin_lock(lock)
 52
 53static inline void arch_spin_unlock_wait(arch_spinlock_t *lock)
 54{
 55	u16 owner = READ_ONCE(lock->h.serving_now);
 56	smp_rmb();
 57	for (;;) {
 58		arch_spinlock_t tmp = READ_ONCE(*lock);
 59
 60		if (tmp.h.serving_now == tmp.h.ticket ||
 61		    tmp.h.serving_now != owner)
 62			break;
 63
 64		cpu_relax();
 65	}
 66	smp_acquire__after_ctrl_dep();
 67}
 68
 69static inline int arch_spin_is_contended(arch_spinlock_t *lock)
 70{
 71	u32 counters = ACCESS_ONCE(lock->lock);
 72
 73	return (((counters >> 16) - counters) & 0xffff) > 1;
 74}
 75#define arch_spin_is_contended	arch_spin_is_contended
 76
 77static inline void arch_spin_lock(arch_spinlock_t *lock)
 78{
 79	int my_ticket;
 80	int tmp;
 81	int inc = 0x10000;
 82
 83	if (R10000_LLSC_WAR) {
 84		__asm__ __volatile__ (
 85		"	.set push		# arch_spin_lock	\n"
 86		"	.set noreorder					\n"
 87		"							\n"
 88		"1:	ll	%[ticket], %[ticket_ptr]		\n"
 89		"	addu	%[my_ticket], %[ticket], %[inc]		\n"
 90		"	sc	%[my_ticket], %[ticket_ptr]		\n"
 91		"	beqzl	%[my_ticket], 1b			\n"
 92		"	 nop						\n"
 93		"	srl	%[my_ticket], %[ticket], 16		\n"
 94		"	andi	%[ticket], %[ticket], 0xffff		\n"
 
 95		"	bne	%[ticket], %[my_ticket], 4f		\n"
 96		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
 97		"2:							\n"
 98		"	.subsection 2					\n"
 99		"4:	andi	%[ticket], %[ticket], 0xffff		\n"
100		"	sll	%[ticket], 5				\n"
101		"							\n"
102		"6:	bnez	%[ticket], 6b				\n"
103		"	 subu	%[ticket], 1				\n"
104		"							\n"
105		"	lhu	%[ticket], %[serving_now_ptr]		\n"
106		"	beq	%[ticket], %[my_ticket], 2b		\n"
107		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
108		"	b	4b					\n"
109		"	 subu	%[ticket], %[ticket], 1			\n"
110		"	.previous					\n"
111		"	.set pop					\n"
112		: [ticket_ptr] "+" GCC_OFF_SMALL_ASM() (lock->lock),
113		  [serving_now_ptr] "+m" (lock->h.serving_now),
114		  [ticket] "=&r" (tmp),
115		  [my_ticket] "=&r" (my_ticket)
116		: [inc] "r" (inc));
117	} else {
118		__asm__ __volatile__ (
119		"	.set push		# arch_spin_lock	\n"
120		"	.set noreorder					\n"
121		"							\n"
122		"1:	ll	%[ticket], %[ticket_ptr]		\n"
123		"	addu	%[my_ticket], %[ticket], %[inc]		\n"
124		"	sc	%[my_ticket], %[ticket_ptr]		\n"
125		"	beqz	%[my_ticket], 1b			\n"
126		"	 srl	%[my_ticket], %[ticket], 16		\n"
127		"	andi	%[ticket], %[ticket], 0xffff		\n"
 
128		"	bne	%[ticket], %[my_ticket], 4f		\n"
129		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
130		"2:	.insn						\n"
131		"	.subsection 2					\n"
132		"4:	andi	%[ticket], %[ticket], 0xffff		\n"
133		"	sll	%[ticket], 5				\n"
134		"							\n"
135		"6:	bnez	%[ticket], 6b				\n"
136		"	 subu	%[ticket], 1				\n"
137		"							\n"
138		"	lhu	%[ticket], %[serving_now_ptr]		\n"
139		"	beq	%[ticket], %[my_ticket], 2b		\n"
140		"	 subu	%[ticket], %[my_ticket], %[ticket]	\n"
141		"	b	4b					\n"
142		"	 subu	%[ticket], %[ticket], 1			\n"
143		"	.previous					\n"
144		"	.set pop					\n"
145		: [ticket_ptr] "+" GCC_OFF_SMALL_ASM() (lock->lock),
146		  [serving_now_ptr] "+m" (lock->h.serving_now),
147		  [ticket] "=&r" (tmp),
148		  [my_ticket] "=&r" (my_ticket)
149		: [inc] "r" (inc));
150	}
151
152	smp_llsc_mb();
153}
154
155static inline void arch_spin_unlock(arch_spinlock_t *lock)
156{
157	unsigned int serving_now = lock->h.serving_now + 1;
158	wmb();
159	lock->h.serving_now = (u16)serving_now;
160	nudge_writes();
161}
162
163static inline unsigned int arch_spin_trylock(arch_spinlock_t *lock)
164{
165	int tmp, tmp2, tmp3;
166	int inc = 0x10000;
167
168	if (R10000_LLSC_WAR) {
169		__asm__ __volatile__ (
170		"	.set push		# arch_spin_trylock	\n"
171		"	.set noreorder					\n"
172		"							\n"
173		"1:	ll	%[ticket], %[ticket_ptr]		\n"
174		"	srl	%[my_ticket], %[ticket], 16		\n"
 
175		"	andi	%[now_serving], %[ticket], 0xffff	\n"
176		"	bne	%[my_ticket], %[now_serving], 3f	\n"
177		"	 addu	%[ticket], %[ticket], %[inc]		\n"
178		"	sc	%[ticket], %[ticket_ptr]		\n"
179		"	beqzl	%[ticket], 1b				\n"
180		"	 li	%[ticket], 1				\n"
181		"2:							\n"
182		"	.subsection 2					\n"
183		"3:	b	2b					\n"
184		"	 li	%[ticket], 0				\n"
185		"	.previous					\n"
186		"	.set pop					\n"
187		: [ticket_ptr] "+" GCC_OFF_SMALL_ASM() (lock->lock),
188		  [ticket] "=&r" (tmp),
189		  [my_ticket] "=&r" (tmp2),
190		  [now_serving] "=&r" (tmp3)
191		: [inc] "r" (inc));
192	} else {
193		__asm__ __volatile__ (
194		"	.set push		# arch_spin_trylock	\n"
195		"	.set noreorder					\n"
196		"							\n"
197		"1:	ll	%[ticket], %[ticket_ptr]		\n"
198		"	srl	%[my_ticket], %[ticket], 16		\n"
 
199		"	andi	%[now_serving], %[ticket], 0xffff	\n"
200		"	bne	%[my_ticket], %[now_serving], 3f	\n"
201		"	 addu	%[ticket], %[ticket], %[inc]		\n"
202		"	sc	%[ticket], %[ticket_ptr]		\n"
203		"	beqz	%[ticket], 1b				\n"
204		"	 li	%[ticket], 1				\n"
205		"2:	.insn						\n"
206		"	.subsection 2					\n"
207		"3:	b	2b					\n"
208		"	 li	%[ticket], 0				\n"
209		"	.previous					\n"
210		"	.set pop					\n"
211		: [ticket_ptr] "+" GCC_OFF_SMALL_ASM() (lock->lock),
212		  [ticket] "=&r" (tmp),
213		  [my_ticket] "=&r" (tmp2),
214		  [now_serving] "=&r" (tmp3)
215		: [inc] "r" (inc));
216	}
217
218	smp_llsc_mb();
219
220	return tmp;
221}
222
223/*
224 * Read-write spinlocks, allowing multiple readers but only one writer.
225 *
226 * NOTE! it is quite common to have readers in interrupts but no interrupt
227 * writers. For those circumstances we can "mix" irq-safe locks - any writer
228 * needs to get a irq-safe write-lock, but readers can get non-irqsafe
229 * read-locks.
230 */
231
232/*
233 * read_can_lock - would read_trylock() succeed?
234 * @lock: the rwlock in question.
235 */
236#define arch_read_can_lock(rw)	((rw)->lock >= 0)
237
238/*
239 * write_can_lock - would write_trylock() succeed?
240 * @lock: the rwlock in question.
241 */
242#define arch_write_can_lock(rw) (!(rw)->lock)
243
244static inline void arch_read_lock(arch_rwlock_t *rw)
245{
246	unsigned int tmp;
247
248	if (R10000_LLSC_WAR) {
249		__asm__ __volatile__(
250		"	.set	noreorder	# arch_read_lock	\n"
251		"1:	ll	%1, %2					\n"
252		"	bltz	%1, 1b					\n"
253		"	 addu	%1, 1					\n"
254		"	sc	%1, %0					\n"
255		"	beqzl	%1, 1b					\n"
256		"	 nop						\n"
257		"	.set	reorder					\n"
258		: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp)
259		: GCC_OFF_SMALL_ASM() (rw->lock)
260		: "memory");
261	} else {
262		do {
263			__asm__ __volatile__(
264			"1:	ll	%1, %2	# arch_read_lock	\n"
265			"	bltz	%1, 1b				\n"
266			"	 addu	%1, 1				\n"
267			"2:	sc	%1, %0				\n"
268			: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp)
269			: GCC_OFF_SMALL_ASM() (rw->lock)
270			: "memory");
271		} while (unlikely(!tmp));
 
 
 
 
 
 
 
 
 
272	}
273
274	smp_llsc_mb();
275}
276
 
 
 
277static inline void arch_read_unlock(arch_rwlock_t *rw)
278{
279	unsigned int tmp;
280
281	smp_mb__before_llsc();
282
283	if (R10000_LLSC_WAR) {
284		__asm__ __volatile__(
285		"1:	ll	%1, %2		# arch_read_unlock	\n"
286		"	addiu	%1, -1					\n"
287		"	sc	%1, %0					\n"
288		"	beqzl	%1, 1b					\n"
289		: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp)
290		: GCC_OFF_SMALL_ASM() (rw->lock)
291		: "memory");
292	} else {
293		do {
294			__asm__ __volatile__(
295			"1:	ll	%1, %2	# arch_read_unlock	\n"
296			"	addiu	%1, -1				\n"
297			"	sc	%1, %0				\n"
298			: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp)
299			: GCC_OFF_SMALL_ASM() (rw->lock)
300			: "memory");
301		} while (unlikely(!tmp));
 
 
 
 
 
 
302	}
303}
304
305static inline void arch_write_lock(arch_rwlock_t *rw)
306{
307	unsigned int tmp;
308
309	if (R10000_LLSC_WAR) {
310		__asm__ __volatile__(
311		"	.set	noreorder	# arch_write_lock	\n"
312		"1:	ll	%1, %2					\n"
313		"	bnez	%1, 1b					\n"
314		"	 lui	%1, 0x8000				\n"
315		"	sc	%1, %0					\n"
316		"	beqzl	%1, 1b					\n"
317		"	 nop						\n"
318		"	.set	reorder					\n"
319		: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp)
320		: GCC_OFF_SMALL_ASM() (rw->lock)
321		: "memory");
322	} else {
323		do {
324			__asm__ __volatile__(
325			"1:	ll	%1, %2	# arch_write_lock	\n"
326			"	bnez	%1, 1b				\n"
327			"	 lui	%1, 0x8000			\n"
328			"2:	sc	%1, %0				\n"
329			: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp)
330			: GCC_OFF_SMALL_ASM() (rw->lock)
331			: "memory");
332		} while (unlikely(!tmp));
 
 
 
 
 
 
 
 
 
333	}
334
335	smp_llsc_mb();
336}
337
338static inline void arch_write_unlock(arch_rwlock_t *rw)
339{
340	smp_mb__before_llsc();
341
342	__asm__ __volatile__(
343	"				# arch_write_unlock	\n"
344	"	sw	$0, %0					\n"
345	: "=m" (rw->lock)
346	: "m" (rw->lock)
347	: "memory");
348}
349
350static inline int arch_read_trylock(arch_rwlock_t *rw)
351{
352	unsigned int tmp;
353	int ret;
354
355	if (R10000_LLSC_WAR) {
356		__asm__ __volatile__(
357		"	.set	noreorder	# arch_read_trylock	\n"
358		"	li	%2, 0					\n"
359		"1:	ll	%1, %3					\n"
360		"	bltz	%1, 2f					\n"
361		"	 addu	%1, 1					\n"
362		"	sc	%1, %0					\n"
363		"	.set	reorder					\n"
364		"	beqzl	%1, 1b					\n"
365		"	 nop						\n"
366		__WEAK_LLSC_MB
367		"	li	%2, 1					\n"
368		"2:							\n"
369		: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp), "=&r" (ret)
370		: GCC_OFF_SMALL_ASM() (rw->lock)
371		: "memory");
372	} else {
373		__asm__ __volatile__(
374		"	.set	noreorder	# arch_read_trylock	\n"
375		"	li	%2, 0					\n"
376		"1:	ll	%1, %3					\n"
377		"	bltz	%1, 2f					\n"
378		"	 addu	%1, 1					\n"
379		"	sc	%1, %0					\n"
380		"	beqz	%1, 1b					\n"
381		"	 nop						\n"
382		"	.set	reorder					\n"
383		__WEAK_LLSC_MB
384		"	li	%2, 1					\n"
385		"2:	.insn						\n"
386		: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp), "=&r" (ret)
387		: GCC_OFF_SMALL_ASM() (rw->lock)
388		: "memory");
389	}
390
391	return ret;
392}
393
394static inline int arch_write_trylock(arch_rwlock_t *rw)
395{
396	unsigned int tmp;
397	int ret;
398
399	if (R10000_LLSC_WAR) {
400		__asm__ __volatile__(
401		"	.set	noreorder	# arch_write_trylock	\n"
402		"	li	%2, 0					\n"
403		"1:	ll	%1, %3					\n"
404		"	bnez	%1, 2f					\n"
405		"	 lui	%1, 0x8000				\n"
406		"	sc	%1, %0					\n"
407		"	beqzl	%1, 1b					\n"
408		"	 nop						\n"
409		__WEAK_LLSC_MB
410		"	li	%2, 1					\n"
411		"	.set	reorder					\n"
412		"2:							\n"
413		: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp), "=&r" (ret)
414		: GCC_OFF_SMALL_ASM() (rw->lock)
415		: "memory");
416	} else {
417		do {
418			__asm__ __volatile__(
419			"	ll	%1, %3	# arch_write_trylock	\n"
420			"	li	%2, 0				\n"
421			"	bnez	%1, 2f				\n"
422			"	lui	%1, 0x8000			\n"
423			"	sc	%1, %0				\n"
424			"	li	%2, 1				\n"
425			"2:	.insn					\n"
426			: "=" GCC_OFF_SMALL_ASM() (rw->lock), "=&r" (tmp),
427			  "=&r" (ret)
428			: GCC_OFF_SMALL_ASM() (rw->lock)
429			: "memory");
430		} while (unlikely(!tmp));
431
432		smp_llsc_mb();
 
 
 
433	}
434
435	return ret;
436}
437
438#define arch_read_lock_flags(lock, flags) arch_read_lock(lock)
439#define arch_write_lock_flags(lock, flags) arch_write_lock(lock)
440
441#define arch_spin_relax(lock)	cpu_relax()
442#define arch_read_relax(lock)	cpu_relax()
443#define arch_write_relax(lock)	cpu_relax()
444
445#endif /* _ASM_SPINLOCK_H */