1
0

atomic.h 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110
  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 void *a_swap_p(void *volatile *x, void *v)
  43. {
  44. __asm__( "xchg %0, %1" : "=r"(v), "=m"(*(void **)x) : "0"(v) : "memory" );
  45. return v;
  46. }
  47. static inline long a_swap_l(volatile void *x, long v)
  48. {
  49. __asm__( "xchg %0, %1" : "=r"(v), "=m"(*(long *)x) : "0"(v) : "memory" );
  50. return v;
  51. }
  52. static inline void a_or(volatile void *p, int v)
  53. {
  54. __asm__( "lock ; orl %1, %0"
  55. : "=m"(*(int *)p) : "r"(v) : "memory" );
  56. }
  57. static inline void a_and(volatile void *p, int v)
  58. {
  59. __asm__( "lock ; andl %1, %0"
  60. : "=m"(*(int *)p) : "r"(v) : "memory" );
  61. }
  62. static inline int a_swap(volatile int *x, int v)
  63. {
  64. __asm__( "xchg %0, %1" : "=r"(v), "=m"(*x) : "0"(v) : "memory" );
  65. return v;
  66. }
  67. #define a_xchg a_swap
  68. static inline int a_fetch_add(volatile int *x, int v)
  69. {
  70. __asm__( "lock ; xadd %0, %1" : "=r"(v), "=m"(*x) : "0"(v) : "memory" );
  71. return v;
  72. }
  73. static inline void a_inc(volatile int *x)
  74. {
  75. __asm__( "lock ; incl %0" : "=m"(*x) : "m"(*x) : "memory" );
  76. }
  77. static inline void a_dec(volatile int *x)
  78. {
  79. __asm__( "lock ; decl %0" : "=m"(*x) : "m"(*x) : "memory" );
  80. }
  81. static inline void a_store(volatile int *p, int x)
  82. {
  83. __asm__( "movl %1, %0" : "=m"(*p) : "r"(x) : "memory" );
  84. }
  85. static inline void a_spin()
  86. {
  87. __asm__ __volatile__( "pause" : : : "memory" );
  88. }
  89. #endif