1 files changed, 29 insertions, 10 deletions

diff --git a/tools/lib/find_bit.c b/tools/lib/find_bit.c
index 42c15f906aac..a88bd507091e 100644
--- a/tools/lib/find_bit.c
+++ b/tools/lib/find_bit.c
@@ -22,22 +22,29 @@
 #include <linux/bitmap.h>
 #include <linux/kernel.h>
 
-#if !defined(find_next_bit)
+#if !defined(find_next_bit) || !defined(find_next_zero_bit) || \
+                !defined(find_next_and_bit)
 
 /*
- * This is a common helper function for find_next_bit and
- * find_next_zero_bit.  The difference is the "invert" argument, which
- * is XORed with each fetched word before searching it for one bits.
+ * This is a common helper function for find_next_bit, find_next_zero_bit, and
+ * find_next_and_bit. The differences are:
+ *  - The "invert" argument, which is XORed with each fetched word before
+ *    searching it for one bits.
+ *  - The optional "addr2", which is anded with "addr1" if present.
  */
-static unsigned long _find_next_bit(const unsigned long *addr,
-                unsigned long nbits, unsigned long start, unsigned long invert)
+static inline unsigned long _find_next_bit(const unsigned long *addr1,
+                const unsigned long *addr2, unsigned long nbits,
+                unsigned long start, unsigned long invert)
 {
         unsigned long tmp;
 
         if (unlikely(start >= nbits))
                 return nbits;
 
-        tmp = addr[start / BITS_PER_LONG] ^ invert;
+        tmp = addr1[start / BITS_PER_LONG];
+        if (addr2)
+                tmp &= addr2[start / BITS_PER_LONG];
+        tmp ^= invert;
 
         /* Handle 1st word. */
         tmp &= BITMAP_FIRST_WORD_MASK(start);
@@ -48,7 +55,10 @@ static unsigned long _find_next_bit(const unsigned long *addr,
                 if (start >= nbits)
                         return nbits;
 
-                tmp = addr[start / BITS_PER_LONG] ^ invert;
+                tmp = addr1[start / BITS_PER_LONG];
+                if (addr2)
+                        tmp &= addr2[start / BITS_PER_LONG];
+                tmp ^= invert;
         }
 
         return min(start + __ffs(tmp), nbits);
@@ -62,7 +72,7 @@ static unsigned long _find_next_bit(const unsigned long *addr,
 unsigned long find_next_bit(const unsigned long *addr, unsigned long size,
                             unsigned long offset)
 {
-        return _find_next_bit(addr, size, offset, 0UL);
+        return _find_next_bit(addr, NULL, size, offset, 0UL);
 }
 #endif
 
@@ -104,6 +114,15 @@ unsigned long find_first_zero_bit(const unsigned long *addr, unsigned long size)
 unsigned long find_next_zero_bit(const unsigned long *addr, unsigned long size,
                                  unsigned long offset)
 {
-        return _find_next_bit(addr, size, offset, ~0UL);
+        return _find_next_bit(addr, NULL, size, offset, ~0UL);
+}
+#endif
+
+#ifndef find_next_and_bit
+unsigned long find_next_and_bit(const unsigned long *addr1,
+                const unsigned long *addr2, unsigned long size,
+                unsigned long offset)
+{
+        return _find_next_bit(addr1, addr2, size, offset, 0UL);
 }
 #endif