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