futex_64.h 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125
  1. #ifndef _ASM_FUTEX_H
  2. #define _ASM_FUTEX_H
  3. #ifdef __KERNEL__
  4. #include <linux/futex.h>
  5. #include <asm/errno.h>
  6. #include <asm/system.h>
  7. #include <asm/uaccess.h>
  8. #define __futex_atomic_op1(insn, ret, oldval, uaddr, oparg) \
  9. __asm__ __volatile ( \
  10. "1: " insn "\n" \
  11. "2: .section .fixup,\"ax\"\n\
  12. 3: mov %3, %1\n\
  13. jmp 2b\n\
  14. .previous\n\
  15. .section __ex_table,\"a\"\n\
  16. .align 8\n\
  17. .quad 1b,3b\n\
  18. .previous" \
  19. : "=r" (oldval), "=r" (ret), "=m" (*uaddr) \
  20. : "i" (-EFAULT), "m" (*uaddr), "0" (oparg), "1" (0))
  21. #define __futex_atomic_op2(insn, ret, oldval, uaddr, oparg) \
  22. __asm__ __volatile ( \
  23. "1: movl %2, %0\n\
  24. movl %0, %3\n" \
  25. insn "\n" \
  26. "2: " LOCK_PREFIX "cmpxchgl %3, %2\n\
  27. jnz 1b\n\
  28. 3: .section .fixup,\"ax\"\n\
  29. 4: mov %5, %1\n\
  30. jmp 3b\n\
  31. .previous\n\
  32. .section __ex_table,\"a\"\n\
  33. .align 8\n\
  34. .quad 1b,4b,2b,4b\n\
  35. .previous" \
  36. : "=&a" (oldval), "=&r" (ret), "=m" (*uaddr), \
  37. "=&r" (tem) \
  38. : "r" (oparg), "i" (-EFAULT), "m" (*uaddr), "1" (0))
  39. static inline int
  40. futex_atomic_op_inuser (int encoded_op, int __user *uaddr)
  41. {
  42. int op = (encoded_op >> 28) & 7;
  43. int cmp = (encoded_op >> 24) & 15;
  44. int oparg = (encoded_op << 8) >> 20;
  45. int cmparg = (encoded_op << 20) >> 20;
  46. int oldval = 0, ret, tem;
  47. if (encoded_op & (FUTEX_OP_OPARG_SHIFT << 28))
  48. oparg = 1 << oparg;
  49. if (! access_ok (VERIFY_WRITE, uaddr, sizeof(int)))
  50. return -EFAULT;
  51. pagefault_disable();
  52. switch (op) {
  53. case FUTEX_OP_SET:
  54. __futex_atomic_op1("xchgl %0, %2", ret, oldval, uaddr, oparg);
  55. break;
  56. case FUTEX_OP_ADD:
  57. __futex_atomic_op1(LOCK_PREFIX "xaddl %0, %2", ret, oldval,
  58. uaddr, oparg);
  59. break;
  60. case FUTEX_OP_OR:
  61. __futex_atomic_op2("orl %4, %3", ret, oldval, uaddr, oparg);
  62. break;
  63. case FUTEX_OP_ANDN:
  64. __futex_atomic_op2("andl %4, %3", ret, oldval, uaddr, ~oparg);
  65. break;
  66. case FUTEX_OP_XOR:
  67. __futex_atomic_op2("xorl %4, %3", ret, oldval, uaddr, oparg);
  68. break;
  69. default:
  70. ret = -ENOSYS;
  71. }
  72. pagefault_enable();
  73. if (!ret) {
  74. switch (cmp) {
  75. case FUTEX_OP_CMP_EQ: ret = (oldval == cmparg); break;
  76. case FUTEX_OP_CMP_NE: ret = (oldval != cmparg); break;
  77. case FUTEX_OP_CMP_LT: ret = (oldval < cmparg); break;
  78. case FUTEX_OP_CMP_GE: ret = (oldval >= cmparg); break;
  79. case FUTEX_OP_CMP_LE: ret = (oldval <= cmparg); break;
  80. case FUTEX_OP_CMP_GT: ret = (oldval > cmparg); break;
  81. default: ret = -ENOSYS;
  82. }
  83. }
  84. return ret;
  85. }
  86. static inline int
  87. futex_atomic_cmpxchg_inatomic(int __user *uaddr, int oldval, int newval)
  88. {
  89. if (!access_ok(VERIFY_WRITE, uaddr, sizeof(int)))
  90. return -EFAULT;
  91. __asm__ __volatile__(
  92. "1: " LOCK_PREFIX "cmpxchgl %3, %1 \n"
  93. "2: .section .fixup, \"ax\" \n"
  94. "3: mov %2, %0 \n"
  95. " jmp 2b \n"
  96. " .previous \n"
  97. " .section __ex_table, \"a\" \n"
  98. " .align 8 \n"
  99. " .quad 1b,3b \n"
  100. " .previous \n"
  101. : "=a" (oldval), "=m" (*uaddr)
  102. : "i" (-EFAULT), "r" (newval), "0" (oldval)
  103. : "memory"
  104. );
  105. return oldval;
  106. }
  107. #endif
  108. #endif