1 files changed, 169 insertions, 0 deletions
diff --git a/include/asm-sh/atomic-grb.h b/include/asm-sh/atomic-grb.h
new file mode 100644
index 00000000000..4c5b7dbfced
--- /dev/null
+++ b/include/asm-sh/atomic-grb.h
@@ -0,0 +1,169 @@
+#ifndef __ASM_SH_ATOMIC_GRB_H
+#define __ASM_SH_ATOMIC_GRB_H
+static inline void atomic_add(int i, atomic_t *v)
+{
+        int tmp;
+        __asm__ __volatile__ (
+                "   .align 2              \n\t"
+                "   mova    1f,   r0      \n\t" /* r0 = end point */
+                "   mov    r15,   r1      \n\t" /* r1 = saved sp */
+                "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */
+                "   mov.l  @%1,   %0      \n\t" /* load  old value */
+                "   add     %2,   %0      \n\t" /* add */
+                "   mov.l   %0,   @%1     \n\t" /* store new value */
+                "1: mov     r1,   r15     \n\t" /* LOGOUT */
+                : "=&r" (tmp),
+                  "+r"  (v)
+                : "r"   (i)
+                : "memory" , "r0", "r1");
+}
+static inline void atomic_sub(int i, atomic_t *v)
+{
+        int tmp;
+        __asm__ __volatile__ (
+                "   .align 2              \n\t"
+                "   mova    1f,   r0      \n\t" /* r0 = end point */
+                "   mov     r15,  r1      \n\t" /* r1 = saved sp */
+                "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */
+                "   mov.l  @%1,   %0      \n\t" /* load  old value */
+                "   sub     %2,   %0      \n\t" /* sub */
+                "   mov.l   %0,   @%1     \n\t" /* store new value */
+                "1: mov     r1,   r15     \n\t" /* LOGOUT */
+                : "=&r" (tmp),
+                  "+r"  (v)
+                : "r"   (i)
+                : "memory" , "r0", "r1");
+}
+static inline int atomic_add_return(int i, atomic_t *v)
+{
+        int tmp;
+        __asm__ __volatile__ (
+                "   .align 2              \n\t"
+                "   mova    1f,   r0      \n\t" /* r0 = end point */
+                "   mov    r15,   r1      \n\t" /* r1 = saved sp */
+                "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */
+                "   mov.l  @%1,   %0      \n\t" /* load  old value */
+                "   add     %2,   %0      \n\t" /* add */
+                "   mov.l   %0,   @%1     \n\t" /* store new value */
+                "1: mov     r1,   r15     \n\t" /* LOGOUT */
+                : "=&r" (tmp),
+                  "+r"  (v)
+                : "r"   (i)
+                : "memory" , "r0", "r1");
+        return tmp;
+}
+static inline int atomic_sub_return(int i, atomic_t *v)
+{
+        int tmp;
+        __asm__ __volatile__ (
+                "   .align 2              \n\t"
+                "   mova    1f,   r0      \n\t" /* r0 = end point */
+                "   mov    r15,   r1      \n\t" /* r1 = saved sp */
+                "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */
+                "   mov.l  @%1,   %0      \n\t" /* load  old value */
+                "   sub     %2,   %0      \n\t" /* sub */
+                "   mov.l   %0,   @%1     \n\t" /* store new value */
+                "1: mov     r1,   r15     \n\t" /* LOGOUT */
+                : "=&r" (tmp),
+                  "+r"  (v)
+                : "r"   (i)
+                : "memory", "r0", "r1");
+        return tmp;
+}
+static inline void atomic_clear_mask(unsigned int mask, atomic_t *v)
+{
+        int tmp;
+        unsigned int _mask = ~mask;
+        __asm__ __volatile__ (
+                "   .align 2              \n\t"
+                "   mova    1f,   r0      \n\t" /* r0 = end point */
+                "   mov    r15,   r1      \n\t" /* r1 = saved sp */
+                "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */
+                "   mov.l  @%1,   %0      \n\t" /* load  old value */
+                "   and     %2,   %0      \n\t" /* add */
+                "   mov.l   %0,   @%1     \n\t" /* store new value */
+                "1: mov     r1,   r15     \n\t" /* LOGOUT */
+                : "=&r" (tmp),
+                  "+r"  (v)
+                : "r"   (_mask)
+                : "memory" , "r0", "r1");
+}
+static inline void atomic_set_mask(unsigned int mask, atomic_t *v)
+{
+        int tmp;
+        __asm__ __volatile__ (
+                "   .align 2              \n\t"
+                "   mova    1f,   r0      \n\t" /* r0 = end point */
+                "   mov    r15,   r1      \n\t" /* r1 = saved sp */
+                "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */
+                "   mov.l  @%1,   %0      \n\t" /* load  old value */
+                "   or      %2,   %0      \n\t" /* or */
+                "   mov.l   %0,   @%1     \n\t" /* store new value */
+                "1: mov     r1,   r15     \n\t" /* LOGOUT */
+                : "=&r" (tmp),
+                  "+r"  (v)
+                : "r"   (mask)
+                : "memory" , "r0", "r1");
+}
+static inline int atomic_cmpxchg(atomic_t *v, int old, int new)
+{
+        int ret;
+        __asm__ __volatile__ (
+                "   .align 2            \n\t"
+                "   mova     1f,  r0    \n\t"
+                "   nop                 \n\t"
+                "   mov     r15,  r1    \n\t"
+                "   mov    #-8,  r15    \n\t"
+                "   mov.l   @%1,  %0    \n\t"
+                "   cmp/eq   %2,  %0    \n\t"
+                "   bf       1f         \n\t"
+                "   mov.l    %3, @%1    \n\t"
+                "1: mov      r1,  r15   \n\t"
+                : "=&r" (ret)
+                : "r" (v), "r" (old), "r" (new)
+                : "memory" , "r0", "r1" , "t");
+        return ret;
+}
+static inline int atomic_add_unless(atomic_t *v, int a, int u)
+{
+        int ret;
+        unsigned long tmp;
+        __asm__ __volatile__ (
+                "   .align 2            \n\t"
+                "   mova    1f,   r0    \n\t"
+                "   nop                 \n\t"
+                "   mov    r15,   r1    \n\t"
+                "   mov    #-12,  r15   \n\t"
+                "   mov.l  @%2,   %1    \n\t"
+                "   mov     %1,   %0    \n\t"
+                "   cmp/eq  %4,   %0    \n\t"
+                "   bt/s    1f          \n\t"
+                "    add    %3,   %1    \n\t"
+                "   mov.l   %1,  @%2    \n\t"
+                "1: mov     r1,   r15   \n\t"
+                : "=&r" (ret), "=&r" (tmp)
+                : "r" (v), "r" (a), "r" (u)
+                : "memory" , "r0", "r1" , "t");
+        return ret != u;
+}
+#endif /* __ASM_SH_ATOMIC_GRB_H */

