preliminaryDataProcessing.h 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228
  1. /* bitops.h: bit operations for the Fujitsu FR-V CPUs
  2. *
  3. * For an explanation of how atomic ops work in this arch, see:
  4. * Documentation/frv/atomic-ops.txt
  5. *
  6. * Copyright (C) 2004 Red Hat, Inc. All Rights Reserved.
  7. * Written by David Howells (dhowells@redhat.com)
  8. *
  9. * This program is free software; you can redistribute it and/or
  10. * modify it under the terms of the GNU General Public License
  11. * as published by the Free Software Foundation; either version
  12. * 2 of the License, or (at your option) any later version.
  13. */
  14. #ifndef _ASM_BITOPS_H
  15. #define _ASM_BITOPS_H
  16. #include <linux/compiler.h>
  17. #include <asm/byteorder.h>
  18. #ifdef __KERNEL__
  19. #ifndef _LINUX_BITOPS_H
  20. #error only <linux/bitops.h> can be included directly
  21. #endif
  22. #include <asm-generic/bitops/ffz.h>
  23. /*
  24. * clear_bit() doesn't provide any barrier for the compiler.
  25. */
  26. #define smp_mb__before_clear_bit() barrier()
  27. #define smp_mb__after_clear_bit() barrier()
  28. #ifndef CONFIG_FRV_OUTOFLINE_ATOMIC_OPS
  29. static inline
  30. unsigned long atomic_test_and_ANDNOT_mask(unsigned long mask, volatile unsigned long *v)
  31. {
  32. unsigned long old, tmp;
  33. asm volatile(
  34. "0: \n"
  35. " orcc gr0,gr0,gr0,icc3 \n" /* set ICC3.Z */
  36. " ckeq icc3,cc7 \n"
  37. " ld.p %M0,%1 \n" /* LD.P/ORCR are atomic */
  38. " orcr cc7,cc7,cc3 \n" /* set CC3 to true */
  39. " and%I3 %1,%3,%2 \n"
  40. " cst.p %2,%M0 ,cc3,#1 \n" /* if store happens... */
  41. " corcc gr29,gr29,gr0 ,cc3,#1 \n" /* ... clear ICC3.Z */
  42. " beq icc3,#0,0b \n"
  43. : "+U"(*v), "=&r"(old), "=r"(tmp)
  44. : "NPr"(~mask)
  45. : "memory", "cc7", "cc3", "icc3"
  46. );
  47. return old;
  48. }
  49. static inline
  50. unsigned long atomic_test_and_OR_mask(unsigned long mask, volatile unsigned long *v)
  51. {
  52. unsigned long old, tmp;
  53. asm volatile(
  54. "0: \n"
  55. " orcc gr0,gr0,gr0,icc3 \n" /* set ICC3.Z */
  56. " ckeq icc3,cc7 \n"
  57. " ld.p %M0,%1 \n" /* LD.P/ORCR are atomic */
  58. " orcr cc7,cc7,cc3 \n" /* set CC3 to true */
  59. " or%I3 %1,%3,%2 \n"
  60. " cst.p %2,%M0 ,cc3,#1 \n" /* if store happens... */
  61. " corcc gr29,gr29,gr0 ,cc3,#1 \n" /* ... clear ICC3.Z */
  62. " beq icc3,#0,0b \n"
  63. : "+U"(*v), "=&r"(old), "=r"(tmp)
  64. : "NPr"(mask)
  65. : "memory", "cc7", "cc3", "icc3"
  66. );
  67. return old;
  68. }
  69. static inline
  70. unsigned long atomic_test_and_XOR_mask(unsigned long mask, volatile unsigned long *v)
  71. {
  72. unsigned long old, tmp;
  73. asm volatile(
  74. "0: \n"
  75. " orcc gr0,gr0,gr0,icc3 \n" /* set ICC3.Z */
  76. " ckeq icc3,cc7 \n"
  77. " ld.p %M0,%1 \n" /* LD.P/ORCR are atomic */
  78. " orcr cc7,cc7,cc3 \n" /* set CC3 to true */
  79. " xor%I3 %1,%3,%2 \n"
  80. " cst.p %2,%M0 ,cc3,#1 \n" /* if store happens... */
  81. " corcc gr29,gr29,gr0 ,cc3,#1 \n" /* ... clear ICC3.Z */
  82. " beq icc3,#0,0b \n"
  83. : "+U"(*v), "=&r"(old), "=r"(tmp)
  84. : "NPr"(mask)
  85. : "memory", "cc7", "cc3", "icc3"
  86. );
  87. return old;
  88. }
  89. #else
  90. extern unsigned long atomic_test_and_ANDNOT_mask(unsigned long mask, volatile unsigned long *v);
  91. extern unsigned long atomic_test_and_OR_mask(unsigned long mask, volatile unsigned long *v);
  92. extern unsigned long atomic_test_and_XOR_mask(unsigned long mask, volatile unsigned long *v);
  93. #endif
  94. #define atomic_clear_mask(mask, v) atomic_test_and_ANDNOT_mask((mask), (v))
  95. #define atomic_set_mask(mask, v) atomic_test_and_OR_mask((mask), (v))
  96. static inline int test_and_clear_bit(unsigned long nr, volatile void *addr)
  97. {
  98. volatile unsigned long *ptr = addr;
  99. unsigned long mask = 1UL << (nr & 31);
  100. ptr += nr >> 5;
  101. return (atomic_test_and_ANDNOT_mask(mask, ptr) & mask) != 0;
  102. }
  103. static inline int test_and_set_bit(unsigned long nr, volatile void *addr)
  104. {
  105. volatile unsigned long *ptr = addr;
  106. unsigned long mask = 1UL << (nr & 31);
  107. ptr += nr >> 5;
  108. return (atomic_test_and_OR_mask(mask, ptr) & mask) != 0;
  109. }
  110. static inline int test_and_change_bit(unsigned long nr, volatile void *addr)
  111. {
  112. volatile unsigned long *ptr = addr;
  113. unsigned long mask = 1UL << (nr & 31);
  114. ptr += nr >> 5;
  115. return (atomic_test_and_XOR_mask(mask, ptr) & mask) != 0;
  116. }
  117. static inline void clear_bit(unsigned long nr, volatile void *addr)
  118. {
  119. test_and_clear_bit(nr, addr);
  120. }
  121. static inline void set_bit(unsigned long nr, volatile void *addr)
  122. {
  123. test_and_set_bit(nr, addr);
  124. }
  125. static inline void change_bit(unsigned long nr, volatile void *addr)
  126. {
  127. test_and_change_bit(nr, addr);
  128. }
  129. static inline void __clear_bit(unsigned long nr, volatile void *addr)
  130. {
  131. volatile unsigned long *a = addr;
  132. int mask;
  133. a += nr >> 5;
  134. mask = 1 << (nr & 31);
  135. *a &= ~mask;
  136. }
  137. static inline void __set_bit(unsigned long nr, volatile void *addr)
  138. {
  139. volatile unsigned long *a = addr;
  140. int mask;
  141. a += nr >> 5;
  142. mask = 1 << (nr & 31);
  143. *a |= mask;
  144. }
  145. static inline void __change_bit(unsigned long nr, volatile void *addr)
  146. {
  147. volatile unsigned long *a = addr;
  148. int mask;
  149. a += nr >> 5;
  150. mask = 1 << (nr & 31);
  151. *a ^= mask;
  152. }
  153. static inline int __test_and_clear_bit(unsigned long nr, volatile void *addr)
  154. {
  155. volatile unsigned long *a = addr;
  156. int mask, retval;
  157. a += nr >> 5;
  158. mask = 1 << (nr & 31);
  159. retval = (mask & *a) != 0;
  160. *a &= ~mask;
  161. return retval;
  162. }
  163. static inline int __test_and_set_bit(unsigned long nr, volatile void *addr)
  164. {
  165. volatile unsigned long *a = addr;
  166. int mask, retval;
  167. a += nr >> 5;
  168. mask = 1 << (nr & 31);
  169. retval = (mask & *a) != 0;
  170. *a |= mask;
  171. return retval;
  172. }
  173. static inline int __test_and_change_bit(unsigned long nr, volatile void *addr)
  174. {
  175. volatile unsigned long *a = addr;
  176. int mask, retval;
  177. a += nr >> 5;
  178. mask = 1 << (nr & 31);
  179. retval = (mask & *a) != 0;
  180. *a ^= mask;
  181. return retval;
  182. }
  183. /*
  184. * This routine doesn't need to be atomic.
  185. */
  186. static inline int
  187. __constant_test_bit(unsigned long nr, const volatile void *addr)
  188. {
  189. return ((1UL << (nr & 31)) & (((const volatile unsigned int *) addr)[nr >> 5])) != 0;
  190. }