atomic.h 2.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110
  1. #ifndef _INTERNAL_ATOMIC_H
  2. #define _INTERNAL_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 int a_ctz_l(unsigned long x)
  12. {
  13. long r;
  14. __asm__( "bsf %1,%0" : "=r"(r) : "r"(x) );
  15. return r;
  16. }
  17. static inline void a_and_64(volatile uint64_t *p, uint64_t v)
  18. {
  19. __asm__( "lock ; andl %1, (%0) ; lock ; andl %2, 4(%0)"
  20. : : "r"((long *)p), "r"((unsigned)v), "r"((unsigned)(v>>32)) : "memory" );
  21. }
  22. static inline void a_or_64(volatile uint64_t *p, uint64_t v)
  23. {
  24. __asm__( "lock ; orl %1, (%0) ; lock ; orl %2, 4(%0)"
  25. : : "r"((long *)p), "r"((unsigned)v), "r"((unsigned)(v>>32)) : "memory" );
  26. }
  27. static inline void a_or_l(volatile void *p, long v)
  28. {
  29. __asm__( "lock ; orl %1, %0"
  30. : "=m"(*(long *)p) : "r"(v) : "memory" );
  31. }
  32. static inline void *a_cas_p(volatile void *p, void *t, void *s)
  33. {
  34. __asm__( "lock ; cmpxchg %3, %1"
  35. : "=a"(t), "=m"(*(long *)p) : "a"(t), "r"(s) : "memory" );
  36. return t;
  37. }
  38. static inline int a_cas(volatile int *p, int t, int s)
  39. {
  40. __asm__( "lock ; cmpxchg %3, %1"
  41. : "=a"(t), "=m"(*p) : "a"(t), "r"(s) : "memory" );
  42. return t;
  43. }
  44. static inline void a_or(volatile int *p, int v)
  45. {
  46. __asm__( "lock ; orl %1, %0"
  47. : "=m"(*p) : "r"(v) : "memory" );
  48. }
  49. static inline void a_and(volatile int *p, int v)
  50. {
  51. __asm__( "lock ; andl %1, %0"
  52. : "=m"(*p) : "r"(v) : "memory" );
  53. }
  54. static inline int a_swap(volatile int *x, int v)
  55. {
  56. __asm__( "xchg %0, %1" : "=r"(v), "=m"(*x) : "0"(v) : "memory" );
  57. return v;
  58. }
  59. #define a_xchg a_swap
  60. static inline int a_fetch_add(volatile int *x, int v)
  61. {
  62. __asm__( "lock ; xadd %0, %1" : "=r"(v), "=m"(*x) : "0"(v) : "memory" );
  63. return v;
  64. }
  65. static inline void a_inc(volatile int *x)
  66. {
  67. __asm__( "lock ; incl %0" : "=m"(*x) : "m"(*x) : "memory" );
  68. }
  69. static inline void a_dec(volatile int *x)
  70. {
  71. __asm__( "lock ; decl %0" : "=m"(*x) : "m"(*x) : "memory" );
  72. }
  73. static inline void a_store(volatile int *p, int x)
  74. {
  75. __asm__( "movl %1, %0 ; lock ; orl $0,(%%esp)" : "=m"(*p) : "r"(x) : "memory" );
  76. }
  77. static inline void a_spin()
  78. {
  79. __asm__ __volatile__( "pause" : : : "memory" );
  80. }
  81. static inline void a_barrier()
  82. {
  83. __asm__ __volatile__( "" : : : "memory" );
  84. }
  85. static inline void a_crash()
  86. {
  87. __asm__ __volatile__( "hlt" : : : "memory" );
  88. }
  89. #endif