[deliverable/linux.git] / arch / mips / include / asm / futex.h

/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (c) 2006  Ralf Baechle (ralf@linux-mips.org)
 */
#ifndef _ASM_FUTEX_H
#define _ASM_FUTEX_H

#ifdef __KERNEL__

#include <linux/futex.h>
#include <linux/uaccess.h>
#include <asm/asm-eva.h>
#include <asm/barrier.h>
#include <asm/compiler.h>
#include <asm/errno.h>
#include <asm/war.h>

#define __futex_atomic_op(insn, ret, oldval, uaddr, oparg)		\
{									\
	if (cpu_has_llsc && R10000_LLSC_WAR) {				\
		__asm__ __volatile__(					\
		"	.set	push				\n"	\
		"	.set	noat				\n"	\
		"	.set	arch=r4000			\n"	\
		"1:	ll	%1, %4	# __futex_atomic_op	\n"	\
		"	.set	mips0				\n"	\
		"	" insn	"				\n"	\
		"	.set	arch=r4000			\n"	\
		"2:	sc	$1, %2				\n"	\
		"	beqzl	$1, 1b				\n"	\
		__WEAK_LLSC_MB						\
		"3:						\n"	\
		"	.insn					\n"	\
		"	.set	pop				\n"	\
		"	.set	mips0				\n"	\
		"	.section .fixup,\"ax\"			\n"	\
		"4:	li	%0, %6				\n"	\
		"	j	3b				\n"	\
		"	.previous				\n"	\
		"	.section __ex_table,\"a\"		\n"	\
		"	"__UA_ADDR "\t1b, 4b			\n"	\
		"	"__UA_ADDR "\t2b, 4b			\n"	\
		"	.previous				\n"	\
		: "=r" (ret), "=&r" (oldval),				\
		  "=" GCC_OFF_SMALL_ASM() (*uaddr)				\
		: "0" (0), GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oparg),	\
		  "i" (-EFAULT)						\
		: "memory");						\
	} else if (cpu_has_llsc) {					\
		__asm__ __volatile__(					\
		"	.set	push				\n"	\
		"	.set	noat				\n"	\
		"	.set	"MIPS_ISA_ARCH_LEVEL"		\n"	\
		"1:	"user_ll("%1", "%4")" # __futex_atomic_op\n"	\
		"	.set	mips0				\n"	\
		"	" insn	"				\n"	\
		"	.set	"MIPS_ISA_ARCH_LEVEL"		\n"	\
		"2:	"user_sc("$1", "%2")"			\n"	\
		"	beqz	$1, 1b				\n"	\
		__WEAK_LLSC_MB						\
		"3:						\n"	\
		"	.insn					\n"	\
		"	.set	pop				\n"	\
		"	.set	mips0				\n"	\
		"	.section .fixup,\"ax\"			\n"	\
		"4:	li	%0, %6				\n"	\
		"	j	3b				\n"	\
		"	.previous				\n"	\
		"	.section __ex_table,\"a\"		\n"	\
		"	"__UA_ADDR "\t1b, 4b			\n"	\
		"	"__UA_ADDR "\t2b, 4b			\n"	\
		"	.previous				\n"	\
		: "=r" (ret), "=&r" (oldval),				\
		  "=" GCC_OFF_SMALL_ASM() (*uaddr)				\
		: "0" (0), GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oparg),	\
		  "i" (-EFAULT)						\
		: "memory");						\
	} else								\
		ret = -ENOSYS;						\
}

