18c2ecf20Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */
28c2ecf20Sopenharmony_ci#ifndef _ASM_X86_FUTEX_H
38c2ecf20Sopenharmony_ci#define _ASM_X86_FUTEX_H
48c2ecf20Sopenharmony_ci
58c2ecf20Sopenharmony_ci#ifdef __KERNEL__
68c2ecf20Sopenharmony_ci
78c2ecf20Sopenharmony_ci#include <linux/futex.h>
88c2ecf20Sopenharmony_ci#include <linux/uaccess.h>
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_ci#include <asm/asm.h>
118c2ecf20Sopenharmony_ci#include <asm/errno.h>
128c2ecf20Sopenharmony_ci#include <asm/processor.h>
138c2ecf20Sopenharmony_ci#include <asm/smap.h>
148c2ecf20Sopenharmony_ci
158c2ecf20Sopenharmony_ci#define unsafe_atomic_op1(insn, oval, uaddr, oparg, label)	\
168c2ecf20Sopenharmony_cido {								\
178c2ecf20Sopenharmony_ci	int oldval = 0, ret;					\
188c2ecf20Sopenharmony_ci	asm volatile("1:\t" insn "\n"				\
198c2ecf20Sopenharmony_ci		     "2:\n"					\
208c2ecf20Sopenharmony_ci		     "\t.section .fixup,\"ax\"\n"		\
218c2ecf20Sopenharmony_ci		     "3:\tmov\t%3, %1\n"			\
228c2ecf20Sopenharmony_ci		     "\tjmp\t2b\n"				\
238c2ecf20Sopenharmony_ci		     "\t.previous\n"				\
248c2ecf20Sopenharmony_ci		     _ASM_EXTABLE_UA(1b, 3b)			\
258c2ecf20Sopenharmony_ci		     : "=r" (oldval), "=r" (ret), "+m" (*uaddr)	\
268c2ecf20Sopenharmony_ci		     : "i" (-EFAULT), "0" (oparg), "1" (0));	\
278c2ecf20Sopenharmony_ci	if (ret)						\
288c2ecf20Sopenharmony_ci		goto label;					\
298c2ecf20Sopenharmony_ci	*oval = oldval;						\
308c2ecf20Sopenharmony_ci} while(0)
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci#define unsafe_atomic_op2(insn, oval, uaddr, oparg, label)	\
348c2ecf20Sopenharmony_cido {								\
358c2ecf20Sopenharmony_ci	int oldval = 0, ret, tem;				\
368c2ecf20Sopenharmony_ci	asm volatile("1:\tmovl	%2, %0\n"			\
378c2ecf20Sopenharmony_ci		     "2:\tmovl\t%0, %3\n"			\
388c2ecf20Sopenharmony_ci		     "\t" insn "\n"				\
398c2ecf20Sopenharmony_ci		     "3:\t" LOCK_PREFIX "cmpxchgl %3, %2\n"	\
408c2ecf20Sopenharmony_ci		     "\tjnz\t2b\n"				\
418c2ecf20Sopenharmony_ci		     "4:\n"					\
428c2ecf20Sopenharmony_ci		     "\t.section .fixup,\"ax\"\n"		\
438c2ecf20Sopenharmony_ci		     "5:\tmov\t%5, %1\n"			\
448c2ecf20Sopenharmony_ci		     "\tjmp\t4b\n"				\
458c2ecf20Sopenharmony_ci		     "\t.previous\n"				\
468c2ecf20Sopenharmony_ci		     _ASM_EXTABLE_UA(1b, 5b)			\
478c2ecf20Sopenharmony_ci		     _ASM_EXTABLE_UA(3b, 5b)			\
488c2ecf20Sopenharmony_ci		     : "=&a" (oldval), "=&r" (ret),		\
498c2ecf20Sopenharmony_ci		       "+m" (*uaddr), "=&r" (tem)		\
508c2ecf20Sopenharmony_ci		     : "r" (oparg), "i" (-EFAULT), "1" (0));	\
518c2ecf20Sopenharmony_ci	if (ret)						\
528c2ecf20Sopenharmony_ci		goto label;					\
538c2ecf20Sopenharmony_ci	*oval = oldval;						\
548c2ecf20Sopenharmony_ci} while(0)
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_cistatic __always_inline int arch_futex_atomic_op_inuser(int op, int oparg, int *oval,
578c2ecf20Sopenharmony_ci		u32 __user *uaddr)
588c2ecf20Sopenharmony_ci{
598c2ecf20Sopenharmony_ci	if (!user_access_begin(uaddr, sizeof(u32)))
608c2ecf20Sopenharmony_ci		return -EFAULT;
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci	switch (op) {
638c2ecf20Sopenharmony_ci	case FUTEX_OP_SET:
648c2ecf20Sopenharmony_ci		unsafe_atomic_op1("xchgl %0, %2", oval, uaddr, oparg, Efault);
658c2ecf20Sopenharmony_ci		break;
668c2ecf20Sopenharmony_ci	case FUTEX_OP_ADD:
678c2ecf20Sopenharmony_ci		unsafe_atomic_op1(LOCK_PREFIX "xaddl %0, %2", oval,
688c2ecf20Sopenharmony_ci				   uaddr, oparg, Efault);
698c2ecf20Sopenharmony_ci		break;
708c2ecf20Sopenharmony_ci	case FUTEX_OP_OR:
718c2ecf20Sopenharmony_ci		unsafe_atomic_op2("orl %4, %3", oval, uaddr, oparg, Efault);
728c2ecf20Sopenharmony_ci		break;
738c2ecf20Sopenharmony_ci	case FUTEX_OP_ANDN:
748c2ecf20Sopenharmony_ci		unsafe_atomic_op2("andl %4, %3", oval, uaddr, ~oparg, Efault);
758c2ecf20Sopenharmony_ci		break;
768c2ecf20Sopenharmony_ci	case FUTEX_OP_XOR:
778c2ecf20Sopenharmony_ci		unsafe_atomic_op2("xorl %4, %3", oval, uaddr, oparg, Efault);
788c2ecf20Sopenharmony_ci		break;
798c2ecf20Sopenharmony_ci	default:
808c2ecf20Sopenharmony_ci		user_access_end();
818c2ecf20Sopenharmony_ci		return -ENOSYS;
828c2ecf20Sopenharmony_ci	}
838c2ecf20Sopenharmony_ci	user_access_end();
848c2ecf20Sopenharmony_ci	return 0;
858c2ecf20Sopenharmony_ciEfault:
868c2ecf20Sopenharmony_ci	user_access_end();
878c2ecf20Sopenharmony_ci	return -EFAULT;
888c2ecf20Sopenharmony_ci}
898c2ecf20Sopenharmony_ci
908c2ecf20Sopenharmony_cistatic inline int futex_atomic_cmpxchg_inatomic(u32 *uval, u32 __user *uaddr,
918c2ecf20Sopenharmony_ci						u32 oldval, u32 newval)
928c2ecf20Sopenharmony_ci{
938c2ecf20Sopenharmony_ci	int ret = 0;
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci	if (!user_access_begin(uaddr, sizeof(u32)))
968c2ecf20Sopenharmony_ci		return -EFAULT;
978c2ecf20Sopenharmony_ci	asm volatile("\n"
988c2ecf20Sopenharmony_ci		"1:\t" LOCK_PREFIX "cmpxchgl %4, %2\n"
998c2ecf20Sopenharmony_ci		"2:\n"
1008c2ecf20Sopenharmony_ci		"\t.section .fixup, \"ax\"\n"
1018c2ecf20Sopenharmony_ci		"3:\tmov     %3, %0\n"
1028c2ecf20Sopenharmony_ci		"\tjmp     2b\n"
1038c2ecf20Sopenharmony_ci		"\t.previous\n"
1048c2ecf20Sopenharmony_ci		_ASM_EXTABLE_UA(1b, 3b)
1058c2ecf20Sopenharmony_ci		: "+r" (ret), "=a" (oldval), "+m" (*uaddr)
1068c2ecf20Sopenharmony_ci		: "i" (-EFAULT), "r" (newval), "1" (oldval)
1078c2ecf20Sopenharmony_ci		: "memory"
1088c2ecf20Sopenharmony_ci	);
1098c2ecf20Sopenharmony_ci	user_access_end();
1108c2ecf20Sopenharmony_ci	*uval = oldval;
1118c2ecf20Sopenharmony_ci	return ret;
1128c2ecf20Sopenharmony_ci}
1138c2ecf20Sopenharmony_ci
1148c2ecf20Sopenharmony_ci#endif
1158c2ecf20Sopenharmony_ci#endif /* _ASM_X86_FUTEX_H */
116