xref: /openbmc/linux/arch/openrisc/include/asm/futex.h (revision d8bcaabe)
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 */
105