static inline int
futex_atomic_op_inuser(int encoded_op, u32 __user *uaddr)
{
	int op = (encoded_op >> 28) & 7;
	int cmp = (encoded_op >> 24) & 15;
	int oparg = (encoded_op << 8) >> 20;
	int cmparg = (encoded_op << 20) >> 20;
	int oldval = 0, ret;
	if (encoded_op & (FUTEX_OP_OPARG_SHIFT << 28))
		oparg = 1 << oparg;

	if (! access_ok (VERIFY_WRITE, uaddr, sizeof(u32)))
		return -EFAULT;

	pagefault_disable();

	switch (op) {
	case FUTEX_OP_SET:
		__futex_atomic_op("move $1, %z5", ret, oldval, uaddr, oparg);
		break;

	case FUTEX_OP_ADD:
		__futex_atomic_op("addu $1, %1, %z5",
				  ret, oldval, uaddr, oparg);
		break;
	case FUTEX_OP_OR:
		__futex_atomic_op("or	$1, %1, %z5",
				  ret, oldval, uaddr, oparg);
		break;
	case FUTEX_OP_ANDN:
		__futex_atomic_op("and	$1, %1, %z5",
				  ret, oldval, uaddr, ~oparg);
		break;
	case FUTEX_OP_XOR:
		__futex_atomic_op("xor	$1, %1, %z5",
				  ret, oldval, uaddr, oparg);
		break;
	default:
		ret = -ENOSYS;
	}

	pagefault_enable();

	if (!ret) {
		switch (cmp) {
		case FUTEX_OP_CMP_EQ: ret = (oldval == cmparg); break;
		case FUTEX_OP_CMP_NE: ret = (oldval != cmparg); break;
		case FUTEX_OP_CMP_LT: ret = (oldval < cmparg); break;
		case FUTEX_OP_CMP_GE: ret = (oldval >= cmparg); break;
		case FUTEX_OP_CMP_LE: ret = (oldval <= cmparg); break;
		case FUTEX_OP_CMP_GT: ret = (oldval > cmparg); break;
		default: ret = -ENOSYS;
		}
	}
	return ret;
}

static inline int
futex_atomic_cmpxchg_inatomic(u32 *uval, u32 __user *uaddr,
			      u32 oldval, u32 newval)
{
	int ret = 0;
	u32 val;

	if (!access_ok(VERIFY_WRITE, uaddr, sizeof(u32)))
		return -EFAULT;

	if (cpu_has_llsc && R10000_LLSC_WAR) {
		__asm__ __volatile__(
		"# futex_atomic_cmpxchg_inatomic			\n"
		"	.set	push					\n"
		"	.set	noat					\n"
		"	.set	arch=r4000				\n"
		"1:	ll	%1, %3					\n"
		"	bne	%1, %z4, 3f				\n"
		"	.set	mips0					\n"
		"	move	$1, %z5					\n"
		"	.set	arch=r4000				\n"
		"2:	sc	$1, %2					\n"
		"	beqzl	$1, 1b					\n"
		__WEAK_LLSC_MB
		"3:							\n"
		"	.insn						\n"
		"	.set	pop					\n"
		"	.section .fixup,\"ax\"				\n"
		"4:	li	%0, %6					\n"
		"	j	3b					\n"
		"	.previous					\n"
		"	.section __ex_table,\"a\"			\n"
		"	"__UA_ADDR "\t1b, 4b				\n"
		"	"__UA_ADDR "\t2b, 4b				\n"
		"	.previous					\n"
		: "+r" (ret), "=&r" (val), "=" GCC_OFF_SMALL_ASM() (*uaddr)
		: GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oldval), "Jr" (newval),
		  "i" (-EFAULT)
		: "memory");
	} else if (cpu_has_llsc) {
		__asm__ __volatile__(
		"# futex_atomic_cmpxchg_inatomic			\n"
		"	.set	push					\n"
		"	.set	noat					\n"
		"	.set	"MIPS_ISA_ARCH_LEVEL"			\n"
		"1:	"user_ll("%1", "%3")"				\n"
		"	bne	%1, %z4, 3f				\n"
		"	.set	mips0					\n"
		"	move	$1, %z5					\n"
		"	.set	"MIPS_ISA_ARCH_LEVEL"			\n"
		"2:	"user_sc("$1", "%2")"				\n"
		"	beqz	$1, 1b					\n"
		__WEAK_LLSC_MB
		"3:							\n"
		"	.insn						\n"
		"	.set	pop					\n"
		"	.section .fixup,\"ax\"				\n"
		"4:	li	%0, %6					\n"
		"	j	3b					\n"
		"	.previous					\n"
		"	.section __ex_table,\"a\"			\n"
		"	"__UA_ADDR "\t1b, 4b				\n"
		"	"__UA_ADDR "\t2b, 4b				\n"
		"	.previous					\n"
		: "+r" (ret), "=&r" (val), "=" GCC_OFF_SMALL_ASM() (*uaddr)
		: GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oldval), "Jr" (newval),
		  "i" (-EFAULT)
		: "memory");
	} else
		return -ENOSYS;

	*uval = val;
	return ret;
}

