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
arch_futex_atomic_op_inuser(int op,int oparg,int * oval,u32 __user * uaddr)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
37a08971e9SAl Viro if (!access_ok(uaddr, sizeof(u32)))
38a08971e9SAl 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
futex_atomic_cmpxchg_inatomic(u32 * uval,u32 __user * uaddr,u32 oldval,u32 newval)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