Merge remote-tracking branch 'origin/master' into drm-misc-fixes
[GitHub/MotorolaMobilityLLC/kernel-slsi.git] / arch / ia64 / include / asm / spinlock.h
1 #ifndef _ASM_IA64_SPINLOCK_H
2 #define _ASM_IA64_SPINLOCK_H
3
4 /*
5 * Copyright (C) 1998-2003 Hewlett-Packard Co
6 * David Mosberger-Tang <davidm@hpl.hp.com>
7 * Copyright (C) 1999 Walt Drummond <drummond@valinux.com>
8 *
9 * This file is used for SMP configurations only.
10 */
11
12 #include <linux/compiler.h>
13 #include <linux/kernel.h>
14 #include <linux/bitops.h>
15
16 #include <linux/atomic.h>
17 #include <asm/intrinsics.h>
18 #include <asm/barrier.h>
19 #include <asm/processor.h>
20
21 #define arch_spin_lock_init(x) ((x)->lock = 0)
22
23 /*
24 * Ticket locks are conceptually two parts, one indicating the current head of
25 * the queue, and the other indicating the current tail. The lock is acquired
26 * by atomically noting the tail and incrementing it by one (thus adding
27 * ourself to the queue and noting our position), then waiting until the head
28 * becomes equal to the the initial value of the tail.
29 * The pad bits in the middle are used to prevent the next_ticket number
30 * overflowing into the now_serving number.
31 *
32 * 31 17 16 15 14 0
33 * +----------------------------------------------------+
34 * | now_serving | padding | next_ticket |
35 * +----------------------------------------------------+
36 */
37
38 #define TICKET_SHIFT 17
39 #define TICKET_BITS 15
40 #define TICKET_MASK ((1 << TICKET_BITS) - 1)
41
42 static __always_inline void __ticket_spin_lock(arch_spinlock_t *lock)
43 {
44 int *p = (int *)&lock->lock, ticket, serve;
45
46 ticket = ia64_fetchadd(1, p, acq);
47
48 if (!(((ticket >> TICKET_SHIFT) ^ ticket) & TICKET_MASK))
49 return;
50
51 ia64_invala();
52
53 for (;;) {
54 asm volatile ("ld4.c.nc %0=[%1]" : "=r"(serve) : "r"(p) : "memory");
55
56 if (!(((serve >> TICKET_SHIFT) ^ ticket) & TICKET_MASK))
57 return;
58 cpu_relax();
59 }
60 }
61
62 static __always_inline int __ticket_spin_trylock(arch_spinlock_t *lock)
63 {
64 int tmp = ACCESS_ONCE(lock->lock);
65
66 if (!(((tmp >> TICKET_SHIFT) ^ tmp) & TICKET_MASK))
67 return ia64_cmpxchg(acq, &lock->lock, tmp, tmp + 1, sizeof (tmp)) == tmp;
68 return 0;
69 }
70
71 static __always_inline void __ticket_spin_unlock(arch_spinlock_t *lock)
72 {
73 unsigned short *p = (unsigned short *)&lock->lock + 1, tmp;
74
75 asm volatile ("ld2.bias %0=[%1]" : "=r"(tmp) : "r"(p));
76 ACCESS_ONCE(*p) = (tmp + 2) & ~1;
77 }
78
79 static inline int __ticket_spin_is_locked(arch_spinlock_t *lock)
80 {
81 long tmp = ACCESS_ONCE(lock->lock);
82
83 return !!(((tmp >> TICKET_SHIFT) ^ tmp) & TICKET_MASK);
84 }
85
86 static inline int __ticket_spin_is_contended(arch_spinlock_t *lock)
87 {
88 long tmp = ACCESS_ONCE(lock->lock);
89
90 return ((tmp - (tmp >> TICKET_SHIFT)) & TICKET_MASK) > 1;
91 }
92
93 static __always_inline int arch_spin_value_unlocked(arch_spinlock_t lock)
94 {
95 return !(((lock.lock >> TICKET_SHIFT) ^ lock.lock) & TICKET_MASK);
96 }
97
98 static inline int arch_spin_is_locked(arch_spinlock_t *lock)
99 {
100 return __ticket_spin_is_locked(lock);
101 }
102
103 static inline int arch_spin_is_contended(arch_spinlock_t *lock)
104 {
105 return __ticket_spin_is_contended(lock);
106 }
107 #define arch_spin_is_contended arch_spin_is_contended
108
109 static __always_inline void arch_spin_lock(arch_spinlock_t *lock)
110 {
111 __ticket_spin_lock(lock);
112 }
113
114 static __always_inline int arch_spin_trylock(arch_spinlock_t *lock)
115 {
116 return __ticket_spin_trylock(lock);
117 }
118
119 static __always_inline void arch_spin_unlock(arch_spinlock_t *lock)
120 {
121 __ticket_spin_unlock(lock);
122 }
123
124 static __always_inline void arch_spin_lock_flags(arch_spinlock_t *lock,
125 unsigned long flags)
126 {
127 arch_spin_lock(lock);
128 }
129
130 #define arch_read_can_lock(rw) (*(volatile int *)(rw) >= 0)
131 #define arch_write_can_lock(rw) (*(volatile int *)(rw) == 0)
132
133 #ifdef ASM_SUPPORTED
134
135 static __always_inline void
136 arch_read_lock_flags(arch_rwlock_t *lock, unsigned long flags)
137 {
138 __asm__ __volatile__ (
139 "tbit.nz p6, p0 = %1,%2\n"
140 "br.few 3f\n"
141 "1:\n"
142 "fetchadd4.rel r2 = [%0], -1;;\n"
143 "(p6) ssm psr.i\n"
144 "2:\n"
145 "hint @pause\n"
146 "ld4 r2 = [%0];;\n"
147 "cmp4.lt p7,p0 = r2, r0\n"
148 "(p7) br.cond.spnt.few 2b\n"
149 "(p6) rsm psr.i\n"
150 ";;\n"
151 "3:\n"
152 "fetchadd4.acq r2 = [%0], 1;;\n"
153 "cmp4.lt p7,p0 = r2, r0\n"
154 "(p7) br.cond.spnt.few 1b\n"
155 : : "r"(lock), "r"(flags), "i"(IA64_PSR_I_BIT)
156 : "p6", "p7", "r2", "memory");
157 }
158
159 #define arch_read_lock(lock) arch_read_lock_flags(lock, 0)
160
161 #else /* !ASM_SUPPORTED */
162
163 #define arch_read_lock_flags(rw, flags) arch_read_lock(rw)
164
165 #define arch_read_lock(rw) \
166 do { \
167 arch_rwlock_t *__read_lock_ptr = (rw); \
168 \
169 while (unlikely(ia64_fetchadd(1, (int *) __read_lock_ptr, acq) < 0)) { \
170 ia64_fetchadd(-1, (int *) __read_lock_ptr, rel); \
171 while (*(volatile int *)__read_lock_ptr < 0) \
172 cpu_relax(); \
173 } \
174 } while (0)
175
176 #endif /* !ASM_SUPPORTED */
177
178 #define arch_read_unlock(rw) \
179 do { \
180 arch_rwlock_t *__read_lock_ptr = (rw); \
181 ia64_fetchadd(-1, (int *) __read_lock_ptr, rel); \
182 } while (0)
183
184 #ifdef ASM_SUPPORTED
185
186 static __always_inline void
187 arch_write_lock_flags(arch_rwlock_t *lock, unsigned long flags)
188 {
189 __asm__ __volatile__ (
190 "tbit.nz p6, p0 = %1, %2\n"
191 "mov ar.ccv = r0\n"
192 "dep r29 = -1, r0, 31, 1\n"
193 "br.few 3f;;\n"
194 "1:\n"
195 "(p6) ssm psr.i\n"
196 "2:\n"
197 "hint @pause\n"
198 "ld4 r2 = [%0];;\n"
199 "cmp4.eq p0,p7 = r0, r2\n"
200 "(p7) br.cond.spnt.few 2b\n"
201 "(p6) rsm psr.i\n"
202 ";;\n"
203 "3:\n"
204 "cmpxchg4.acq r2 = [%0], r29, ar.ccv;;\n"
205 "cmp4.eq p0,p7 = r0, r2\n"
206 "(p7) br.cond.spnt.few 1b;;\n"
207 : : "r"(lock), "r"(flags), "i"(IA64_PSR_I_BIT)
208 : "ar.ccv", "p6", "p7", "r2", "r29", "memory");
209 }
210
211 #define arch_write_lock(rw) arch_write_lock_flags(rw, 0)
212
213 #define arch_write_trylock(rw) \
214 ({ \
215 register long result; \
216 \
217 __asm__ __volatile__ ( \
218 "mov ar.ccv = r0\n" \
219 "dep r29 = -1, r0, 31, 1;;\n" \
220 "cmpxchg4.acq %0 = [%1], r29, ar.ccv\n" \
221 : "=r"(result) : "r"(rw) : "ar.ccv", "r29", "memory"); \
222 (result == 0); \
223 })
224
225 static inline void arch_write_unlock(arch_rwlock_t *x)
226 {
227 u8 *y = (u8 *)x;
228 barrier();
229 asm volatile ("st1.rel.nta [%0] = r0\n\t" :: "r"(y+3) : "memory" );
230 }
231
232 #else /* !ASM_SUPPORTED */
233
234 #define arch_write_lock_flags(l, flags) arch_write_lock(l)
235
236 #define arch_write_lock(l) \
237 ({ \
238 __u64 ia64_val, ia64_set_val = ia64_dep_mi(-1, 0, 31, 1); \
239 __u32 *ia64_write_lock_ptr = (__u32 *) (l); \
240 do { \
241 while (*ia64_write_lock_ptr) \
242 ia64_barrier(); \
243 ia64_val = ia64_cmpxchg4_acq(ia64_write_lock_ptr, ia64_set_val, 0); \
244 } while (ia64_val); \
245 })
246
247 #define arch_write_trylock(rw) \
248 ({ \
249 __u64 ia64_val; \
250 __u64 ia64_set_val = ia64_dep_mi(-1, 0, 31,1); \
251 ia64_val = ia64_cmpxchg4_acq((__u32 *)(rw), ia64_set_val, 0); \
252 (ia64_val == 0); \
253 })
254
255 static inline void arch_write_unlock(arch_rwlock_t *x)
256 {
257 barrier();
258 x->write_lock = 0;
259 }
260
261 #endif /* !ASM_SUPPORTED */
262
263 static inline int arch_read_trylock(arch_rwlock_t *x)
264 {
265 union {
266 arch_rwlock_t lock;
267 __u32 word;
268 } old, new;
269 old.lock = new.lock = *x;
270 old.lock.write_lock = new.lock.write_lock = 0;
271 ++new.lock.read_counter;
272 return (u32)ia64_cmpxchg4_acq((__u32 *)(x), new.word, old.word) == old.word;
273 }
274
275 #define arch_spin_relax(lock) cpu_relax()
276 #define arch_read_relax(lock) cpu_relax()
277 #define arch_write_relax(lock) cpu_relax()
278
279 #endif /* _ASM_IA64_SPINLOCK_H */