Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | #ifndef _M68KNOMMU_BITOPS_H |
| 2 | #define _M68KNOMMU_BITOPS_H |
| 3 | |
| 4 | /* |
| 5 | * Copyright 1992, Linus Torvalds. |
| 6 | */ |
| 7 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 | #include <linux/compiler.h> |
| 9 | #include <asm/byteorder.h> /* swab32 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 | |
| 11 | #ifdef __KERNEL__ |
| 12 | |
Jiri Slaby | 0624517 | 2007-10-18 23:40:26 -0700 | [diff] [blame] | 13 | #ifndef _LINUX_BITOPS_H |
| 14 | #error only <linux/bitops.h> can be included directly |
| 15 | #endif |
| 16 | |
Sebastian Siewior | a6260ef | 2008-05-09 16:10:37 +0200 | [diff] [blame] | 17 | #if defined (__mcfisaaplus__) || defined (__mcfisac__) |
| 18 | static inline int ffs(unsigned int val) |
| 19 | { |
| 20 | if (!val) |
| 21 | return 0; |
| 22 | |
| 23 | asm volatile( |
| 24 | "bitrev %0\n\t" |
| 25 | "ff1 %0\n\t" |
| 26 | : "=d" (val) |
| 27 | : "0" (val) |
| 28 | ); |
| 29 | val++; |
| 30 | return val; |
| 31 | } |
| 32 | |
| 33 | static inline int __ffs(unsigned int val) |
| 34 | { |
| 35 | asm volatile( |
| 36 | "bitrev %0\n\t" |
| 37 | "ff1 %0\n\t" |
| 38 | : "=d" (val) |
| 39 | : "0" (val) |
| 40 | ); |
| 41 | return val; |
| 42 | } |
| 43 | |
| 44 | #else |
Akinobu Mita | d2d7cdc | 2006-03-26 01:39:29 -0800 | [diff] [blame] | 45 | #include <asm-generic/bitops/ffs.h> |
| 46 | #include <asm-generic/bitops/__ffs.h> |
Sebastian Siewior | a6260ef | 2008-05-09 16:10:37 +0200 | [diff] [blame] | 47 | #endif |
| 48 | |
Akinobu Mita | d2d7cdc | 2006-03-26 01:39:29 -0800 | [diff] [blame] | 49 | #include <asm-generic/bitops/sched.h> |
| 50 | #include <asm-generic/bitops/ffz.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | |
| 52 | static __inline__ void set_bit(int nr, volatile unsigned long * addr) |
| 53 | { |
| 54 | #ifdef CONFIG_COLDFIRE |
| 55 | __asm__ __volatile__ ("lea %0,%%a0; bset %1,(%%a0)" |
| 56 | : "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 57 | : "d" (nr) |
| 58 | : "%a0", "cc"); |
| 59 | #else |
| 60 | __asm__ __volatile__ ("bset %1,%0" |
| 61 | : "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 62 | : "di" (nr) |
| 63 | : "cc"); |
| 64 | #endif |
| 65 | } |
| 66 | |
| 67 | #define __set_bit(nr, addr) set_bit(nr, addr) |
| 68 | |
| 69 | /* |
| 70 | * clear_bit() doesn't provide any barrier for the compiler. |
| 71 | */ |
| 72 | #define smp_mb__before_clear_bit() barrier() |
| 73 | #define smp_mb__after_clear_bit() barrier() |
| 74 | |
| 75 | static __inline__ void clear_bit(int nr, volatile unsigned long * addr) |
| 76 | { |
| 77 | #ifdef CONFIG_COLDFIRE |
| 78 | __asm__ __volatile__ ("lea %0,%%a0; bclr %1,(%%a0)" |
| 79 | : "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 80 | : "d" (nr) |
| 81 | : "%a0", "cc"); |
| 82 | #else |
| 83 | __asm__ __volatile__ ("bclr %1,%0" |
| 84 | : "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 85 | : "di" (nr) |
| 86 | : "cc"); |
| 87 | #endif |
| 88 | } |
| 89 | |
| 90 | #define __clear_bit(nr, addr) clear_bit(nr, addr) |
| 91 | |
| 92 | static __inline__ void change_bit(int nr, volatile unsigned long * addr) |
| 93 | { |
| 94 | #ifdef CONFIG_COLDFIRE |
| 95 | __asm__ __volatile__ ("lea %0,%%a0; bchg %1,(%%a0)" |
| 96 | : "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 97 | : "d" (nr) |
| 98 | : "%a0", "cc"); |
| 99 | #else |
| 100 | __asm__ __volatile__ ("bchg %1,%0" |
| 101 | : "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 102 | : "di" (nr) |
| 103 | : "cc"); |
| 104 | #endif |
| 105 | } |
| 106 | |
| 107 | #define __change_bit(nr, addr) change_bit(nr, addr) |
| 108 | |
| 109 | static __inline__ int test_and_set_bit(int nr, volatile unsigned long * addr) |
| 110 | { |
| 111 | char retval; |
| 112 | |
| 113 | #ifdef CONFIG_COLDFIRE |
| 114 | __asm__ __volatile__ ("lea %1,%%a0; bset %2,(%%a0); sne %0" |
| 115 | : "=d" (retval), "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 116 | : "d" (nr) |
| 117 | : "%a0"); |
| 118 | #else |
| 119 | __asm__ __volatile__ ("bset %2,%1; sne %0" |
| 120 | : "=d" (retval), "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 121 | : "di" (nr) |
| 122 | /* No clobber */); |
| 123 | #endif |
| 124 | |
| 125 | return retval; |
| 126 | } |
| 127 | |
| 128 | #define __test_and_set_bit(nr, addr) test_and_set_bit(nr, addr) |
| 129 | |
| 130 | static __inline__ int test_and_clear_bit(int nr, volatile unsigned long * addr) |
| 131 | { |
| 132 | char retval; |
| 133 | |
| 134 | #ifdef CONFIG_COLDFIRE |
| 135 | __asm__ __volatile__ ("lea %1,%%a0; bclr %2,(%%a0); sne %0" |
| 136 | : "=d" (retval), "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 137 | : "d" (nr) |
| 138 | : "%a0"); |
| 139 | #else |
| 140 | __asm__ __volatile__ ("bclr %2,%1; sne %0" |
| 141 | : "=d" (retval), "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 142 | : "di" (nr) |
| 143 | /* No clobber */); |
| 144 | #endif |
| 145 | |
| 146 | return retval; |
| 147 | } |
| 148 | |
| 149 | #define __test_and_clear_bit(nr, addr) test_and_clear_bit(nr, addr) |
| 150 | |
| 151 | static __inline__ int test_and_change_bit(int nr, volatile unsigned long * addr) |
| 152 | { |
| 153 | char retval; |
| 154 | |
| 155 | #ifdef CONFIG_COLDFIRE |
| 156 | __asm__ __volatile__ ("lea %1,%%a0\n\tbchg %2,(%%a0)\n\tsne %0" |
| 157 | : "=d" (retval), "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 158 | : "d" (nr) |
| 159 | : "%a0"); |
| 160 | #else |
| 161 | __asm__ __volatile__ ("bchg %2,%1; sne %0" |
| 162 | : "=d" (retval), "+m" (((volatile char *)addr)[(nr^31) >> 3]) |
| 163 | : "di" (nr) |
| 164 | /* No clobber */); |
| 165 | #endif |
| 166 | |
| 167 | return retval; |
| 168 | } |
| 169 | |
| 170 | #define __test_and_change_bit(nr, addr) test_and_change_bit(nr, addr) |
| 171 | |
| 172 | /* |
| 173 | * This routine doesn't need to be atomic. |
| 174 | */ |
| 175 | static __inline__ int __constant_test_bit(int nr, const volatile unsigned long * addr) |
| 176 | { |
| 177 | return ((1UL << (nr & 31)) & (((const volatile unsigned int *) addr)[nr >> 5])) != 0; |
| 178 | } |
| 179 | |
| 180 | static __inline__ int __test_bit(int nr, const volatile unsigned long * addr) |
| 181 | { |
| 182 | int * a = (int *) addr; |
| 183 | int mask; |
| 184 | |
| 185 | a += nr >> 5; |
| 186 | mask = 1 << (nr & 0x1f); |
| 187 | return ((mask & *a) != 0); |
| 188 | } |
| 189 | |
| 190 | #define test_bit(nr,addr) \ |
| 191 | (__builtin_constant_p(nr) ? \ |
| 192 | __constant_test_bit((nr),(addr)) : \ |
| 193 | __test_bit((nr),(addr))) |
| 194 | |
Akinobu Mita | d2d7cdc | 2006-03-26 01:39:29 -0800 | [diff] [blame] | 195 | #include <asm-generic/bitops/find.h> |
| 196 | #include <asm-generic/bitops/hweight.h> |
Nick Piggin | 2633357 | 2007-10-18 03:06:39 -0700 | [diff] [blame] | 197 | #include <asm-generic/bitops/lock.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 198 | |
Akinobu Mita | c1e6ca7 | 2011-03-23 16:42:00 -0700 | [diff] [blame] | 199 | #define BITOP_LE_SWIZZLE ((BITS_PER_LONG-1) & ~0x7) |
| 200 | |
| 201 | static inline void __set_bit_le(int nr, void *addr) |
| 202 | { |
| 203 | __set_bit(nr ^ BITOP_LE_SWIZZLE, addr); |
| 204 | } |
| 205 | |
| 206 | static inline void __clear_bit_le(int nr, void *addr) |
| 207 | { |
| 208 | __clear_bit(nr ^ BITOP_LE_SWIZZLE, addr); |
| 209 | } |
| 210 | |
| 211 | static inline int __test_and_set_bit_le(int nr, volatile void *addr) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | { |
| 213 | char retval; |
| 214 | |
| 215 | #ifdef CONFIG_COLDFIRE |
| 216 | __asm__ __volatile__ ("lea %1,%%a0; bset %2,(%%a0); sne %0" |
| 217 | : "=d" (retval), "+m" (((volatile char *)addr)[nr >> 3]) |
| 218 | : "d" (nr) |
| 219 | : "%a0"); |
| 220 | #else |
| 221 | __asm__ __volatile__ ("bset %2,%1; sne %0" |
| 222 | : "=d" (retval), "+m" (((volatile char *)addr)[nr >> 3]) |
| 223 | : "di" (nr) |
| 224 | /* No clobber */); |
| 225 | #endif |
| 226 | |
| 227 | return retval; |
| 228 | } |
| 229 | |
Akinobu Mita | c1e6ca7 | 2011-03-23 16:42:00 -0700 | [diff] [blame] | 230 | static inline int __test_and_clear_bit_le(int nr, volatile void *addr) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 231 | { |
| 232 | char retval; |
| 233 | |
| 234 | #ifdef CONFIG_COLDFIRE |
| 235 | __asm__ __volatile__ ("lea %1,%%a0; bclr %2,(%%a0); sne %0" |
| 236 | : "=d" (retval), "+m" (((volatile char *)addr)[nr >> 3]) |
| 237 | : "d" (nr) |
| 238 | : "%a0"); |
| 239 | #else |
| 240 | __asm__ __volatile__ ("bclr %2,%1; sne %0" |
| 241 | : "=d" (retval), "+m" (((volatile char *)addr)[nr >> 3]) |
| 242 | : "di" (nr) |
| 243 | /* No clobber */); |
| 244 | #endif |
| 245 | |
| 246 | return retval; |
| 247 | } |
| 248 | |
| 249 | #define ext2_set_bit_atomic(lock, nr, addr) \ |
| 250 | ({ \ |
| 251 | int ret; \ |
| 252 | spin_lock(lock); \ |
Akinobu Mita | c1e6ca7 | 2011-03-23 16:42:00 -0700 | [diff] [blame] | 253 | ret = __test_and_set_bit_le((nr), (addr)); \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 254 | spin_unlock(lock); \ |
| 255 | ret; \ |
| 256 | }) |
| 257 | |
| 258 | #define ext2_clear_bit_atomic(lock, nr, addr) \ |
| 259 | ({ \ |
| 260 | int ret; \ |
| 261 | spin_lock(lock); \ |
Akinobu Mita | c1e6ca7 | 2011-03-23 16:42:00 -0700 | [diff] [blame] | 262 | ret = __test_and_clear_bit_le((nr), (addr)); \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 | spin_unlock(lock); \ |
| 264 | ret; \ |
| 265 | }) |
| 266 | |
Akinobu Mita | c1e6ca7 | 2011-03-23 16:42:00 -0700 | [diff] [blame] | 267 | static inline int test_bit_le(int nr, const volatile void *addr) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | { |
| 269 | char retval; |
| 270 | |
| 271 | #ifdef CONFIG_COLDFIRE |
| 272 | __asm__ __volatile__ ("lea %1,%%a0; btst %2,(%%a0); sne %0" |
| 273 | : "=d" (retval) |
| 274 | : "m" (((const volatile char *)addr)[nr >> 3]), "d" (nr) |
| 275 | : "%a0"); |
| 276 | #else |
| 277 | __asm__ __volatile__ ("btst %2,%1; sne %0" |
| 278 | : "=d" (retval) |
| 279 | : "m" (((const volatile char *)addr)[nr >> 3]), "di" (nr) |
| 280 | /* No clobber */); |
| 281 | #endif |
| 282 | |
| 283 | return retval; |
| 284 | } |
| 285 | |
Akinobu Mita | c1e6ca7 | 2011-03-23 16:42:00 -0700 | [diff] [blame] | 286 | #define find_first_zero_bit_le(addr, size) \ |
| 287 | find_next_zero_bit_le((addr), (size), 0) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | |
Akinobu Mita | c1e6ca7 | 2011-03-23 16:42:00 -0700 | [diff] [blame] | 289 | static inline unsigned long find_next_zero_bit_le(void *addr, unsigned long size, unsigned long offset) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 290 | { |
| 291 | unsigned long *p = ((unsigned long *) addr) + (offset >> 5); |
| 292 | unsigned long result = offset & ~31UL; |
| 293 | unsigned long tmp; |
| 294 | |
| 295 | if (offset >= size) |
| 296 | return size; |
| 297 | size -= result; |
| 298 | offset &= 31UL; |
| 299 | if(offset) { |
| 300 | /* We hold the little endian value in tmp, but then the |
| 301 | * shift is illegal. So we could keep a big endian value |
| 302 | * in tmp, like this: |
| 303 | * |
| 304 | * tmp = __swab32(*(p++)); |
| 305 | * tmp |= ~0UL >> (32-offset); |
| 306 | * |
Joe Perches | ab690d9 | 2008-02-03 17:38:04 +0200 | [diff] [blame] | 307 | * but this would decrease performance, so we change the |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 308 | * shift: |
| 309 | */ |
| 310 | tmp = *(p++); |
| 311 | tmp |= __swab32(~0UL >> (32-offset)); |
| 312 | if(size < 32) |
| 313 | goto found_first; |
| 314 | if(~tmp) |
| 315 | goto found_middle; |
| 316 | size -= 32; |
| 317 | result += 32; |
| 318 | } |
| 319 | while(size & ~31UL) { |
| 320 | if(~(tmp = *(p++))) |
| 321 | goto found_middle; |
| 322 | result += 32; |
| 323 | size -= 32; |
| 324 | } |
| 325 | if(!size) |
| 326 | return result; |
| 327 | tmp = *p; |
| 328 | |
| 329 | found_first: |
| 330 | /* tmp is little endian, so we would have to swab the shift, |
| 331 | * see above. But then we have to swab tmp below for ffz, so |
| 332 | * we might as well do this here. |
| 333 | */ |
| 334 | return result + ffz(__swab32(tmp) | (~0UL << size)); |
| 335 | found_middle: |
| 336 | return result + ffz(__swab32(tmp)); |
| 337 | } |
| 338 | |
Akinobu Mita | d2d7cdc | 2006-03-26 01:39:29 -0800 | [diff] [blame] | 339 | #include <asm-generic/bitops/minix.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 340 | |
| 341 | #endif /* __KERNEL__ */ |
| 342 | |
Akinobu Mita | d2d7cdc | 2006-03-26 01:39:29 -0800 | [diff] [blame] | 343 | #include <asm-generic/bitops/fls.h> |
Rusty Russell | 0db5d3d | 2009-01-01 10:12:18 +1030 | [diff] [blame] | 344 | #include <asm-generic/bitops/__fls.h> |
Akinobu Mita | d2d7cdc | 2006-03-26 01:39:29 -0800 | [diff] [blame] | 345 | #include <asm-generic/bitops/fls64.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 346 | |
| 347 | #endif /* _M68KNOMMU_BITOPS_H */ |