futex_64.h 2.9 KB

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