git.sur5r.net Git - u-boot/blob - include/linux/bitops.h

   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  * fls - find last (most-significant) bit set
  43  * @x: the word to search
  44  *
  45  * This is defined the same way as ffs.
  46  * Note fls(0) = 0, fls(1) = 1, fls(0x80000000) = 32.
  47  */
  48 static inline int generic_fls(int x)
  49 {
  50         int r = 32;
  51
  52         if (!x)
  53                 return 0;
  54         if (!(x & 0xffff0000u)) {
  55                 x <<= 16;
  56                 r -= 16;
  57         }
  58         if (!(x & 0xff000000u)) {
  59                 x <<= 8;
  60                 r -= 8;
  61         }
  62         if (!(x & 0xf0000000u)) {
  63                 x <<= 4;
  64                 r -= 4;
  65         }
  66         if (!(x & 0xc0000000u)) {
  67                 x <<= 2;
  68                 r -= 2;
  69         }
  70         if (!(x & 0x80000000u)) {
  71                 x <<= 1;
  72                 r -= 1;
  73         }
  74         return r;
  75 }
  76
  77
  78 /*
  79  * hweightN: returns the hamming weight (i.e. the number
  80  * of bits set) of a N-bit word
  81  */
  82
  83 static inline unsigned int generic_hweight32(unsigned int w)
  84 {
  85         unsigned int res = (w & 0x55555555) + ((w >> 1) & 0x55555555);
  86         res = (res & 0x33333333) + ((res >> 2) & 0x33333333);
  87         res = (res & 0x0F0F0F0F) + ((res >> 4) & 0x0F0F0F0F);
  88         res = (res & 0x00FF00FF) + ((res >> 8) & 0x00FF00FF);
  89         return (res & 0x0000FFFF) + ((res >> 16) & 0x0000FFFF);
  90 }
  91
  92 static inline unsigned int generic_hweight16(unsigned int w)
  93 {
  94         unsigned int res = (w & 0x5555) + ((w >> 1) & 0x5555);
  95         res = (res & 0x3333) + ((res >> 2) & 0x3333);
  96         res = (res & 0x0F0F) + ((res >> 4) & 0x0F0F);
  97         return (res & 0x00FF) + ((res >> 8) & 0x00FF);
  98 }
  99
 100 static inline unsigned int generic_hweight8(unsigned int w)
 101 {
 102         unsigned int res = (w & 0x55) + ((w >> 1) & 0x55);
 103         res = (res & 0x33) + ((res >> 2) & 0x33);
 104         return (res & 0x0F) + ((res >> 4) & 0x0F);
 105 }
 106
 107 #define BIT_MASK(nr)            (1UL << ((nr) % BITS_PER_LONG))
 108 #define BIT_WORD(nr)            ((nr) / BITS_PER_LONG)
 109
 110 #include <asm/bitops.h>
 111
 112 /* linux/include/asm-generic/bitops/non-atomic.h */
 113
 114 #ifndef PLATFORM__SET_BIT
 115 # define __set_bit generic_set_bit
 116 #endif
 117
 118 #ifndef PLATFORM__CLEAR_BIT
 119 # define __clear_bit generic_clear_bit
 120 #endif
 121
 122 #ifndef PLATFORM_FFS
 123 # define ffs generic_ffs
 124 #endif
 125
 126 #ifndef PLATFORM_FLS
 127 # define fls generic_fls
 128 #endif
 129
 130 /**
 131  * __set_bit - Set a bit in memory
 132  * @nr: the bit to set
 133  * @addr: the address to start counting from
 134  *
 135  * Unlike set_bit(), this function is non-atomic and may be reordered.
 136  * If it's called on the same region of memory simultaneously, the effect
 137  * may be that only one operation succeeds.
 138  */
 139 static inline void generic_set_bit(int nr, volatile unsigned long *addr)
 140 {
 141         unsigned long mask = BIT_MASK(nr);
 142         unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
 143
 144         *p  |= mask;
 145 }
 146
 147 static inline void generic_clear_bit(int nr, volatile unsigned long *addr)
 148 {
 149         unsigned long mask = BIT_MASK(nr);
 150         unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
 151
 152         *p &= ~mask;
 153 }
 154
 155 #endif