1 /* 2 * Atomic xchg and cmpxchg operations. 3 * 4 * This file is subject to the terms and conditions of the GNU General Public 5 * License. See the file "COPYING" in the main directory of this archive 6 * for more details. 7 * 8 * Copyright (C) 2001 - 2005 Tensilica Inc. 9 */ 10 11 #ifndef _XTENSA_CMPXCHG_H 12 #define _XTENSA_CMPXCHG_H 13 14 #ifndef __ASSEMBLY__ 15 16 #include <linux/stringify.h> 17 18 /* 19 * cmpxchg 20 */ 21 22 static inline unsigned long 23 __cmpxchg_u32(volatile int *p, int old, int new) 24 { 25 #if XCHAL_HAVE_S32C1I 26 __asm__ __volatile__( 27 " wsr %2, scompare1\n" 28 " s32c1i %0, %1, 0\n" 29 : "+a" (new) 30 : "a" (p), "a" (old) 31 : "memory" 32 ); 33 34 return new; 35 #else 36 __asm__ __volatile__( 37 " rsil a15, "__stringify(LOCKLEVEL)"\n" 38 " l32i %0, %1, 0\n" 39 " bne %0, %2, 1f\n" 40 " s32i %3, %1, 0\n" 41 "1:\n" 42 " wsr a15, ps\n" 43 " rsync\n" 44 : "=&a" (old) 45 : "a" (p), "a" (old), "r" (new) 46 : "a15", "memory"); 47 return old; 48 #endif 49 } 50 /* This function doesn't exist, so you'll get a linker error 51 * if something tries to do an invalid cmpxchg(). */ 52 53 extern void __cmpxchg_called_with_bad_pointer(void); 54 55 static __inline__ unsigned long 56 __cmpxchg(volatile void *ptr, unsigned long old, unsigned long new, int size) 57 { 58 switch (size) { 59 case 4: return __cmpxchg_u32(ptr, old, new); 60 default: __cmpxchg_called_with_bad_pointer(); 61 return old; 62 } 63 } 64 65 #define cmpxchg(ptr,o,n) \ 66 ({ __typeof__(*(ptr)) _o_ = (o); \ 67 __typeof__(*(ptr)) _n_ = (n); \ 68 (__typeof__(*(ptr))) __cmpxchg((ptr), (unsigned long)_o_, \ 69 (unsigned long)_n_, sizeof (*(ptr))); \ 70 }) 71 72 #include <asm-generic/cmpxchg-local.h> 73 74 static inline unsigned long __cmpxchg_local(volatile void *ptr, 75 unsigned long old, 76 unsigned long new, int size) 77 { 78 switch (size) { 79 case 4: 80 return __cmpxchg_u32(ptr, old, new); 81 default: 82 return __cmpxchg_local_generic(ptr, old, new, size); 83 } 84 85 return old; 86 } 87 88 /* 89 * cmpxchg_local and cmpxchg64_local are atomic wrt current CPU. Always make 90 * them available. 91 */ 92 #define cmpxchg_local(ptr, o, n) \ 93 ((__typeof__(*(ptr)))__cmpxchg_local_generic((ptr), (unsigned long)(o),\ 94 (unsigned long)(n), sizeof(*(ptr)))) 95 #define cmpxchg64_local(ptr, o, n) __cmpxchg64_local_generic((ptr), (o), (n)) 96 #define cmpxchg64(ptr, o, n) cmpxchg64_local((ptr), (o), (n)) 97 98 /* 99 * xchg_u32 100 * 101 * Note that a15 is used here because the register allocation 102 * done by the compiler is not guaranteed and a window overflow 103 * may not occur between the rsil and wsr instructions. By using 104 * a15 in the rsil, the machine is guaranteed to be in a state 105 * where no register reference will cause an overflow. 106 */ 107 108 static inline unsigned long xchg_u32(volatile int * m, unsigned long val) 109 { 110 #if XCHAL_HAVE_S32C1I 111 unsigned long tmp, result; 112 __asm__ __volatile__( 113 "1: l32i %1, %2, 0\n" 114 " mov %0, %3\n" 115 " wsr %1, scompare1\n" 116 " s32c1i %0, %2, 0\n" 117 " bne %0, %1, 1b\n" 118 : "=&a" (result), "=&a" (tmp) 119 : "a" (m), "a" (val) 120 : "memory" 121 ); 122 return result; 123 #else 124 unsigned long tmp; 125 __asm__ __volatile__( 126 " rsil a15, "__stringify(LOCKLEVEL)"\n" 127 " l32i %0, %1, 0\n" 128 " s32i %2, %1, 0\n" 129 " wsr a15, ps\n" 130 " rsync\n" 131 : "=&a" (tmp) 132 : "a" (m), "a" (val) 133 : "a15", "memory"); 134 return tmp; 135 #endif 136 } 137 138 #define xchg(ptr,x) \ 139 ((__typeof__(*(ptr)))__xchg((unsigned long)(x),(ptr),sizeof(*(ptr)))) 140 141 /* 142 * This only works if the compiler isn't horribly bad at optimizing. 143 * gcc-2.5.8 reportedly can't handle this, but I define that one to 144 * be dead anyway. 145 */ 146 147 extern void __xchg_called_with_bad_pointer(void); 148 149 static __inline__ unsigned long 150 __xchg(unsigned long x, volatile void * ptr, int size) 151 { 152 switch (size) { 153 case 4: 154 return xchg_u32(ptr, x); 155 } 156 __xchg_called_with_bad_pointer(); 157 return x; 158 } 159 160 #endif /* __ASSEMBLY__ */ 161 162 #endif /* _XTENSA_CMPXCHG_H */ 163