18c2ecf20Sopenharmony_ci/*
28c2ecf20Sopenharmony_ci * Copyright (C) 2014 Stefan Kristiansson <stefan.kristiansson@saunalahti.fi>
38c2ecf20Sopenharmony_ci *
48c2ecf20Sopenharmony_ci * This file is licensed under the terms of the GNU General Public License
58c2ecf20Sopenharmony_ci * version 2.  This program is licensed "as is" without any warranty of any
68c2ecf20Sopenharmony_ci * kind, whether express or implied.
78c2ecf20Sopenharmony_ci */
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_ci#ifndef __ASM_OPENRISC_BITOPS_ATOMIC_H
108c2ecf20Sopenharmony_ci#define __ASM_OPENRISC_BITOPS_ATOMIC_H
118c2ecf20Sopenharmony_ci
128c2ecf20Sopenharmony_cistatic inline void set_bit(int nr, volatile unsigned long *addr)
138c2ecf20Sopenharmony_ci{
148c2ecf20Sopenharmony_ci	unsigned long mask = BIT_MASK(nr);
158c2ecf20Sopenharmony_ci	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
168c2ecf20Sopenharmony_ci	unsigned long tmp;
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci	__asm__ __volatile__(
198c2ecf20Sopenharmony_ci		"1:	l.lwa	%0,0(%1)	\n"
208c2ecf20Sopenharmony_ci		"	l.or	%0,%0,%2	\n"
218c2ecf20Sopenharmony_ci		"	l.swa	0(%1),%0	\n"
228c2ecf20Sopenharmony_ci		"	l.bnf	1b		\n"
238c2ecf20Sopenharmony_ci		"	 l.nop			\n"
248c2ecf20Sopenharmony_ci		: "=&r"(tmp)
258c2ecf20Sopenharmony_ci		: "r"(p), "r"(mask)
268c2ecf20Sopenharmony_ci		: "cc", "memory");
278c2ecf20Sopenharmony_ci}
288c2ecf20Sopenharmony_ci
298c2ecf20Sopenharmony_cistatic inline void clear_bit(int nr, volatile unsigned long *addr)
308c2ecf20Sopenharmony_ci{
318c2ecf20Sopenharmony_ci	unsigned long mask = BIT_MASK(nr);
328c2ecf20Sopenharmony_ci	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
338c2ecf20Sopenharmony_ci	unsigned long tmp;
348c2ecf20Sopenharmony_ci
358c2ecf20Sopenharmony_ci	__asm__ __volatile__(
368c2ecf20Sopenharmony_ci		"1:	l.lwa	%0,0(%1)	\n"
378c2ecf20Sopenharmony_ci		"	l.and	%0,%0,%2	\n"
388c2ecf20Sopenharmony_ci		"	l.swa	0(%1),%0	\n"
398c2ecf20Sopenharmony_ci		"	l.bnf	1b		\n"
408c2ecf20Sopenharmony_ci		"	 l.nop			\n"
418c2ecf20Sopenharmony_ci		: "=&r"(tmp)
428c2ecf20Sopenharmony_ci		: "r"(p), "r"(~mask)
438c2ecf20Sopenharmony_ci		: "cc", "memory");
448c2ecf20Sopenharmony_ci}
458c2ecf20Sopenharmony_ci
468c2ecf20Sopenharmony_cistatic inline void change_bit(int nr, volatile unsigned long *addr)
478c2ecf20Sopenharmony_ci{
488c2ecf20Sopenharmony_ci	unsigned long mask = BIT_MASK(nr);
498c2ecf20Sopenharmony_ci	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
508c2ecf20Sopenharmony_ci	unsigned long tmp;
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci	__asm__ __volatile__(
538c2ecf20Sopenharmony_ci		"1:	l.lwa	%0,0(%1)	\n"
548c2ecf20Sopenharmony_ci		"	l.xor	%0,%0,%2	\n"
558c2ecf20Sopenharmony_ci		"	l.swa	0(%1),%0	\n"
568c2ecf20Sopenharmony_ci		"	l.bnf	1b		\n"
578c2ecf20Sopenharmony_ci		"	 l.nop			\n"
588c2ecf20Sopenharmony_ci		: "=&r"(tmp)
598c2ecf20Sopenharmony_ci		: "r"(p), "r"(mask)
608c2ecf20Sopenharmony_ci		: "cc", "memory");
618c2ecf20Sopenharmony_ci}
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_cistatic inline int test_and_set_bit(int nr, volatile unsigned long *addr)
648c2ecf20Sopenharmony_ci{
658c2ecf20Sopenharmony_ci	unsigned long mask = BIT_MASK(nr);
668c2ecf20Sopenharmony_ci	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
678c2ecf20Sopenharmony_ci	unsigned long old;
688c2ecf20Sopenharmony_ci	unsigned long tmp;
698c2ecf20Sopenharmony_ci
708c2ecf20Sopenharmony_ci	__asm__ __volatile__(
718c2ecf20Sopenharmony_ci		"1:	l.lwa	%0,0(%2)	\n"
728c2ecf20Sopenharmony_ci		"	l.or	%1,%0,%3	\n"
738c2ecf20Sopenharmony_ci		"	l.swa	0(%2),%1	\n"
748c2ecf20Sopenharmony_ci		"	l.bnf	1b		\n"
758c2ecf20Sopenharmony_ci		"	 l.nop			\n"
768c2ecf20Sopenharmony_ci		: "=&r"(old), "=&r"(tmp)
778c2ecf20Sopenharmony_ci		: "r"(p), "r"(mask)
788c2ecf20Sopenharmony_ci		: "cc", "memory");
798c2ecf20Sopenharmony_ci
808c2ecf20Sopenharmony_ci	return (old & mask) != 0;
818c2ecf20Sopenharmony_ci}
828c2ecf20Sopenharmony_ci
838c2ecf20Sopenharmony_cistatic inline int test_and_clear_bit(int nr, volatile unsigned long *addr)
848c2ecf20Sopenharmony_ci{
858c2ecf20Sopenharmony_ci	unsigned long mask = BIT_MASK(nr);
868c2ecf20Sopenharmony_ci	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
878c2ecf20Sopenharmony_ci	unsigned long old;
888c2ecf20Sopenharmony_ci	unsigned long tmp;
898c2ecf20Sopenharmony_ci
908c2ecf20Sopenharmony_ci	__asm__ __volatile__(
918c2ecf20Sopenharmony_ci		"1:	l.lwa	%0,0(%2)	\n"
928c2ecf20Sopenharmony_ci		"	l.and	%1,%0,%3	\n"
938c2ecf20Sopenharmony_ci		"	l.swa	0(%2),%1	\n"
948c2ecf20Sopenharmony_ci		"	l.bnf	1b		\n"
958c2ecf20Sopenharmony_ci		"	 l.nop			\n"
968c2ecf20Sopenharmony_ci		: "=&r"(old), "=&r"(tmp)
978c2ecf20Sopenharmony_ci		: "r"(p), "r"(~mask)
988c2ecf20Sopenharmony_ci		: "cc", "memory");
998c2ecf20Sopenharmony_ci
1008c2ecf20Sopenharmony_ci	return (old & mask) != 0;
1018c2ecf20Sopenharmony_ci}
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_cistatic inline int test_and_change_bit(int nr, volatile unsigned long *addr)
1048c2ecf20Sopenharmony_ci{
1058c2ecf20Sopenharmony_ci	unsigned long mask = BIT_MASK(nr);
1068c2ecf20Sopenharmony_ci	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
1078c2ecf20Sopenharmony_ci	unsigned long old;
1088c2ecf20Sopenharmony_ci	unsigned long tmp;
1098c2ecf20Sopenharmony_ci
1108c2ecf20Sopenharmony_ci	__asm__ __volatile__(
1118c2ecf20Sopenharmony_ci		"1:	l.lwa	%0,0(%2)	\n"
1128c2ecf20Sopenharmony_ci		"	l.xor	%1,%0,%3	\n"
1138c2ecf20Sopenharmony_ci		"	l.swa	0(%2),%1	\n"
1148c2ecf20Sopenharmony_ci		"	l.bnf	1b		\n"
1158c2ecf20Sopenharmony_ci		"	 l.nop			\n"
1168c2ecf20Sopenharmony_ci		: "=&r"(old), "=&r"(tmp)
1178c2ecf20Sopenharmony_ci		: "r"(p), "r"(mask)
1188c2ecf20Sopenharmony_ci		: "cc", "memory");
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_ci	return (old & mask) != 0;
1218c2ecf20Sopenharmony_ci}
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci#endif /* __ASM_OPENRISC_BITOPS_ATOMIC_H */
124