diff --git a/include/asm-sh/atomic-grb.h b/include/asm-sh/atomic-grb.h new file mode 100644 index 00000000000..4c5b7dbfced --- /dev/null +++ b/include/asm-sh/atomic-grb.h
@@ -0,0 +1,169 @@
	1	#ifndef __ASM_SH_ATOMIC_GRB_H
	2	#define __ASM_SH_ATOMIC_GRB_H
	3
	4	static inline void atomic_add(int i, atomic_t *v)
	5	{
	6	int tmp;
	7
	8	__asm__ __volatile__ (
	9	" .align 2 \n\t"
	10	" mova 1f, r0 \n\t" /* r0 = end point */
	11	" mov r15, r1 \n\t" /* r1 = saved sp */
	12	" mov #-6, r15 \n\t" /* LOGIN: r15 = size */
	13	" mov.l @%1, %0 \n\t" /* load old value */
	14	" add %2, %0 \n\t" /* add */
	15	" mov.l %0, @%1 \n\t" /* store new value */
	16	"1: mov r1, r15 \n\t" /* LOGOUT */
	17	: "=&r" (tmp),
	18	"+r" (v)
	19	: "r" (i)
	20	: "memory" , "r0", "r1");
	21	}
	22
	23	static inline void atomic_sub(int i, atomic_t *v)
	24	{
	25	int tmp;
	26
	27	__asm__ __volatile__ (
	28	" .align 2 \n\t"
	29	" mova 1f, r0 \n\t" /* r0 = end point */
	30	" mov r15, r1 \n\t" /* r1 = saved sp */
	31	" mov #-6, r15 \n\t" /* LOGIN: r15 = size */
	32	" mov.l @%1, %0 \n\t" /* load old value */
	33	" sub %2, %0 \n\t" /* sub */
	34	" mov.l %0, @%1 \n\t" /* store new value */
	35	"1: mov r1, r15 \n\t" /* LOGOUT */
	36	: "=&r" (tmp),
	37	"+r" (v)
	38	: "r" (i)
	39	: "memory" , "r0", "r1");
	40	}
	41
	42	static inline int atomic_add_return(int i, atomic_t *v)
	43	{
	44	int tmp;
	45
	46	__asm__ __volatile__ (
	47	" .align 2 \n\t"
	48	" mova 1f, r0 \n\t" /* r0 = end point */
	49	" mov r15, r1 \n\t" /* r1 = saved sp */
	50	" mov #-6, r15 \n\t" /* LOGIN: r15 = size */
	51	" mov.l @%1, %0 \n\t" /* load old value */
	52	" add %2, %0 \n\t" /* add */
	53	" mov.l %0, @%1 \n\t" /* store new value */
	54	"1: mov r1, r15 \n\t" /* LOGOUT */
	55	: "=&r" (tmp),
	56	"+r" (v)
	57	: "r" (i)
	58	: "memory" , "r0", "r1");
	59
	60	return tmp;
	61	}
	62
	63	static inline int atomic_sub_return(int i, atomic_t *v)
	64	{
	65	int tmp;
	66
	67	__asm__ __volatile__ (
	68	" .align 2 \n\t"
	69	" mova 1f, r0 \n\t" /* r0 = end point */
	70	" mov r15, r1 \n\t" /* r1 = saved sp */
	71	" mov #-6, r15 \n\t" /* LOGIN: r15 = size */
	72	" mov.l @%1, %0 \n\t" /* load old value */
	73	" sub %2, %0 \n\t" /* sub */
	74	" mov.l %0, @%1 \n\t" /* store new value */
	75	"1: mov r1, r15 \n\t" /* LOGOUT */
	76	: "=&r" (tmp),
	77	"+r" (v)
	78	: "r" (i)
	79	: "memory", "r0", "r1");
	80
	81	return tmp;
	82	}
	83
	84	static inline void atomic_clear_mask(unsigned int mask, atomic_t *v)
	85	{
	86	int tmp;
	87	unsigned int _mask = ~mask;
	88
	89	__asm__ __volatile__ (
	90	" .align 2 \n\t"
	91	" mova 1f, r0 \n\t" /* r0 = end point */
	92	" mov r15, r1 \n\t" /* r1 = saved sp */
	93	" mov #-6, r15 \n\t" /* LOGIN: r15 = size */
	94	" mov.l @%1, %0 \n\t" /* load old value */
	95	" and %2, %0 \n\t" /* add */
	96	" mov.l %0, @%1 \n\t" /* store new value */
	97	"1: mov r1, r15 \n\t" /* LOGOUT */
	98	: "=&r" (tmp),
	99	"+r" (v)
	100	: "r" (_mask)
	101	: "memory" , "r0", "r1");
	102	}
	103
	104	static inline void atomic_set_mask(unsigned int mask, atomic_t *v)
	105	{
	106	int tmp;
	107
	108	__asm__ __volatile__ (
	109	" .align 2 \n\t"
	110	" mova 1f, r0 \n\t" /* r0 = end point */
	111	" mov r15, r1 \n\t" /* r1 = saved sp */
	112	" mov #-6, r15 \n\t" /* LOGIN: r15 = size */
	113	" mov.l @%1, %0 \n\t" /* load old value */
	114	" or %2, %0 \n\t" /* or */
	115	" mov.l %0, @%1 \n\t" /* store new value */
	116	"1: mov r1, r15 \n\t" /* LOGOUT */
	117	: "=&r" (tmp),
	118	"+r" (v)
	119	: "r" (mask)
	120	: "memory" , "r0", "r1");
	121	}
	122
	123	static inline int atomic_cmpxchg(atomic_t *v, int old, int new)
	124	{
	125	int ret;
	126
	127	__asm__ __volatile__ (
	128	" .align 2 \n\t"
	129	" mova 1f, r0 \n\t"
	130	" nop \n\t"
	131	" mov r15, r1 \n\t"
	132	" mov #-8, r15 \n\t"
	133	" mov.l @%1, %0 \n\t"
	134	" cmp/eq %2, %0 \n\t"
	135	" bf 1f \n\t"
	136	" mov.l %3, @%1 \n\t"
	137	"1: mov r1, r15 \n\t"
	138	: "=&r" (ret)
	139	: "r" (v), "r" (old), "r" (new)
	140	: "memory" , "r0", "r1" , "t");
	141
	142	return ret;
	143	}
	144
	145	static inline int atomic_add_unless(atomic_t *v, int a, int u)
	146	{
	147	int ret;
	148	unsigned long tmp;
	149
	150	__asm__ __volatile__ (
	151	" .align 2 \n\t"
	152	" mova 1f, r0 \n\t"
	153	" nop \n\t"
	154	" mov r15, r1 \n\t"
	155	" mov #-12, r15 \n\t"
	156	" mov.l @%2, %1 \n\t"
	157	" mov %1, %0 \n\t"
	158	" cmp/eq %4, %0 \n\t"
	159	" bt/s 1f \n\t"
	160	" add %3, %1 \n\t"
	161	" mov.l %1, @%2 \n\t"
	162	"1: mov r1, r15 \n\t"
	163	: "=&r" (ret), "=&r" (tmp)
	164	: "r" (v), "r" (a), "r" (u)
	165	: "memory" , "r0", "r1" , "t");
	166
	167	return ret != u;
	168	}
	169	#endif /* __ASM_SH_ATOMIC_GRB_H */