Whamcloud - gitweb
b=14390
[fs/lustre-release.git] / lnet / libcfs / user-bitops.c
1 /* -*- mode: c; c-basic-offset: 8; indent-tabs-mode: nil; -*-
2  * vim:expandtab:shiftwidth=8:tabstop=8:
3  *
4  * Copyright (C) 2007 Cluster File Systems, Inc.
5  *
6  * This file is part of Lustre, http://www.lustre.org.
7  *
8  * Lustre is free software; you can redistribute it and/or modify it under the
9  * terms of version 2 of the GNU General Public License as published by the
10  * Free Software Foundation.
11  *
12  * Lustre is distributed in the hope that it will be useful, but WITHOUT ANY
13  * WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
14  * FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more
15  * details.
16  *
17  * You should have received a copy of the GNU General Public License along
18  * with Lustre; if not, write to the Free Software Foundation, Inc., 675 Mass
19  * Ave, Cambridge, MA 02139, USA.
20  *
21  */
22 #ifndef __KERNEL__
23
24 #include <libcfs/libcfs.h>
25 #include <libcfs/kp30.h>
26 #include <libcfs/user-bitops.h>
27
28 #define OFF_BY_START(start)     ((start)/BITS_PER_LONG)
29
30 unsigned long find_next_bit(unsigned long *addr,
31                             unsigned long size, unsigned long offset)
32 {
33         unsigned long *word, *last;
34         unsigned long first_bit, bit, base;
35
36         word = addr + OFF_BY_START(offset);
37         last = addr + OFF_BY_START(size-1);
38         first_bit = offset % BITS_PER_LONG;
39         base = offset - first_bit;
40
41         if (offset >= size)
42                 return size;
43         if (first_bit != 0) {
44                 int tmp = (*word++) & (~0UL << first_bit);
45                 bit = __ffs(tmp);
46                 if (bit < BITS_PER_LONG)
47                         goto found;
48                 word++;
49                 base += BITS_PER_LONG;
50         }
51         while (word <= last) {
52                 if (*word != 0UL) {
53                         bit = __ffs(*word);
54                         goto found;
55                 }
56                 word++;
57                 base += BITS_PER_LONG;
58         }
59         return size;
60 found:
61         return base + bit;
62 }
63
64 unsigned long find_next_zero_bit(unsigned long *addr,
65                                  unsigned long size, unsigned long offset)
66 {
67         unsigned long *word, *last;
68         unsigned long first_bit, bit, base;
69
70         word = addr + OFF_BY_START(offset);
71         last = addr + OFF_BY_START(size-1);
72         first_bit = offset % BITS_PER_LONG;
73         base = offset - first_bit;
74
75         if (offset >= size)
76                 return size;
77         if (first_bit != 0) {
78                 int tmp = (*word++) & (~0UL << first_bit);
79                 bit = __ffz(tmp);
80                 if (bit < BITS_PER_LONG)
81                         goto found;
82                 word++;
83                 base += BITS_PER_LONG;
84         }
85         while (word <= last) {
86                 if (*word != ~0UL) {
87                         bit = __ffz(*word);
88                         goto found;
89                 }
90                 word++;
91                 base += BITS_PER_LONG;
92         }
93         return size;
94 found:
95         return base + bit;
96 }
97
98 #endif