arch/openrisc/include/asm/futex.h

   1 #ifndef __ASM_OPENRISC_FUTEX_H
   2 #define __ASM_OPENRISC_FUTEX_H
   3
   4 #ifdef __KERNEL__
   5
   6 #include <linux/futex.h>
   7 #include <linux/uaccess.h>
   8 #include <asm/errno.h>
   9
  10 #define __futex_atomic_op(insn, ret, oldval, uaddr, oparg) \
  11 ({                                                              \
  12         __asm__ __volatile__ (                                  \
  13                 "1:     l.lwa   %0, %2                  \n"     \
  14                         insn                            "\n"    \
  15                 "2:     l.swa   %2, %1                  \n"     \
  16                 "       l.bnf   1b                      \n"     \
  17                 "        l.ori  %1, r0, 0               \n"     \
  18                 "3:                                     \n"     \
  19                 ".section .fixup,\"ax\"                 \n"     \
  20                 "4:     l.j     3b                      \n"     \
  21                 "        l.addi %1, r0, %3              \n"     \
  22                 ".previous                              \n"     \
  23                 ".section __ex_table,\"a\"              \n"     \
  24                 ".word  1b,4b,2b,4b                     \n"     \
  25                 ".previous                              \n"     \
  26                 : "=&r" (oldval), "=&r" (ret), "+m" (*uaddr)    \
  27                 : "i" (-EFAULT), "r" (oparg)                    \
  28                 : "cc", "memory"                                \
  29                 );                                              \
  30 })
  31
  32 static inline int
  33 arch_futex_atomic_op_inuser(int op, int oparg, int *oval, u32 __user *uaddr)
  34 {
  35         int oldval = 0, ret;
  36
  37         pagefault_disable();
  38
  39         switch (op) {
  40         case FUTEX_OP_SET:
  41                 __futex_atomic_op("l.or %1,%4,%4", ret, oldval, uaddr, oparg);
  42                 break;
  43         case FUTEX_OP_ADD:
  44                 __futex_atomic_op("l.add %1,%0,%4", ret, oldval, uaddr, oparg);
  45                 break;
  46         case FUTEX_OP_OR:
  47                 __futex_atomic_op("l.or %1,%0,%4", ret, oldval, uaddr, oparg);
  48                 break;
  49         case FUTEX_OP_ANDN:
  50                 __futex_atomic_op("l.and %1,%0,%4", ret, oldval, uaddr, ~oparg);
  51                 break;
  52         case FUTEX_OP_XOR:
  53                 __futex_atomic_op("l.xor %1,%0,%4", ret, oldval, uaddr, oparg);
  54                 break;
  55         default:
  56                 ret = -ENOSYS;
  57         }
  58
  59         pagefault_enable();
  60
  61         if (!ret)
  62                 *oval = oldval;
  63
  64         return ret;
  65 }
  66
  67 static inline int
  68 futex_atomic_cmpxchg_inatomic(u32 *uval, u32 __user *uaddr,
  69                               u32 oldval, u32 newval)
  70 {
  71         int ret = 0;
  72         u32 prev;
  73
  74         if (!access_ok(VERIFY_WRITE, uaddr, sizeof(u32)))
  75                 return -EFAULT;
  76
  77         __asm__ __volatile__ (                          \
  78                 "1:     l.lwa   %1, %2          \n"     \
  79                 "       l.sfeq  %1, %3          \n"     \
  80                 "       l.bnf   3f              \n"     \
  81                 "        l.nop                  \n"     \
  82                 "2:     l.swa   %2, %4          \n"     \
  83                 "       l.bnf   1b              \n"     \
  84                 "        l.nop                  \n"     \
  85                 "3:                             \n"     \
  86                 ".section .fixup,\"ax\"         \n"     \
  87                 "4:     l.j     3b              \n"     \
  88                 "        l.addi %0, r0, %5      \n"     \
  89                 ".previous                      \n"     \
  90                 ".section __ex_table,\"a\"      \n"     \
  91                 ".word  1b,4b,2b,4b             \n"     \
  92                 ".previous                      \n"     \
  93                 : "+r" (ret), "=&r" (prev), "+m" (*uaddr) \
  94                 : "r" (oldval), "r" (newval), "i" (-EFAULT) \
  95                 : "cc", "memory"                        \
  96                 );
  97
  98         *uval = prev;
  99         return ret;
 100 }
 101
 102 #endif /* __KERNEL__ */
 103
 104 #endif /* __ASM_OPENRISC_FUTEX_H */