| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 1 | #include <linux/compiler.h> | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 2 | #include <linux/module.h> | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 3 | #include <linux/types.h> | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 4 |  | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 5 | #include <asm/processor.h> | 
 | 6 | #include <asm/cmpxchg.h> | 
 | 7 | #include <asm/atomic.h> | 
 | 8 |  | 
| Ingo Molnar | 3ac805d | 2009-07-03 12:51:19 +0200 | [diff] [blame] | 9 | static noinline u64 cmpxchg8b(u64 *ptr, u64 old, u64 new) | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 10 | { | 
| Eric Dumazet | 69237f9 | 2009-07-03 13:26:41 +0200 | [diff] [blame] | 11 | 	u32 low = new; | 
 | 12 | 	u32 high = new >> 32; | 
 | 13 |  | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 14 | 	asm volatile( | 
| Eric Dumazet | 69237f9 | 2009-07-03 13:26:41 +0200 | [diff] [blame] | 15 | 		LOCK_PREFIX "cmpxchg8b %1\n" | 
 | 16 | 		     : "+A" (old), "+m" (*ptr) | 
 | 17 | 		     :  "b" (low),  "c" (high) | 
 | 18 | 		     ); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 19 | 	return old; | 
 | 20 | } | 
 | 21 |  | 
 | 22 | u64 atomic64_cmpxchg(atomic64_t *ptr, u64 old_val, u64 new_val) | 
 | 23 | { | 
 | 24 | 	return cmpxchg8b(&ptr->counter, old_val, new_val); | 
 | 25 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 26 | EXPORT_SYMBOL(atomic64_cmpxchg); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 27 |  | 
 | 28 | /** | 
 | 29 |  * atomic64_xchg - xchg atomic64 variable | 
 | 30 |  * @ptr:      pointer to type atomic64_t | 
 | 31 |  * @new_val:  value to assign | 
 | 32 |  * | 
 | 33 |  * Atomically xchgs the value of @ptr to @new_val and returns | 
 | 34 |  * the old value. | 
 | 35 |  */ | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 36 | u64 atomic64_xchg(atomic64_t *ptr, u64 new_val) | 
 | 37 | { | 
| Ingo Molnar | 3a8d178 | 2009-07-03 19:56:36 +0200 | [diff] [blame] | 38 | 	/* | 
 | 39 | 	 * Try first with a (possibly incorrect) assumption about | 
 | 40 | 	 * what we have there. We'll do two loops most likely, | 
 | 41 | 	 * but we'll get an ownership MESI transaction straight away | 
 | 42 | 	 * instead of a read transaction followed by a | 
 | 43 | 	 * flush-for-ownership transaction: | 
 | 44 | 	 */ | 
 | 45 | 	u64 old_val, real_val = 0; | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 46 |  | 
 | 47 | 	do { | 
| Ingo Molnar | 3a8d178 | 2009-07-03 19:56:36 +0200 | [diff] [blame] | 48 | 		old_val = real_val; | 
 | 49 |  | 
 | 50 | 		real_val = atomic64_cmpxchg(ptr, old_val, new_val); | 
 | 51 |  | 
 | 52 | 	} while (real_val != old_val); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 53 |  | 
 | 54 | 	return old_val; | 
 | 55 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 56 | EXPORT_SYMBOL(atomic64_xchg); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 57 |  | 
 | 58 | /** | 
 | 59 |  * atomic64_set - set atomic64 variable | 
 | 60 |  * @ptr:      pointer to type atomic64_t | 
 | 61 |  * @new_val:  value to assign | 
 | 62 |  * | 
 | 63 |  * Atomically sets the value of @ptr to @new_val. | 
 | 64 |  */ | 
 | 65 | void atomic64_set(atomic64_t *ptr, u64 new_val) | 
 | 66 | { | 
 | 67 | 	atomic64_xchg(ptr, new_val); | 
 | 68 | } | 
| Eric Dumazet | a79f0da | 2009-07-03 16:50:10 +0200 | [diff] [blame] | 69 | EXPORT_SYMBOL(atomic64_set); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 70 |  | 
 | 71 | /** | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 72 | EXPORT_SYMBOL(atomic64_read); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 73 |  * atomic64_add_return - add and return | 
 | 74 |  * @delta: integer value to add | 
 | 75 |  * @ptr:   pointer to type atomic64_t | 
 | 76 |  * | 
 | 77 |  * Atomically adds @delta to @ptr and returns @delta + *@ptr | 
 | 78 |  */ | 
| Ingo Molnar | 3ac805d | 2009-07-03 12:51:19 +0200 | [diff] [blame] | 79 | noinline u64 atomic64_add_return(u64 delta, atomic64_t *ptr) | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 80 | { | 
| Ingo Molnar | 824975e | 2009-07-03 12:39:07 +0200 | [diff] [blame] | 81 | 	/* | 
| Ingo Molnar | 3a8d178 | 2009-07-03 19:56:36 +0200 | [diff] [blame] | 82 | 	 * Try first with a (possibly incorrect) assumption about | 
| Ingo Molnar | 824975e | 2009-07-03 12:39:07 +0200 | [diff] [blame] | 83 | 	 * what we have there. We'll do two loops most likely, | 
 | 84 | 	 * but we'll get an ownership MESI transaction straight away | 
 | 85 | 	 * instead of a read transaction followed by a | 
 | 86 | 	 * flush-for-ownership transaction: | 
 | 87 | 	 */ | 
| Ingo Molnar | 3a8d178 | 2009-07-03 19:56:36 +0200 | [diff] [blame] | 88 | 	u64 old_val, new_val, real_val = 0; | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 89 |  | 
 | 90 | 	do { | 
| Ingo Molnar | 824975e | 2009-07-03 12:39:07 +0200 | [diff] [blame] | 91 | 		old_val = real_val; | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 92 | 		new_val = old_val + delta; | 
 | 93 |  | 
| Ingo Molnar | 824975e | 2009-07-03 12:39:07 +0200 | [diff] [blame] | 94 | 		real_val = atomic64_cmpxchg(ptr, old_val, new_val); | 
 | 95 |  | 
 | 96 | 	} while (real_val != old_val); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 97 |  | 
 | 98 | 	return new_val; | 
 | 99 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 100 | EXPORT_SYMBOL(atomic64_add_return); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 101 |  | 
 | 102 | u64 atomic64_sub_return(u64 delta, atomic64_t *ptr) | 
 | 103 | { | 
 | 104 | 	return atomic64_add_return(-delta, ptr); | 
 | 105 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 106 | EXPORT_SYMBOL(atomic64_sub_return); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 107 |  | 
 | 108 | u64 atomic64_inc_return(atomic64_t *ptr) | 
 | 109 | { | 
 | 110 | 	return atomic64_add_return(1, ptr); | 
 | 111 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 112 | EXPORT_SYMBOL(atomic64_inc_return); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 113 |  | 
 | 114 | u64 atomic64_dec_return(atomic64_t *ptr) | 
 | 115 | { | 
 | 116 | 	return atomic64_sub_return(1, ptr); | 
 | 117 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 118 | EXPORT_SYMBOL(atomic64_dec_return); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 119 |  | 
 | 120 | /** | 
 | 121 |  * atomic64_add - add integer to atomic64 variable | 
 | 122 |  * @delta: integer value to add | 
 | 123 |  * @ptr:   pointer to type atomic64_t | 
 | 124 |  * | 
 | 125 |  * Atomically adds @delta to @ptr. | 
 | 126 |  */ | 
 | 127 | void atomic64_add(u64 delta, atomic64_t *ptr) | 
 | 128 | { | 
 | 129 | 	atomic64_add_return(delta, ptr); | 
 | 130 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 131 | EXPORT_SYMBOL(atomic64_add); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 132 |  | 
 | 133 | /** | 
 | 134 |  * atomic64_sub - subtract the atomic64 variable | 
 | 135 |  * @delta: integer value to subtract | 
 | 136 |  * @ptr:   pointer to type atomic64_t | 
 | 137 |  * | 
 | 138 |  * Atomically subtracts @delta from @ptr. | 
 | 139 |  */ | 
 | 140 | void atomic64_sub(u64 delta, atomic64_t *ptr) | 
 | 141 | { | 
 | 142 | 	atomic64_add(-delta, ptr); | 
 | 143 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 144 | EXPORT_SYMBOL(atomic64_sub); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 145 |  | 
 | 146 | /** | 
 | 147 |  * atomic64_sub_and_test - subtract value from variable and test result | 
 | 148 |  * @delta: integer value to subtract | 
 | 149 |  * @ptr:   pointer to type atomic64_t | 
 | 150 |  * | 
 | 151 |  * Atomically subtracts @delta from @ptr and returns | 
 | 152 |  * true if the result is zero, or false for all | 
 | 153 |  * other cases. | 
 | 154 |  */ | 
 | 155 | int atomic64_sub_and_test(u64 delta, atomic64_t *ptr) | 
 | 156 | { | 
| Ingo Molnar | ddf9a00 | 2009-07-03 20:11:30 +0200 | [diff] [blame] | 157 | 	u64 new_val = atomic64_sub_return(delta, ptr); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 158 |  | 
| Ingo Molnar | ddf9a00 | 2009-07-03 20:11:30 +0200 | [diff] [blame] | 159 | 	return new_val == 0; | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 160 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 161 | EXPORT_SYMBOL(atomic64_sub_and_test); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 162 |  | 
 | 163 | /** | 
 | 164 |  * atomic64_inc - increment atomic64 variable | 
 | 165 |  * @ptr: pointer to type atomic64_t | 
 | 166 |  * | 
 | 167 |  * Atomically increments @ptr by 1. | 
 | 168 |  */ | 
 | 169 | void atomic64_inc(atomic64_t *ptr) | 
 | 170 | { | 
 | 171 | 	atomic64_add(1, ptr); | 
 | 172 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 173 | EXPORT_SYMBOL(atomic64_inc); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 174 |  | 
 | 175 | /** | 
 | 176 |  * atomic64_dec - decrement atomic64 variable | 
 | 177 |  * @ptr: pointer to type atomic64_t | 
 | 178 |  * | 
 | 179 |  * Atomically decrements @ptr by 1. | 
 | 180 |  */ | 
 | 181 | void atomic64_dec(atomic64_t *ptr) | 
 | 182 | { | 
 | 183 | 	atomic64_sub(1, ptr); | 
 | 184 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 185 | EXPORT_SYMBOL(atomic64_dec); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 186 |  | 
 | 187 | /** | 
 | 188 |  * atomic64_dec_and_test - decrement and test | 
 | 189 |  * @ptr: pointer to type atomic64_t | 
 | 190 |  * | 
 | 191 |  * Atomically decrements @ptr by 1 and | 
 | 192 |  * returns true if the result is 0, or false for all other | 
 | 193 |  * cases. | 
 | 194 |  */ | 
 | 195 | int atomic64_dec_and_test(atomic64_t *ptr) | 
 | 196 | { | 
 | 197 | 	return atomic64_sub_and_test(1, ptr); | 
 | 198 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 199 | EXPORT_SYMBOL(atomic64_dec_and_test); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 200 |  | 
 | 201 | /** | 
 | 202 |  * atomic64_inc_and_test - increment and test | 
 | 203 |  * @ptr: pointer to type atomic64_t | 
 | 204 |  * | 
 | 205 |  * Atomically increments @ptr by 1 | 
 | 206 |  * and returns true if the result is zero, or false for all | 
 | 207 |  * other cases. | 
 | 208 |  */ | 
 | 209 | int atomic64_inc_and_test(atomic64_t *ptr) | 
 | 210 | { | 
 | 211 | 	return atomic64_sub_and_test(-1, ptr); | 
 | 212 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 213 | EXPORT_SYMBOL(atomic64_inc_and_test); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 214 |  | 
 | 215 | /** | 
 | 216 |  * atomic64_add_negative - add and test if negative | 
 | 217 |  * @delta: integer value to add | 
 | 218 |  * @ptr:   pointer to type atomic64_t | 
 | 219 |  * | 
 | 220 |  * Atomically adds @delta to @ptr and returns true | 
 | 221 |  * if the result is negative, or false when | 
 | 222 |  * result is greater than or equal to zero. | 
 | 223 |  */ | 
 | 224 | int atomic64_add_negative(u64 delta, atomic64_t *ptr) | 
 | 225 | { | 
| Ingo Molnar | ddf9a00 | 2009-07-03 20:11:30 +0200 | [diff] [blame] | 226 | 	s64 new_val = atomic64_add_return(delta, ptr); | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 227 |  | 
| Ingo Molnar | ddf9a00 | 2009-07-03 20:11:30 +0200 | [diff] [blame] | 228 | 	return new_val < 0; | 
| Ingo Molnar | b7882b7 | 2009-07-03 13:26:39 +0200 | [diff] [blame] | 229 | } | 
| Ingo Molnar | 1fde902 | 2009-07-03 17:28:57 +0200 | [diff] [blame] | 230 | EXPORT_SYMBOL(atomic64_add_negative); |