xref: /OK3568_Linux_fs/u-boot/arch/sh/include/asm/bitops.h (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun #ifndef __ASM_SH_BITOPS_H
2*4882a593Smuzhiyun #define __ASM_SH_BITOPS_H
3*4882a593Smuzhiyun 
4*4882a593Smuzhiyun #include <asm-generic/bitops/fls.h>
5*4882a593Smuzhiyun #include <asm-generic/bitops/__fls.h>
6*4882a593Smuzhiyun #include <asm-generic/bitops/fls64.h>
7*4882a593Smuzhiyun #include <asm-generic/bitops/__ffs.h>
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #ifdef __KERNEL__
10*4882a593Smuzhiyun #include <asm/irqflags.h>
11*4882a593Smuzhiyun /* For __swab32 */
12*4882a593Smuzhiyun #include <asm/byteorder.h>
13*4882a593Smuzhiyun 
set_bit(int nr,volatile void * addr)14*4882a593Smuzhiyun static inline void set_bit(int nr, volatile void * addr)
15*4882a593Smuzhiyun {
16*4882a593Smuzhiyun 	int	mask;
17*4882a593Smuzhiyun 	volatile unsigned int *a = addr;
18*4882a593Smuzhiyun 	unsigned long flags;
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun 	a += nr >> 5;
21*4882a593Smuzhiyun 	mask = 1 << (nr & 0x1f);
22*4882a593Smuzhiyun 	local_irq_save(flags);
23*4882a593Smuzhiyun 	*a |= mask;
24*4882a593Smuzhiyun 	local_irq_restore(flags);
25*4882a593Smuzhiyun }
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun /*
28*4882a593Smuzhiyun  * clear_bit() doesn't provide any barrier for the compiler.
29*4882a593Smuzhiyun  */
30*4882a593Smuzhiyun #define smp_mb__before_clear_bit()	barrier()
31*4882a593Smuzhiyun #define smp_mb__after_clear_bit()	barrier()
clear_bit(int nr,volatile void * addr)32*4882a593Smuzhiyun static inline void clear_bit(int nr, volatile void * addr)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun 	int	mask;
35*4882a593Smuzhiyun 	volatile unsigned int *a = addr;
36*4882a593Smuzhiyun 	unsigned long flags;
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun 	a += nr >> 5;
39*4882a593Smuzhiyun 	mask = 1 << (nr & 0x1f);
40*4882a593Smuzhiyun 	local_irq_save(flags);
41*4882a593Smuzhiyun 	*a &= ~mask;
42*4882a593Smuzhiyun 	local_irq_restore(flags);
43*4882a593Smuzhiyun }
44*4882a593Smuzhiyun 
change_bit(int nr,volatile void * addr)45*4882a593Smuzhiyun static inline void change_bit(int nr, volatile void * addr)
46*4882a593Smuzhiyun {
47*4882a593Smuzhiyun 	int	mask;
48*4882a593Smuzhiyun 	volatile unsigned int *a = addr;
49*4882a593Smuzhiyun 	unsigned long flags;
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun 	a += nr >> 5;
52*4882a593Smuzhiyun 	mask = 1 << (nr & 0x1f);
53*4882a593Smuzhiyun 	local_irq_save(flags);
54*4882a593Smuzhiyun 	*a ^= mask;
55*4882a593Smuzhiyun 	local_irq_restore(flags);
56*4882a593Smuzhiyun }
57*4882a593Smuzhiyun 
test_and_set_bit(int nr,volatile void * addr)58*4882a593Smuzhiyun static inline int test_and_set_bit(int nr, volatile void * addr)
59*4882a593Smuzhiyun {
60*4882a593Smuzhiyun 	int	mask, retval;
61*4882a593Smuzhiyun 	volatile unsigned int *a = addr;
62*4882a593Smuzhiyun 	unsigned long flags;
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun 	a += nr >> 5;
65*4882a593Smuzhiyun 	mask = 1 << (nr & 0x1f);
66*4882a593Smuzhiyun 	local_irq_save(flags);
67*4882a593Smuzhiyun 	retval = (mask & *a) != 0;
68*4882a593Smuzhiyun 	*a |= mask;
69*4882a593Smuzhiyun 	local_irq_restore(flags);
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun 	return retval;
72*4882a593Smuzhiyun }
73*4882a593Smuzhiyun 
test_and_clear_bit(int nr,volatile void * addr)74*4882a593Smuzhiyun static inline int test_and_clear_bit(int nr, volatile void * addr)
75*4882a593Smuzhiyun {
76*4882a593Smuzhiyun 	int	mask, retval;
77*4882a593Smuzhiyun 	volatile unsigned int *a = addr;
78*4882a593Smuzhiyun 	unsigned long flags;
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	a += nr >> 5;
81*4882a593Smuzhiyun 	mask = 1 << (nr & 0x1f);
82*4882a593Smuzhiyun 	local_irq_save(flags);
83*4882a593Smuzhiyun 	retval = (mask & *a) != 0;
84*4882a593Smuzhiyun 	*a &= ~mask;
85*4882a593Smuzhiyun 	local_irq_restore(flags);
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun 	return retval;
88*4882a593Smuzhiyun }
89*4882a593Smuzhiyun 
test_and_change_bit(int nr,volatile void * addr)90*4882a593Smuzhiyun static inline int test_and_change_bit(int nr, volatile void * addr)
91*4882a593Smuzhiyun {
92*4882a593Smuzhiyun 	int	mask, retval;
93*4882a593Smuzhiyun 	volatile unsigned int *a = addr;
94*4882a593Smuzhiyun 	unsigned long flags;
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun 	a += nr >> 5;
97*4882a593Smuzhiyun 	mask = 1 << (nr & 0x1f);
98*4882a593Smuzhiyun 	local_irq_save(flags);
99*4882a593Smuzhiyun 	retval = (mask & *a) != 0;
100*4882a593Smuzhiyun 	*a ^= mask;
101*4882a593Smuzhiyun 	local_irq_restore(flags);
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 	return retval;
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun 
ffz(unsigned long word)106*4882a593Smuzhiyun static inline unsigned long ffz(unsigned long word)
107*4882a593Smuzhiyun {
108*4882a593Smuzhiyun 	unsigned long result;
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	__asm__("1:\n\t"
111*4882a593Smuzhiyun 		"shlr	%1\n\t"
112*4882a593Smuzhiyun 		"bt/s	1b\n\t"
113*4882a593Smuzhiyun 		" add	#1, %0"
114*4882a593Smuzhiyun 		: "=r" (result), "=r" (word)
115*4882a593Smuzhiyun 		: "0" (~0L), "1" (word)
116*4882a593Smuzhiyun 		: "t");
117*4882a593Smuzhiyun 	return result;
118*4882a593Smuzhiyun }
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun /**
121*4882a593Smuzhiyun  * ffs - find first bit in word.
122*4882a593Smuzhiyun  * @word: The word to search
123*4882a593Smuzhiyun  *
124*4882a593Smuzhiyun  * Undefined if no bit exists, so code should check against 0 first.
125*4882a593Smuzhiyun  */
ffs(int x)126*4882a593Smuzhiyun static inline int ffs (int x)
127*4882a593Smuzhiyun {
128*4882a593Smuzhiyun 	int r = 1;
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun 	if (!x)
131*4882a593Smuzhiyun 		return 0;
132*4882a593Smuzhiyun 	if (!(x & 0xffff)) {
133*4882a593Smuzhiyun 		x >>= 16;
134*4882a593Smuzhiyun 		r += 16;
135*4882a593Smuzhiyun 	}
136*4882a593Smuzhiyun 	if (!(x & 0xff)) {
137*4882a593Smuzhiyun 		x >>= 8;
138*4882a593Smuzhiyun 		r += 8;
139*4882a593Smuzhiyun 	}
140*4882a593Smuzhiyun 	if (!(x & 0xf)) {
141*4882a593Smuzhiyun 		x >>= 4;
142*4882a593Smuzhiyun 		r += 4;
143*4882a593Smuzhiyun 	}
144*4882a593Smuzhiyun 	if (!(x & 3)) {
145*4882a593Smuzhiyun 		x >>= 2;
146*4882a593Smuzhiyun 		r += 2;
147*4882a593Smuzhiyun 	}
148*4882a593Smuzhiyun 	if (!(x & 1)) {
149*4882a593Smuzhiyun 		x >>= 1;
150*4882a593Smuzhiyun 		r += 1;
151*4882a593Smuzhiyun 	}
152*4882a593Smuzhiyun 	return r;
153*4882a593Smuzhiyun }
154*4882a593Smuzhiyun #define PLATFORM_FFS
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun #endif /* __KERNEL__ */
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun #endif /* __ASM_SH_BITOPS_H */
159