1b2441318SGreg Kroah-Hartman /* SPDX-License-Identifier: GPL-2.0 */ 2fd3db0a6SMichal Simek #ifndef _ASM_MICROBLAZE_FUTEX_H 3fd3db0a6SMichal Simek #define _ASM_MICROBLAZE_FUTEX_H 4fd3db0a6SMichal Simek 5fd3db0a6SMichal Simek #ifdef __KERNEL__ 6fd3db0a6SMichal Simek 7fd3db0a6SMichal Simek #include <linux/futex.h> 8fd3db0a6SMichal Simek #include <linux/uaccess.h> 9fd3db0a6SMichal Simek #include <asm/errno.h> 10fd3db0a6SMichal Simek 11fd3db0a6SMichal Simek #define __futex_atomic_op(insn, ret, oldval, uaddr, oparg) \ 12fd3db0a6SMichal Simek ({ \ 13fd3db0a6SMichal Simek __asm__ __volatile__ ( \ 14fd3db0a6SMichal Simek "1: lwx %0, %2, r0; " \ 15fd3db0a6SMichal Simek insn \ 16fd3db0a6SMichal Simek "2: swx %1, %2, r0; \ 17fd3db0a6SMichal Simek addic %1, r0, 0; \ 18fd3db0a6SMichal Simek bnei %1, 1b; \ 19fd3db0a6SMichal Simek 3: \ 20fd3db0a6SMichal Simek .section .fixup,\"ax\"; \ 21fd3db0a6SMichal Simek 4: brid 3b; \ 22fd3db0a6SMichal Simek addik %1, r0, %3; \ 23fd3db0a6SMichal Simek .previous; \ 24fd3db0a6SMichal Simek .section __ex_table,\"a\"; \ 25fd3db0a6SMichal Simek .word 1b,4b,2b,4b; \ 26fd3db0a6SMichal Simek .previous;" \ 27fd3db0a6SMichal Simek : "=&r" (oldval), "=&r" (ret) \ 288cf662edSMichal Simek : "r" (uaddr), "i" (-EFAULT), "r" (oparg) \ 29fd3db0a6SMichal Simek ); \ 30fd3db0a6SMichal Simek }) 31fd3db0a6SMichal Simek 32fd3db0a6SMichal Simek static inline int 3330d6e0a4SJiri Slaby arch_futex_atomic_op_inuser(int op, int oparg, int *oval, u32 __user *uaddr) 34fd3db0a6SMichal Simek { 35fd3db0a6SMichal Simek int oldval = 0, ret; 36fd3db0a6SMichal Simek 37*a08971e9SAl Viro if (!access_ok(uaddr, sizeof(u32))) 38*a08971e9SAl Viro return -EFAULT; 39fd3db0a6SMichal Simek 40fd3db0a6SMichal Simek switch (op) { 41fd3db0a6SMichal Simek case FUTEX_OP_SET: 42fd3db0a6SMichal Simek __futex_atomic_op("or %1,%4,%4;", ret, oldval, uaddr, oparg); 43fd3db0a6SMichal Simek break; 44fd3db0a6SMichal Simek case FUTEX_OP_ADD: 45fd3db0a6SMichal Simek __futex_atomic_op("add %1,%0,%4;", ret, oldval, uaddr, oparg); 46fd3db0a6SMichal Simek break; 47fd3db0a6SMichal Simek case FUTEX_OP_OR: 48fd3db0a6SMichal Simek __futex_atomic_op("or %1,%0,%4;", ret, oldval, uaddr, oparg); 49fd3db0a6SMichal Simek break; 50fd3db0a6SMichal Simek case FUTEX_OP_ANDN: 514bb30baaSMichal Simek __futex_atomic_op("andn %1,%0,%4;", ret, oldval, uaddr, oparg); 52fd3db0a6SMichal Simek break; 53fd3db0a6SMichal Simek case FUTEX_OP_XOR: 54fd3db0a6SMichal Simek __futex_atomic_op("xor %1,%0,%4;", ret, oldval, uaddr, oparg); 55fd3db0a6SMichal Simek break; 56fd3db0a6SMichal Simek default: 57fd3db0a6SMichal Simek ret = -ENOSYS; 58fd3db0a6SMichal Simek } 59fd3db0a6SMichal Simek 6030d6e0a4SJiri Slaby if (!ret) 6130d6e0a4SJiri Slaby *oval = oldval; 6230d6e0a4SJiri Slaby 63fd3db0a6SMichal Simek return ret; 64fd3db0a6SMichal Simek } 65fd3db0a6SMichal Simek 66fd3db0a6SMichal Simek static inline int 678d7718aaSMichel Lespinasse futex_atomic_cmpxchg_inatomic(u32 *uval, u32 __user *uaddr, 688d7718aaSMichel Lespinasse u32 oldval, u32 newval) 69fd3db0a6SMichal Simek { 708d7718aaSMichel Lespinasse int ret = 0, cmp; 718d7718aaSMichel Lespinasse u32 prev; 72fd3db0a6SMichal Simek 7396d4f267SLinus Torvalds if (!access_ok(uaddr, sizeof(u32))) 74fd3db0a6SMichal Simek return -EFAULT; 75fd3db0a6SMichal Simek 7637a9d912SMichel Lespinasse __asm__ __volatile__ ("1: lwx %1, %3, r0; \ 7737a9d912SMichel Lespinasse cmp %2, %1, %4; \ 78f6a12a7dSMeyer, Kirk bnei %2, 3f; \ 7937a9d912SMichel Lespinasse 2: swx %5, %3, r0; \ 8037a9d912SMichel Lespinasse addic %2, r0, 0; \ 8137a9d912SMichel Lespinasse bnei %2, 1b; \ 82fd3db0a6SMichal Simek 3: \ 83fd3db0a6SMichal Simek .section .fixup,\"ax\"; \ 84fd3db0a6SMichal Simek 4: brid 3b; \ 8537a9d912SMichel Lespinasse addik %0, r0, %6; \ 86fd3db0a6SMichal Simek .previous; \ 87fd3db0a6SMichal Simek .section __ex_table,\"a\"; \ 88fd3db0a6SMichal Simek .word 1b,4b,2b,4b; \ 89fd3db0a6SMichal Simek .previous;" \ 9037a9d912SMichel Lespinasse : "+r" (ret), "=&r" (prev), "=&r"(cmp) \ 91fd3db0a6SMichal Simek : "r" (uaddr), "r" (oldval), "r" (newval), "i" (-EFAULT)); 92fd3db0a6SMichal Simek 9337a9d912SMichel Lespinasse *uval = prev; 9437a9d912SMichel Lespinasse return ret; 95fd3db0a6SMichal Simek } 96fd3db0a6SMichal Simek 97fd3db0a6SMichal Simek #endif /* __KERNEL__ */ 98fd3db0a6SMichal Simek 99fd3db0a6SMichal Simek #endif 100