#endif
#endif /* _ASM_FUTEX_H */
Commit	Line	Data
0004a9df RB	1	/*
	2	* This file is subject to the terms and conditions of the GNU General Public
	3	* License. See the file "COPYING" in the main directory of this archive
	4	* for more details.
	5	*
	6	* Copyright (c) 2006 Ralf Baechle (ralf@linux-mips.org)
	7	*/
4732efbe JJ	8	#ifndef _ASM_FUTEX_H
	9	#define _ASM_FUTEX_H
	10
	11	#ifdef __KERNEL__
	12
	13	#include <linux/futex.h>
730f412c	14	#include <linux/uaccess.h>
a6813fe5	15	#include <asm/asm-eva.h>
0004a9df	16	#include <asm/barrier.h>
b0984c43	17	#include <asm/compiler.h>
4732efbe	18	#include <asm/errno.h>
6ee1da94	19	#include <asm/war.h>
4732efbe	20
ebfaebae RB	21	#define __futex_atomic_op(insn, ret, oldval, uaddr, oparg) \
ebfaebae RB	22	{ \
6ee1da94 RB	23	if (cpu_has_llsc && R10000_LLSC_WAR) { \
	24	__asm__ __volatile__( \
	25	" .set push \n" \
	26	" .set noat \n" \
a809d460	27	" .set arch=r4000 \n" \
0307e8d0	28	"1: ll %1, %4 # __futex_atomic_op \n" \
6ee1da94 RB	29	" .set mips0 \n" \
6ee1da94 RB	30	" " insn " \n" \
a809d460	31	" .set arch=r4000 \n" \
0307e8d0	32	"2: sc $1, %2 \n" \
6ee1da94	33	" beqzl $1, 1b \n" \
17099b11	34	__WEAK_LLSC_MB \
6ee1da94	35	"3: \n" \
0e525e48	36	" .insn \n" \
6ee1da94 RB	37	" .set pop \n" \
	38	" .set mips0 \n" \
	39	" .section .fixup,\"ax\" \n" \
0307e8d0	40	"4: li %0, %6 \n" \
0f67e90e	41	" j 3b \n" \
6ee1da94 RB	42	" .previous \n" \
	43	" .section __ex_table,\"a\" \n" \
	44	" "__UA_ADDR "\t1b, 4b \n" \
	45	" "__UA_ADDR "\t2b, 4b \n" \
	46	" .previous \n" \
b0984c43	47	: "=r" (ret), "=&r" (oldval), \
94bfb75a MC	48	"=" GCC_OFF_SMALL_ASM() (*uaddr) \
94bfb75a MC	49	: "0" (0), GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oparg), \
b0984c43	50	"i" (-EFAULT) \
0307e8d0	51	: "memory"); \
6ee1da94 RB	52	} else if (cpu_has_llsc) { \
	53	__asm__ __volatile__( \
	54	" .set push \n" \
	55	" .set noat \n" \
1922c356	56	" .set "MIPS_ISA_ARCH_LEVEL" \n" \
a6813fe5	57	"1: "user_ll("%1", "%4")" # __futex_atomic_op\n" \
6ee1da94 RB	58	" .set mips0 \n" \
6ee1da94 RB	59	" " insn " \n" \
1922c356	60	" .set "MIPS_ISA_ARCH_LEVEL" \n" \
a6813fe5	61	"2: "user_sc("$1", "%2")" \n" \
6ee1da94	62	" beqz $1, 1b \n" \
17099b11	63	__WEAK_LLSC_MB \
6ee1da94	64	"3: \n" \
0e525e48	65	" .insn \n" \
6ee1da94 RB	66	" .set pop \n" \
	67	" .set mips0 \n" \
	68	" .section .fixup,\"ax\" \n" \
0307e8d0	69	"4: li %0, %6 \n" \
0f67e90e	70	" j 3b \n" \
6ee1da94 RB	71	" .previous \n" \
	72	" .section __ex_table,\"a\" \n" \
	73	" "__UA_ADDR "\t1b, 4b \n" \
	74	" "__UA_ADDR "\t2b, 4b \n" \
	75	" .previous \n" \
b0984c43	76	: "=r" (ret), "=&r" (oldval), \
94bfb75a MC	77	"=" GCC_OFF_SMALL_ASM() (*uaddr) \
94bfb75a MC	78	: "0" (0), GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oparg), \
b0984c43	79	"i" (-EFAULT) \
0307e8d0	80	: "memory"); \
6ee1da94 RB	81	} else \
6ee1da94 RB	82	ret = -ENOSYS; \
ebfaebae RB	83	}
ebfaebae RB	84
4732efbe	85	static inline int
8d7718aa	86	futex_atomic_op_inuser(int encoded_op, u32 __user *uaddr)
4732efbe JJ	87	{
	88	int op = (encoded_op >> 28) & 7;
	89	int cmp = (encoded_op >> 24) & 15;
	90	int oparg = (encoded_op << 8) >> 20;
	91	int cmparg = (encoded_op << 20) >> 20;
	92	int oldval = 0, ret;
	93	if (encoded_op & (FUTEX_OP_OPARG_SHIFT << 28))
	94	oparg = 1 << oparg;
	95
8d7718aa	96	if (! access_ok (VERIFY_WRITE, uaddr, sizeof(u32)))
4732efbe JJ	97	return -EFAULT;
4732efbe JJ	98
a866374a	99	pagefault_disable();
4732efbe JJ	100
	101	switch (op) {
	102	case FUTEX_OP_SET:
70342287	103	__futex_atomic_op("move $1, %z5", ret, oldval, uaddr, oparg);
ebfaebae RB	104	break;
ebfaebae RB	105
4732efbe	106	case FUTEX_OP_ADD:
70342287 RB	107	__futex_atomic_op("addu $1, %1, %z5",
70342287 RB	108	ret, oldval, uaddr, oparg);
ebfaebae	109	break;
4732efbe	110	case FUTEX_OP_OR:
0307e8d0	111	__futex_atomic_op("or $1, %1, %z5",
70342287	112	ret, oldval, uaddr, oparg);
ebfaebae	113	break;
4732efbe	114	case FUTEX_OP_ANDN:
0307e8d0	115	__futex_atomic_op("and $1, %1, %z5",
70342287	116	ret, oldval, uaddr, ~oparg);
ebfaebae	117	break;
4732efbe	118	case FUTEX_OP_XOR:
0307e8d0	119	__futex_atomic_op("xor $1, %1, %z5",
70342287	120	ret, oldval, uaddr, oparg);
ebfaebae	121	break;
4732efbe JJ	122	default:
	123	ret = -ENOSYS;
	124	}
	125
a866374a	126	pagefault_enable();
4732efbe JJ	127
	128	if (!ret) {
	129	switch (cmp) {
	130	case FUTEX_OP_CMP_EQ: ret = (oldval == cmparg); break;
	131	case FUTEX_OP_CMP_NE: ret = (oldval != cmparg); break;
	132	case FUTEX_OP_CMP_LT: ret = (oldval < cmparg); break;
	133	case FUTEX_OP_CMP_GE: ret = (oldval >= cmparg); break;
	134	case FUTEX_OP_CMP_LE: ret = (oldval <= cmparg); break;
	135	case FUTEX_OP_CMP_GT: ret = (oldval > cmparg); break;
	136	default: ret = -ENOSYS;
	137	}
	138	}
	139	return ret;
	140	}
	141
