1 files changed, 141 insertions, 0 deletions
diff --git a/arch/m68k/include/asm/cmpxchg.h b/arch/m68k/include/asm/cmpxchg.h
new file mode 100644
index 000000000000..5c81d0eae5cf
--- /dev/null
+++ b/arch/m68k/include/asm/cmpxchg.h
@@ -0,0 +1,141 @@
+#ifndef __ARCH_M68K_CMPXCHG__
+#define __ARCH_M68K_CMPXCHG__
+#include <linux/irqflags.h>
+struct __xchg_dummy { unsigned long a[100]; };
+#define __xg(x) ((volatile struct __xchg_dummy *)(x))
+extern unsigned long __invalid_xchg_size(unsigned long, volatile void *, int);
+#ifndef CONFIG_RMW_INSNS
+static inline unsigned long __xchg(unsigned long x, volatile void * ptr, int size)
+{
+        unsigned long flags, tmp;
+        local_irq_save(flags);
+        switch (size) {
+        case 1:
+                tmp = *(u8 *)ptr;
+                *(u8 *)ptr = x;
+                x = tmp;
+                break;
+        case 2:
+                tmp = *(u16 *)ptr;
+                *(u16 *)ptr = x;
+                x = tmp;
+                break;
+        case 4:
+                tmp = *(u32 *)ptr;
+                *(u32 *)ptr = x;
+                x = tmp;
+                break;
+        default:
+                tmp = __invalid_xchg_size(x, ptr, size);
+                break;
+        }
+        local_irq_restore(flags);
+        return x;
+}
+#else
+static inline unsigned long __xchg(unsigned long x, volatile void * ptr, int size)
+{
+        switch (size) {
+        case 1:
+                __asm__ __volatile__
+                        ("moveb %2,%0\n\t"
+                         "1:\n\t"
+                         "casb %0,%1,%2\n\t"
+                         "jne 1b"
+                         : "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
+                break;
+        case 2:
+                __asm__ __volatile__
+                        ("movew %2,%0\n\t"
+                         "1:\n\t"
+                         "casw %0,%1,%2\n\t"
+                         "jne 1b"
+                         : "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
+                break;
+        case 4:
+                __asm__ __volatile__
+                        ("movel %2,%0\n\t"
+                         "1:\n\t"
+                         "casl %0,%1,%2\n\t"
+                         "jne 1b"
+                         : "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
+                break;
+        default:
+                x = __invalid_xchg_size(x, ptr, size);
+                break;
+        }
+        return x;
+}
+#endif
+#define xchg(ptr,x) ((__typeof__(*(ptr)))__xchg((unsigned long)(x),(ptr),sizeof(*(ptr))))
+#include <asm-generic/cmpxchg-local.h>
+#define cmpxchg64_local(ptr, o, n) __cmpxchg64_local_generic((ptr), (o), (n))
+extern unsigned long __invalid_cmpxchg_size(volatile void *,
+                                            unsigned long, unsigned long, int);
+/*
+ * Atomic compare and exchange.  Compare OLD with MEM, if identical,
+ * store NEW in MEM.  Return the initial value in MEM.  Success is
+ * indicated by comparing RETURN with OLD.
+ */
+#ifdef CONFIG_RMW_INSNS
+#define __HAVE_ARCH_CMPXCHG     1
+static inline unsigned long __cmpxchg(volatile void *p, unsigned long old,
+                                      unsigned long new, int size)
+{
+        switch (size) {
+        case 1:
+                __asm__ __volatile__ ("casb %0,%2,%1"
+                                      : "=d" (old), "=m" (*(char *)p)
+                                      : "d" (new), "0" (old), "m" (*(char *)p));
+                break;
+        case 2:
+                __asm__ __volatile__ ("casw %0,%2,%1"
+                                      : "=d" (old), "=m" (*(short *)p)
+                                      : "d" (new), "0" (old), "m" (*(short *)p));
+                break;
+        case 4:
+                __asm__ __volatile__ ("casl %0,%2,%1"
+                                      : "=d" (old), "=m" (*(int *)p)
+                                      : "d" (new), "0" (old), "m" (*(int *)p));
+                break;
+        default:
+                old = __invalid_cmpxchg_size(p, old, new, size);
+                break;
+        }
+        return old;
+}
+#define cmpxchg(ptr, o, n)                                                  \
+        ((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o),           \
+                        (unsigned long)(n), sizeof(*(ptr))))
+#define cmpxchg_local(ptr, o, n)                                            \
+        ((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o),           \
+                        (unsigned long)(n), sizeof(*(ptr))))
+#else
+/*
+ * cmpxchg_local and cmpxchg64_local are atomic wrt current CPU. Always make
+ * them available.
+ */
+#define cmpxchg_local(ptr, o, n)                                               \
+        ((__typeof__(*(ptr)))__cmpxchg_local_generic((ptr), (unsigned long)(o),\
+                        (unsigned long)(n), sizeof(*(ptr))))
+#include <asm-generic/cmpxchg.h>
+#endif
+#endif /* __ARCH_M68K_CMPXCHG__ */

diff --git a/arch/m68k/include/asm/cmpxchg.h b/arch/m68k/include/asm/cmpxchg.h new file mode 100644 index 000000000000..5c81d0eae5cf --- /dev/null +++ b/arch/m68k/include/asm/cmpxchg.h
@@ -0,0 +1,141 @@
	1	#ifndef __ARCH_M68K_CMPXCHG__
	2	#define __ARCH_M68K_CMPXCHG__
	3
	4	#include <linux/irqflags.h>
	5
	6	struct __xchg_dummy { unsigned long a[100]; };
	7	#define __xg(x) ((volatile struct __xchg_dummy *)(x))
	8
	9	extern unsigned long __invalid_xchg_size(unsigned long, volatile void *, int);
	10
	11	#ifndef CONFIG_RMW_INSNS
	12	static inline unsigned long __xchg(unsigned long x, volatile void * ptr, int size)
	13	{
	14	unsigned long flags, tmp;
	15
	16	local_irq_save(flags);
	17
	18	switch (size) {
	19	case 1:
	20	tmp = (u8 )ptr;
	21	(u8 )ptr = x;
	22	x = tmp;
	23	break;
	24	case 2:
	25	tmp = (u16 )ptr;
	26	(u16 )ptr = x;
	27	x = tmp;
	28	break;
	29	case 4:
	30	tmp = (u32 )ptr;
	31	(u32 )ptr = x;
	32	x = tmp;
	33	break;
	34	default:
	35	tmp = __invalid_xchg_size(x, ptr, size);
	36	break;
	37	}
	38
	39	local_irq_restore(flags);
	40	return x;
	41	}
	42	#else
	43	static inline unsigned long __xchg(unsigned long x, volatile void * ptr, int size)
	44	{
	45	switch (size) {
	46	case 1:
	47	__asm__ __volatile__
	48	("moveb %2,%0\n\t"
	49	"1:\n\t"
	50	"casb %0,%1,%2\n\t"
	51	"jne 1b"
	52	: "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
	53	break;
	54	case 2:
	55	__asm__ __volatile__
	56	("movew %2,%0\n\t"
	57	"1:\n\t"
	58	"casw %0,%1,%2\n\t"
	59	"jne 1b"
	60	: "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
	61	break;
	62	case 4:
	63	__asm__ __volatile__
	64	("movel %2,%0\n\t"
	65	"1:\n\t"
	66	"casl %0,%1,%2\n\t"
	67	"jne 1b"
	68	: "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
	69	break;
	70	default:
	71	x = __invalid_xchg_size(x, ptr, size);
	72	break;
	73	}
	74	return x;
	75	}
	76	#endif
	77
	78	#define xchg(ptr,x) ((__typeof__((ptr)))__xchg((unsigned long)(x),(ptr),sizeof((ptr))))
	79
	80	#include <asm-generic/cmpxchg-local.h>
	81
	82	#define cmpxchg64_local(ptr, o, n) __cmpxchg64_local_generic((ptr), (o), (n))
	83
	84	extern unsigned long __invalid_cmpxchg_size(volatile void *,
	85	unsigned long, unsigned long, int);
	86
	87	/*
	88	* Atomic compare and exchange. Compare OLD with MEM, if identical,
	89	* store NEW in MEM. Return the initial value in MEM. Success is
	90	* indicated by comparing RETURN with OLD.
	91	*/
	92	#ifdef CONFIG_RMW_INSNS
	93	#define __HAVE_ARCH_CMPXCHG 1
	94
	95	static inline unsigned long __cmpxchg(volatile void *p, unsigned long old,
	96	unsigned long new, int size)
	97	{
	98	switch (size) {
	99	case 1:
	100	__asm__ __volatile__ ("casb %0,%2,%1"
	101	: "=d" (old), "=m" ((char )p)
	102	: "d" (new), "0" (old), "m" ((char )p));
	103	break;
	104	case 2:
	105	__asm__ __volatile__ ("casw %0,%2,%1"
	106	: "=d" (old), "=m" ((short )p)
	107	: "d" (new), "0" (old), "m" ((short )p));
	108	break;
	109	case 4:
	110	__asm__ __volatile__ ("casl %0,%2,%1"
	111	: "=d" (old), "=m" ((int )p)
	112	: "d" (new), "0" (old), "m" ((int )p));
	113	break;
	114	default:
	115	old = __invalid_cmpxchg_size(p, old, new, size);
	116	break;
	117	}
	118	return old;
	119	}
	120
	121	#define cmpxchg(ptr, o, n) \
	122	((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o), \
	123	(unsigned long)(n), sizeof(*(ptr))))
	124	#define cmpxchg_local(ptr, o, n) \
	125	((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o), \
	126	(unsigned long)(n), sizeof(*(ptr))))
	127	#else
	128
	129	/*
	130	* cmpxchg_local and cmpxchg64_local are atomic wrt current CPU. Always make
	131	* them available.
	132	*/
	133	#define cmpxchg_local(ptr, o, n) \
	134	((__typeof__(*(ptr)))__cmpxchg_local_generic((ptr), (unsigned long)(o),\
	135	(unsigned long)(n), sizeof(*(ptr))))
	136
	137	#include <asm-generic/cmpxchg.h>
	138
	139	#endif
	140
	141	#endif /* __ARCH_M68K_CMPXCHG__ */