futex.h 2.1 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485
  1. #ifndef _ASM_POWERPC_FUTEX_H
  2. #define _ASM_POWERPC_FUTEX_H
  3. #ifdef __KERNEL__
  4. #include <linux/futex.h>
  5. #include <asm/errno.h>
  6. #include <asm/synch.h>
  7. #include <asm/uaccess.h>
  8. #include <asm/asm-compat.h>
  9. #define __futex_atomic_op(insn, ret, oldval, uaddr, oparg) \
  10. __asm__ __volatile ( \
  11. LWSYNC_ON_SMP \
  12. "1: lwarx %0,0,%2\n" \
  13. insn \
  14. PPC405_ERR77(0, %2) \
  15. "2: stwcx. %1,0,%2\n" \
  16. "bne- 1b\n" \
  17. "li %1,0\n" \
  18. "3: .section .fixup,\"ax\"\n" \
  19. "4: li %1,%3\n" \
  20. "b 3b\n" \
  21. ".previous\n" \
  22. ".section __ex_table,\"a\"\n" \
  23. ".align 3\n" \
  24. PPC_LONG "1b,4b,2b,4b\n" \
  25. ".previous" \
  26. : "=&r" (oldval), "=&r" (ret) \
  27. : "b" (uaddr), "i" (-EFAULT), "1" (oparg) \
  28. : "cr0", "memory")
  29. static inline int futex_atomic_op_inuser (int encoded_op, int __user *uaddr)
  30. {
  31. int op = (encoded_op >> 28) & 7;
  32. int cmp = (encoded_op >> 24) & 15;
  33. int oparg = (encoded_op << 8) >> 20;
  34. int cmparg = (encoded_op << 20) >> 20;
  35. int oldval = 0, ret;
  36. if (encoded_op & (FUTEX_OP_OPARG_SHIFT << 28))
  37. oparg = 1 << oparg;
  38. if (! access_ok (VERIFY_WRITE, uaddr, sizeof(int)))
  39. return -EFAULT;
  40. inc_preempt_count();
  41. switch (op) {
  42. case FUTEX_OP_SET:
  43. __futex_atomic_op("", ret, oldval, uaddr, oparg);
  44. break;
  45. case FUTEX_OP_ADD:
  46. __futex_atomic_op("add %1,%0,%1\n", ret, oldval, uaddr, oparg);
  47. break;
  48. case FUTEX_OP_OR:
  49. __futex_atomic_op("or %1,%0,%1\n", ret, oldval, uaddr, oparg);
  50. break;
  51. case FUTEX_OP_ANDN:
  52. __futex_atomic_op("andc %1,%0,%1\n", ret, oldval, uaddr, oparg);
  53. break;
  54. case FUTEX_OP_XOR:
  55. __futex_atomic_op("xor %1,%0,%1\n", ret, oldval, uaddr, oparg);
  56. break;
  57. default:
  58. ret = -ENOSYS;
  59. }
  60. dec_preempt_count();
  61. if (!ret) {
  62. switch (cmp) {
  63. case FUTEX_OP_CMP_EQ: ret = (oldval == cmparg); break;
  64. case FUTEX_OP_CMP_NE: ret = (oldval != cmparg); break;
  65. case FUTEX_OP_CMP_LT: ret = (oldval < cmparg); break;
  66. case FUTEX_OP_CMP_GE: ret = (oldval >= cmparg); break;
  67. case FUTEX_OP_CMP_LE: ret = (oldval <= cmparg); break;
  68. case FUTEX_OP_CMP_GT: ret = (oldval > cmparg); break;
  69. default: ret = -ENOSYS;
  70. }
  71. }
  72. return ret;
  73. }
  74. #endif /* __KERNEL__ */
  75. #endif /* _ASM_POWERPC_FUTEX_H */