e9056f13	142	static inline int
8d7718aa ML	143	futex_atomic_cmpxchg_inatomic(u32 uval, u32 __user uaddr,
8d7718aa ML	144	u32 oldval, u32 newval)
e9056f13	145	{
8d7718aa ML	146	int ret = 0;
8d7718aa ML	147	u32 val;
6ee1da94	148
8d7718aa	149	if (!access_ok(VERIFY_WRITE, uaddr, sizeof(u32)))
6ee1da94 RB	150	return -EFAULT;
	151
	152	if (cpu_has_llsc && R10000_LLSC_WAR) {
	153	__asm__ __volatile__(
	154	"# futex_atomic_cmpxchg_inatomic \n"
	155	" .set push \n"
	156	" .set noat \n"
a809d460	157	" .set arch=r4000 \n"
37a9d912 ML	158	"1: ll %1, %3 \n"
37a9d912 ML	159	" bne %1, %z4, 3f \n"
6ee1da94	160	" .set mips0 \n"
37a9d912	161	" move $1, %z5 \n"
a809d460	162	" .set arch=r4000 \n"
37a9d912	163	"2: sc $1, %2 \n"
6ee1da94	164	" beqzl $1, 1b \n"
17099b11	165	__WEAK_LLSC_MB
6ee1da94	166	"3: \n"
0e525e48	167	" .insn \n"
6ee1da94 RB	168	" .set pop \n"
6ee1da94 RB	169	" .section .fixup,\"ax\" \n"
37a9d912	170	"4: li %0, %6 \n"
6ee1da94 RB	171	" j 3b \n"
	172	" .previous \n"
	173	" .section __ex_table,\"a\" \n"
	174	" "__UA_ADDR "\t1b, 4b \n"
	175	" "__UA_ADDR "\t2b, 4b \n"
	176	" .previous \n"
94bfb75a MC	177	: "+r" (ret), "=&r" (val), "=" GCC_OFF_SMALL_ASM() (*uaddr)
94bfb75a MC	178	: GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oldval), "Jr" (newval),
b0984c43	179	"i" (-EFAULT)
6ee1da94 RB	180	: "memory");
	181	} else if (cpu_has_llsc) {
	182	__asm__ __volatile__(
	183	"# futex_atomic_cmpxchg_inatomic \n"
	184	" .set push \n"
	185	" .set noat \n"
1922c356	186	" .set "MIPS_ISA_ARCH_LEVEL" \n"
a6813fe5	187	"1: "user_ll("%1", "%3")" \n"
37a9d912	188	" bne %1, %z4, 3f \n"
6ee1da94	189	" .set mips0 \n"
37a9d912	190	" move $1, %z5 \n"
1922c356	191	" .set "MIPS_ISA_ARCH_LEVEL" \n"
a6813fe5	192	"2: "user_sc("$1", "%2")" \n"
6ee1da94	193	" beqz $1, 1b \n"
17099b11	194	__WEAK_LLSC_MB
6ee1da94	195	"3: \n"
0e525e48	196	" .insn \n"
6ee1da94 RB	197	" .set pop \n"
6ee1da94 RB	198	" .section .fixup,\"ax\" \n"
37a9d912	199	"4: li %0, %6 \n"
6ee1da94 RB	200	" j 3b \n"
	201	" .previous \n"
	202	" .section __ex_table,\"a\" \n"
	203	" "__UA_ADDR "\t1b, 4b \n"
	204	" "__UA_ADDR "\t2b, 4b \n"
	205	" .previous \n"
94bfb75a MC	206	: "+r" (ret), "=&r" (val), "=" GCC_OFF_SMALL_ASM() (*uaddr)
94bfb75a MC	207	: GCC_OFF_SMALL_ASM() (*uaddr), "Jr" (oldval), "Jr" (newval),
b0984c43	208	"i" (-EFAULT)
6ee1da94 RB	209	: "memory");
	210	} else
	211	return -ENOSYS;
	212
37a9d912 ML	213	*uval = val;
37a9d912 ML	214	return ret;
e9056f13 IM	215	}
e9056f13 IM	216
4732efbe	217	#endif
0f67e90e	218	#endif /* _ASM_FUTEX_H */