162306a36Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */
262306a36Sopenharmony_ci#ifndef __ASM_SH_BITOPS_CAS_H
362306a36Sopenharmony_ci#define __ASM_SH_BITOPS_CAS_H
462306a36Sopenharmony_ci
562306a36Sopenharmony_cistatic inline unsigned __bo_cas(volatile unsigned *p, unsigned old, unsigned new)
662306a36Sopenharmony_ci{
762306a36Sopenharmony_ci	__asm__ __volatile__("cas.l %1,%0,@r0"
862306a36Sopenharmony_ci		: "+r"(new)
962306a36Sopenharmony_ci		: "r"(old), "z"(p)
1062306a36Sopenharmony_ci		: "t", "memory" );
1162306a36Sopenharmony_ci	return new;
1262306a36Sopenharmony_ci}
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_cistatic inline void set_bit(int nr, volatile void *addr)
1562306a36Sopenharmony_ci{
1662306a36Sopenharmony_ci	unsigned mask, old;
1762306a36Sopenharmony_ci	volatile unsigned *a = addr;
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci	a += nr >> 5;
2062306a36Sopenharmony_ci	mask = 1U << (nr & 0x1f);
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci	do old = *a;
2362306a36Sopenharmony_ci	while (__bo_cas(a, old, old|mask) != old);
2462306a36Sopenharmony_ci}
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_cistatic inline void clear_bit(int nr, volatile void *addr)
2762306a36Sopenharmony_ci{
2862306a36Sopenharmony_ci	unsigned mask, old;
2962306a36Sopenharmony_ci	volatile unsigned *a = addr;
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci	a += nr >> 5;
3262306a36Sopenharmony_ci	mask = 1U << (nr & 0x1f);
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci	do old = *a;
3562306a36Sopenharmony_ci	while (__bo_cas(a, old, old&~mask) != old);
3662306a36Sopenharmony_ci}
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_cistatic inline void change_bit(int nr, volatile void *addr)
3962306a36Sopenharmony_ci{
4062306a36Sopenharmony_ci	unsigned mask, old;
4162306a36Sopenharmony_ci	volatile unsigned *a = addr;
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_ci	a += nr >> 5;
4462306a36Sopenharmony_ci	mask = 1U << (nr & 0x1f);
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci	do old = *a;
4762306a36Sopenharmony_ci	while (__bo_cas(a, old, old^mask) != old);
4862306a36Sopenharmony_ci}
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cistatic inline int test_and_set_bit(int nr, volatile void *addr)
5162306a36Sopenharmony_ci{
5262306a36Sopenharmony_ci	unsigned mask, old;
5362306a36Sopenharmony_ci	volatile unsigned *a = addr;
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci	a += nr >> 5;
5662306a36Sopenharmony_ci	mask = 1U << (nr & 0x1f);
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_ci	do old = *a;
5962306a36Sopenharmony_ci	while (__bo_cas(a, old, old|mask) != old);
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_ci	return !!(old & mask);
6262306a36Sopenharmony_ci}
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_cistatic inline int test_and_clear_bit(int nr, volatile void *addr)
6562306a36Sopenharmony_ci{
6662306a36Sopenharmony_ci	unsigned mask, old;
6762306a36Sopenharmony_ci	volatile unsigned *a = addr;
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	a += nr >> 5;
7062306a36Sopenharmony_ci	mask = 1U << (nr & 0x1f);
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci	do old = *a;
7362306a36Sopenharmony_ci	while (__bo_cas(a, old, old&~mask) != old);
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_ci	return !!(old & mask);
7662306a36Sopenharmony_ci}
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_cistatic inline int test_and_change_bit(int nr, volatile void *addr)
7962306a36Sopenharmony_ci{
8062306a36Sopenharmony_ci	unsigned mask, old;
8162306a36Sopenharmony_ci	volatile unsigned *a = addr;
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci	a += nr >> 5;
8462306a36Sopenharmony_ci	mask = 1U << (nr & 0x1f);
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	do old = *a;
8762306a36Sopenharmony_ci	while (__bo_cas(a, old, old^mask) != old);
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	return !!(old & mask);
9062306a36Sopenharmony_ci}
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_ci#include <asm-generic/bitops/non-atomic.h>
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci#endif /* __ASM_SH_BITOPS_CAS_H */
95