libcfs/libcfs/user-bitops.c

   1 /*
   2  * GPL HEADER START
   3  *
   4  * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 only,
   8  * as published by the Free Software Foundation.
   9  *
  10  * This program is distributed in the hope that it will be useful, but
  11  * WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13  * General Public License version 2 for more details (a copy is included
  14  * in the LICENSE file that accompanied this code).
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * version 2 along with this program; If not, see
  18  * http://www.sun.com/software/products/lustre/docs/GPLv2.pdf
  19  *
  20  * Please contact Sun Microsystems, Inc., 4150 Network Circle, Santa Clara,
  21  * CA 95054 USA or visit www.sun.com if you need additional information or
  22  * have any questions.
  23  *
  24  * GPL HEADER END
  25  */
  26 /*
  27  * Copyright (c) 2008, 2010, Oracle and/or its affiliates. All rights reserved.
  28  * Use is subject to license terms.
  29  */
  30 /*
  31  * This file is part of Lustre, http://www.lustre.org/
  32  * Lustre is a trademark of Sun Microsystems, Inc.
  33  */
  34 #ifndef __KERNEL__
  35
  36 #include <libcfs/libcfs.h>
  37 #include <libcfs/user-bitops.h>
  38
  39 #define OFF_BY_START(start)     ((start)/BITS_PER_LONG)
  40
  41 unsigned long find_next_bit(unsigned long *addr,
  42                                 unsigned long size, unsigned long offset)
  43 {
  44         unsigned long *word, *last;
  45         unsigned long first_bit, bit, base;
  46
  47         word = addr + OFF_BY_START(offset);
  48         last = addr + OFF_BY_START(size-1);
  49         first_bit = offset % BITS_PER_LONG;
  50         base = offset - first_bit;
  51
  52         if (offset >= size)
  53                 return size;
  54         if (first_bit != 0) {
  55                 int tmp = (*word++) & (~0UL << first_bit);
  56                 bit = __cfs_ffs(tmp);
  57                 if (bit < BITS_PER_LONG)
  58                         goto found;
  59                 word++;
  60                 base += BITS_PER_LONG;
  61         }
  62         while (word <= last) {
  63                 if (*word != 0UL) {
  64                         bit = __cfs_ffs(*word);
  65                         goto found;
  66                 }
  67                 word++;
  68                 base += BITS_PER_LONG;
  69         }
  70         return size;
  71 found:
  72         return base + bit;
  73 }
  74
  75 unsigned long find_next_zero_bit(unsigned long *addr,
  76                                      unsigned long size, unsigned long offset)
  77 {
  78         unsigned long *word, *last;
  79         unsigned long first_bit, bit, base;
  80
  81         word = addr + OFF_BY_START(offset);
  82         last = addr + OFF_BY_START(size-1);
  83         first_bit = offset % BITS_PER_LONG;
  84         base = offset - first_bit;
  85
  86         if (offset >= size)
  87                 return size;
  88         if (first_bit != 0) {
  89                 int tmp = (*word++) & (~0UL << first_bit);
  90                 bit = __cfs_ffz(tmp);
  91                 if (bit < BITS_PER_LONG)
  92                         goto found;
  93                 word++;
  94                 base += BITS_PER_LONG;
  95         }
  96         while (word <= last) {
  97                 if (*word != ~0UL) {
  98                         bit = __cfs_ffz(*word);
  99                         goto found;
 100                 }
 101                 word++;
 102                 base += BITS_PER_LONG;
 103         }
 104         return size;
 105 found:
 106         return base + bit;
 107 }
 108
 109 #endif