Merge branch 'topic/emu10k1' into for-linus
[linux-2.6] / arch / s390 / lib / spinlock.c
1 /*
2  *  arch/s390/lib/spinlock.c
3  *    Out of line spinlock code.
4  *
5  *    Copyright (C) IBM Corp. 2004, 2006
6  *    Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com)
7  */
8
9 #include <linux/types.h>
10 #include <linux/module.h>
11 #include <linux/spinlock.h>
12 #include <linux/init.h>
13 #include <asm/io.h>
14
15 int spin_retry = 1000;
16
17 /**
18  * spin_retry= parameter
19  */
20 static int __init spin_retry_setup(char *str)
21 {
22         spin_retry = simple_strtoul(str, &str, 0);
23         return 1;
24 }
25 __setup("spin_retry=", spin_retry_setup);
26
27 static inline void _raw_yield(void)
28 {
29         if (MACHINE_HAS_DIAG44)
30                 asm volatile("diag 0,0,0x44");
31 }
32
33 static inline void _raw_yield_cpu(int cpu)
34 {
35         if (MACHINE_HAS_DIAG9C)
36                 asm volatile("diag %0,0,0x9c"
37                              : : "d" (__cpu_logical_map[cpu]));
38         else
39                 _raw_yield();
40 }
41
42 void _raw_spin_lock_wait(raw_spinlock_t *lp)
43 {
44         int count = spin_retry;
45         unsigned int cpu = ~smp_processor_id();
46
47         while (1) {
48                 if (count-- <= 0) {
49                         unsigned int owner = lp->owner_cpu;
50                         if (owner != 0)
51                                 _raw_yield_cpu(~owner);
52                         count = spin_retry;
53                 }
54                 if (__raw_spin_is_locked(lp))
55                         continue;
56                 if (_raw_compare_and_swap(&lp->owner_cpu, 0, cpu) == 0)
57                         return;
58         }
59 }
60 EXPORT_SYMBOL(_raw_spin_lock_wait);
61
62 void _raw_spin_lock_wait_flags(raw_spinlock_t *lp, unsigned long flags)
63 {
64         int count = spin_retry;
65         unsigned int cpu = ~smp_processor_id();
66
67         local_irq_restore(flags);
68         while (1) {
69                 if (count-- <= 0) {
70                         unsigned int owner = lp->owner_cpu;
71                         if (owner != 0)
72                                 _raw_yield_cpu(~owner);
73                         count = spin_retry;
74                 }
75                 if (__raw_spin_is_locked(lp))
76                         continue;
77                 local_irq_disable();
78                 if (_raw_compare_and_swap(&lp->owner_cpu, 0, cpu) == 0)
79                         return;
80                 local_irq_restore(flags);
81         }
82 }
83 EXPORT_SYMBOL(_raw_spin_lock_wait_flags);
84
85 int _raw_spin_trylock_retry(raw_spinlock_t *lp)
86 {
87         unsigned int cpu = ~smp_processor_id();
88         int count;
89
90         for (count = spin_retry; count > 0; count--) {
91                 if (__raw_spin_is_locked(lp))
92                         continue;
93                 if (_raw_compare_and_swap(&lp->owner_cpu, 0, cpu) == 0)
94                         return 1;
95         }
96         return 0;
97 }
98 EXPORT_SYMBOL(_raw_spin_trylock_retry);
99
100 void _raw_spin_relax(raw_spinlock_t *lock)
101 {
102         unsigned int cpu = lock->owner_cpu;
103         if (cpu != 0)
104                 _raw_yield_cpu(~cpu);
105 }
106 EXPORT_SYMBOL(_raw_spin_relax);
107
108 void _raw_read_lock_wait(raw_rwlock_t *rw)
109 {
110         unsigned int old;
111         int count = spin_retry;
112
113         while (1) {
114                 if (count-- <= 0) {
115                         _raw_yield();
116                         count = spin_retry;
117                 }
118                 if (!__raw_read_can_lock(rw))
119                         continue;
120                 old = rw->lock & 0x7fffffffU;
121                 if (_raw_compare_and_swap(&rw->lock, old, old + 1) == old)
122                         return;
123         }
124 }
125 EXPORT_SYMBOL(_raw_read_lock_wait);
126
127 int _raw_read_trylock_retry(raw_rwlock_t *rw)
128 {
129         unsigned int old;
130         int count = spin_retry;
131
132         while (count-- > 0) {
133                 if (!__raw_read_can_lock(rw))
134                         continue;
135                 old = rw->lock & 0x7fffffffU;
136                 if (_raw_compare_and_swap(&rw->lock, old, old + 1) == old)
137                         return 1;
138         }
139         return 0;
140 }
141 EXPORT_SYMBOL(_raw_read_trylock_retry);
142
143 void _raw_write_lock_wait(raw_rwlock_t *rw)
144 {
145         int count = spin_retry;
146
147         while (1) {
148                 if (count-- <= 0) {
149                         _raw_yield();
150                         count = spin_retry;
151                 }
152                 if (!__raw_write_can_lock(rw))
153                         continue;
154                 if (_raw_compare_and_swap(&rw->lock, 0, 0x80000000) == 0)
155                         return;
156         }
157 }
158 EXPORT_SYMBOL(_raw_write_lock_wait);
159
160 int _raw_write_trylock_retry(raw_rwlock_t *rw)
161 {
162         int count = spin_retry;
163
164         while (count-- > 0) {
165                 if (!__raw_write_can_lock(rw))
166                         continue;
167                 if (_raw_compare_and_swap(&rw->lock, 0, 0x80000000) == 0)
168                         return 1;
169         }
170         return 0;
171 }
172 EXPORT_SYMBOL(_raw_write_trylock_retry);