atomic.h 2.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117
  1. #ifndef _INTERNAA_ATOMIC_H
  2. #define _INTERNAA_ATOMIC_H
  3. #include <stdint.h>
  4. static inline int a_ctz_64(uint64_t x)
  5. {
  6. int r;
  7. __asm__( "bsf %1,%0 ; jnz 1f ; bsf %2,%0 ; addl $32,%0\n1:"
  8. : "=r"(r) : "r"((unsigned)x), "r"((unsigned)(x>>32)) );
  9. return r;
  10. }
  11. static inline void a_and_64(volatile uint64_t *p, uint64_t v)
  12. {
  13. __asm__( "lock ; andl %1, (%0) ; lock ; andl %2, 4(%0)"
  14. : : "r"((long *)p), "r"((unsigned)v), "r"((unsigned)(v>>32)) : "memory" );
  15. }
  16. static inline void a_or_64(volatile uint64_t *p, uint64_t v)
  17. {
  18. __asm__( "lock ; orl %1, (%0) ; lock ; orl %2, 4(%0)"
  19. : : "r"((long *)p), "r"((unsigned)v), "r"((unsigned)(v>>32)) : "memory" );
  20. }
  21. static inline void a_store_l(volatile void *p, long x)
  22. {
  23. __asm__( "movl %1, %0" : "=m"(*(long *)p) : "r"(x) : "memory" );
  24. }
  25. static inline void a_or_l(volatile void *p, long v)
  26. {
  27. __asm__( "lock ; orl %1, %0"
  28. : "=m"(*(long *)p) : "r"(v) : "memory" );
  29. }
  30. static inline void *a_cas_p(volatile void *p, void *t, void *s)
  31. {
  32. __asm__( "lock ; cmpxchg %3, %1"
  33. : "=a"(t), "=m"(*(long *)p) : "a"(t), "r"(s) : "memory" );
  34. return t;
  35. }
  36. static inline long a_cas_l(volatile void *p, long t, long s)
  37. {
  38. __asm__( "lock ; cmpxchg %3, %1"
  39. : "=a"(t), "=m"(*(long *)p) : "a"(t), "r"(s) : "memory" );
  40. return t;
  41. }
  42. static inline int a_cas(volatile int *p, int t, int s)
  43. {
  44. __asm__( "lock ; cmpxchg %3, %1"
  45. : "=a"(t), "=m"(*p) : "a"(t), "r"(s) : "memory" );
  46. return t;
  47. }
  48. static inline void *a_swap_p(void *volatile *x, void *v)
  49. {
  50. __asm__( "xchg %0, %1" : "=r"(v), "=m"(*(void **)x) : "0"(v) : "memory" );
  51. return v;
  52. }
  53. static inline long a_swap_l(volatile void *x, long v)
  54. {
  55. __asm__( "xchg %0, %1" : "=r"(v), "=m"(*(long *)x) : "0"(v) : "memory" );
  56. return v;
  57. }
  58. static inline void a_or(volatile void *p, int v)
  59. {
  60. __asm__( "lock ; orl %1, %0"
  61. : "=m"(*(int *)p) : "r"(v) : "memory" );
  62. }
  63. static inline void a_and(volatile void *p, int v)
  64. {
  65. __asm__( "lock ; andl %1, %0"
  66. : "=m"(*(int *)p) : "r"(v) : "memory" );
  67. }
  68. static inline int a_swap(volatile int *x, int v)
  69. {
  70. __asm__( "xchg %0, %1" : "=r"(v), "=m"(*x) : "0"(v) : "memory" );
  71. return v;
  72. }
  73. #define a_xchg a_swap
  74. static inline int a_fetch_add(volatile int *x, int v)
  75. {
  76. __asm__( "lock ; xadd %0, %1" : "=r"(v), "=m"(*x) : "0"(v) : "memory" );
  77. return v;
  78. }
  79. static inline void a_inc(volatile int *x)
  80. {
  81. __asm__( "lock ; incl %0" : "=m"(*x) : "m"(*x) : "memory" );
  82. }
  83. static inline void a_dec(volatile int *x)
  84. {
  85. __asm__( "lock ; decl %0" : "=m"(*x) : "m"(*x) : "memory" );
  86. }
  87. static inline void a_store(volatile int *p, int x)
  88. {
  89. __asm__( "movl %1, %0" : "=m"(*p) : "r"(x) : "memory" );
  90. }
  91. static inline void a_spin()
  92. {
  93. __asm__ __volatile__( "pause" : : : "memory" );
  94. }
  95. #endif