1 /* SPDX-License-Identifier: GPL-2.0 */
2 #ifndef _PERF_BITOPS_H
3 #define _PERF_BITOPS_H
4
5 #include <string.h>
6 #include <linux/bitops.h>
7 #include <stdlib.h>
8 #include <linux/kernel.h>
9
10 #define DECLARE_BITMAP(name,bits) \
11 unsigned long name[BITS_TO_LONGS(bits)]
12
13 int __bitmap_weight(const unsigned long *bitmap, int bits);
14 void __bitmap_or(unsigned long *dst, const unsigned long *bitmap1,
15 const unsigned long *bitmap2, int bits);
16 int __bitmap_and(unsigned long *dst, const unsigned long *bitmap1,
17 const unsigned long *bitmap2, unsigned int bits);
18 void bitmap_clear(unsigned long *map, unsigned int start, int len);
19
20 #define BITMAP_FIRST_WORD_MASK(start) (~0UL << ((start) & (BITS_PER_LONG - 1)))
21
22 #define BITMAP_LAST_WORD_MASK(nbits) \
23 ( \
24 ((nbits) % BITS_PER_LONG) ? \
25 (1UL<<((nbits) % BITS_PER_LONG))-1 : ~0UL \
26 )
27
28 #define small_const_nbits(nbits) \
29 (__builtin_constant_p(nbits) && (nbits) <= BITS_PER_LONG)
30
bitmap_zero(unsigned long * dst,int nbits)31 static inline void bitmap_zero(unsigned long *dst, int nbits)
32 {
33 if (small_const_nbits(nbits))
34 *dst = 0UL;
35 else {
36 int len = BITS_TO_LONGS(nbits) * sizeof(unsigned long);
37 memset(dst, 0, len);
38 }
39 }
40
bitmap_fill(unsigned long * dst,unsigned int nbits)41 static inline void bitmap_fill(unsigned long *dst, unsigned int nbits)
42 {
43 unsigned int nlongs = BITS_TO_LONGS(nbits);
44 if (!small_const_nbits(nbits)) {
45 unsigned int len = (nlongs - 1) * sizeof(unsigned long);
46 memset(dst, 0xff, len);
47 }
48 dst[nlongs - 1] = BITMAP_LAST_WORD_MASK(nbits);
49 }
50
bitmap_empty(const unsigned long * src,unsigned nbits)51 static inline int bitmap_empty(const unsigned long *src, unsigned nbits)
52 {
53 if (small_const_nbits(nbits))
54 return ! (*src & BITMAP_LAST_WORD_MASK(nbits));
55
56 return find_first_bit(src, nbits) == nbits;
57 }
58
bitmap_full(const unsigned long * src,unsigned int nbits)59 static inline int bitmap_full(const unsigned long *src, unsigned int nbits)
60 {
61 if (small_const_nbits(nbits))
62 return ! (~(*src) & BITMAP_LAST_WORD_MASK(nbits));
63
64 return find_first_zero_bit(src, nbits) == nbits;
65 }
66
bitmap_weight(const unsigned long * src,int nbits)67 static inline int bitmap_weight(const unsigned long *src, int nbits)
68 {
69 if (small_const_nbits(nbits))
70 return hweight_long(*src & BITMAP_LAST_WORD_MASK(nbits));
71 return __bitmap_weight(src, nbits);
72 }
73
bitmap_or(unsigned long * dst,const unsigned long * src1,const unsigned long * src2,int nbits)74 static inline void bitmap_or(unsigned long *dst, const unsigned long *src1,
75 const unsigned long *src2, int nbits)
76 {
77 if (small_const_nbits(nbits))
78 *dst = *src1 | *src2;
79 else
80 __bitmap_or(dst, src1, src2, nbits);
81 }
82
83 /**
84 * test_and_set_bit - Set a bit and return its old value
85 * @nr: Bit to set
86 * @addr: Address to count from
87 */
test_and_set_bit(int nr,unsigned long * addr)88 static inline int test_and_set_bit(int nr, unsigned long *addr)
89 {
90 unsigned long mask = BIT_MASK(nr);
91 unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
92 unsigned long old;
93
94 old = *p;
95 *p = old | mask;
96
97 return (old & mask) != 0;
98 }
99
100 /**
101 * test_and_clear_bit - Clear a bit and return its old value
102 * @nr: Bit to clear
103 * @addr: Address to count from
104 */
test_and_clear_bit(int nr,unsigned long * addr)105 static inline int test_and_clear_bit(int nr, unsigned long *addr)
106 {
107 unsigned long mask = BIT_MASK(nr);
108 unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
109 unsigned long old;
110
111 old = *p;
112 *p = old & ~mask;
113
114 return (old & mask) != 0;
115 }
116
117 /**
118 * bitmap_alloc - Allocate bitmap
119 * @nbits: Number of bits
120 */
bitmap_alloc(int nbits)121 static inline unsigned long *bitmap_alloc(int nbits)
122 {
123 return calloc(1, BITS_TO_LONGS(nbits) * sizeof(unsigned long));
124 }
125
126 /*
127 * bitmap_scnprintf - print bitmap list into buffer
128 * @bitmap: bitmap
129 * @nbits: size of bitmap
130 * @buf: buffer to store output
131 * @size: size of @buf
132 */
133 size_t bitmap_scnprintf(unsigned long *bitmap, int nbits,
134 char *buf, size_t size);
135
136 /**
137 * bitmap_and - Do logical and on bitmaps
138 * @dst: resulting bitmap
139 * @src1: operand 1
140 * @src2: operand 2
141 * @nbits: size of bitmap
142 */
bitmap_and(unsigned long * dst,const unsigned long * src1,const unsigned long * src2,unsigned int nbits)143 static inline int bitmap_and(unsigned long *dst, const unsigned long *src1,
144 const unsigned long *src2, unsigned int nbits)
145 {
146 if (small_const_nbits(nbits))
147 return (*dst = *src1 & *src2 & BITMAP_LAST_WORD_MASK(nbits)) != 0;
148 return __bitmap_and(dst, src1, src2, nbits);
149 }
150
151 #endif /* _PERF_BITOPS_H */
152