xref: /rk3399_rockchip-uboot/include/linux/bitops.h (revision ab32ffa1fdf23b968bbdfcb956ba9c9f5d5361bd)
1 #ifndef _LINUX_BITOPS_H
2 #define _LINUX_BITOPS_H
3 
4 #include <asm/types.h>
5 
6 /*
7  * ffs: find first bit set. This is defined the same way as
8  * the libc and compiler builtin ffs routines, therefore
9  * differs in spirit from the above ffz (man ffs).
10  */
11 
12 static inline int generic_ffs(int x)
13 {
14 	int r = 1;
15 
16 	if (!x)
17 		return 0;
18 	if (!(x & 0xffff)) {
19 		x >>= 16;
20 		r += 16;
21 	}
22 	if (!(x & 0xff)) {
23 		x >>= 8;
24 		r += 8;
25 	}
26 	if (!(x & 0xf)) {
27 		x >>= 4;
28 		r += 4;
29 	}
30 	if (!(x & 3)) {
31 		x >>= 2;
32 		r += 2;
33 	}
34 	if (!(x & 1)) {
35 		x >>= 1;
36 		r += 1;
37 	}
38 	return r;
39 }
40 
41 /*
42  * hweightN: returns the hamming weight (i.e. the number
43  * of bits set) of a N-bit word
44  */
45 
46 static inline unsigned int generic_hweight32(unsigned int w)
47 {
48 	unsigned int res = (w & 0x55555555) + ((w >> 1) & 0x55555555);
49 	res = (res & 0x33333333) + ((res >> 2) & 0x33333333);
50 	res = (res & 0x0F0F0F0F) + ((res >> 4) & 0x0F0F0F0F);
51 	res = (res & 0x00FF00FF) + ((res >> 8) & 0x00FF00FF);
52 	return (res & 0x0000FFFF) + ((res >> 16) & 0x0000FFFF);
53 }
54 
55 static inline unsigned int generic_hweight16(unsigned int w)
56 {
57 	unsigned int res = (w & 0x5555) + ((w >> 1) & 0x5555);
58 	res = (res & 0x3333) + ((res >> 2) & 0x3333);
59 	res = (res & 0x0F0F) + ((res >> 4) & 0x0F0F);
60 	return (res & 0x00FF) + ((res >> 8) & 0x00FF);
61 }
62 
63 static inline unsigned int generic_hweight8(unsigned int w)
64 {
65 	unsigned int res = (w & 0x55) + ((w >> 1) & 0x55);
66 	res = (res & 0x33) + ((res >> 2) & 0x33);
67 	return (res & 0x0F) + ((res >> 4) & 0x0F);
68 }
69 
70 #define BIT_MASK(nr)		(1UL << ((nr) % BITS_PER_LONG))
71 #define BIT_WORD(nr)		((nr) / BITS_PER_LONG)
72 
73 #include <asm/bitops.h>
74 
75 /* linux/include/asm-generic/bitops/non-atomic.h */
76 
77 #ifndef __set_bit
78 # define __set_bit generic_set_bit
79 #endif
80 
81 #ifndef __clear_bit
82 # define __clear_bit generic_clear_bit
83 #endif
84 
85 /**
86  * __set_bit - Set a bit in memory
87  * @nr: the bit to set
88  * @addr: the address to start counting from
89  *
90  * Unlike set_bit(), this function is non-atomic and may be reordered.
91  * If it's called on the same region of memory simultaneously, the effect
92  * may be that only one operation succeeds.
93  */
94 static inline void generic_set_bit(int nr, volatile unsigned long *addr)
95 {
96 	unsigned long mask = BIT_MASK(nr);
97 	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
98 
99 	*p  |= mask;
100 }
101 
102 static inline void generic_clear_bit(int nr, volatile unsigned long *addr)
103 {
104 	unsigned long mask = BIT_MASK(nr);
105 	unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
106 
107 	*p &= ~mask;
108 }
109 
110 #endif
111