bitvec-1.1.5.0: src/Data/Bit/Immutable.hs
{-# LANGUAGE CPP #-}
{-# LANGUAGE BangPatterns #-}
{-# LANGUAGE BinaryLiterals #-}
{-# LANGUAGE FlexibleContexts #-}
{-# LANGUAGE MagicHash #-}
{-# LANGUAGE RankNTypes #-}
{-# LANGUAGE FlexibleInstances #-}
{-# LANGUAGE TupleSections #-}
{-# LANGUAGE UndecidableInstances #-}
{-# OPTIONS_GHC -fno-warn-orphans #-}
#ifndef BITVEC_THREADSAFE
module Data.Bit.Immutable
#else
module Data.Bit.ImmutableTS
#endif
( castFromWords
, castToWords
, cloneToWords
, castFromWords8
, castToWords8
, cloneToWords8
, cloneFromByteString
, cloneToByteString
, zipBits
, mapBits
, invertBits
, selectBits
, excludeBits
, reverseBits
, bitIndex
, nthBitIndex
, countBits
, listBits
) where
#include "MachDeps.h"
import Control.Monad
import Control.Monad.ST
import Data.Bits
#if UseSIMD
import Data.Bit.SIMD
#endif
#ifndef BITVEC_THREADSAFE
import Data.Bit.Internal
import Data.Bit.Mutable
#else
import Data.Bit.InternalTS
import Data.Bit.MutableTS
#endif
import Data.Bit.PdepPext
import Data.Bit.Utils
import qualified Data.ByteString.Internal as BS
import Data.Primitive.ByteArray
import qualified Data.Vector.Primitive as P
import qualified Data.Vector.Storable as S
import qualified Data.Vector.Unboxed as U
import qualified Data.Vector.Unboxed.Base as UB
import qualified Data.Vector.Unboxed.Mutable as MU
import Data.Word
#ifdef WORDS_BIGENDIAN
import GHC.Exts
#endif
-- | Note: For '(.&.)', '(.|.)' and 'xor',
-- if one input is larger than the other, the remaining bits will be ignored.
-- 'bitSize' is undefined (throws an exception).
instance {-# OVERLAPPING #-} Bits (Vector Bit) where
(.&.) = zipBits (.&.)
(.|.) = zipBits (.|.)
xor = zipBits xor
complement = invertBits
bitSize _ = error "bitSize is undefined"
bitSizeMaybe _ = Nothing
isSigned _ = False
zeroBits = U.empty
popCount = countBits
testBit v n
| n < 0 || n >= U.length v = False
| otherwise = unBit (U.unsafeIndex v n)
setBit v n
| n < 0 || n >= U.length v = v
| otherwise = runST $ do
u <- U.thaw v
MU.unsafeWrite u n (Bit True)
U.unsafeFreeze u
clearBit v n
| n < 0 || n >= U.length v = v
| otherwise = runST $ do
u <- U.thaw v
MU.unsafeWrite u n (Bit False)
U.unsafeFreeze u
complementBit v n
| n < 0 || n >= U.length v = v
| otherwise = runST $ do
u <- U.thaw v
unsafeFlipBit u n
U.unsafeFreeze u
bit n
| n < 0 = U.empty
| otherwise = runST $ do
v <- MU.replicate (n + 1) (Bit False)
MU.unsafeWrite v n (Bit True)
U.unsafeFreeze v
shift v n = case n `compare` 0 of
-- shift right
LT
| U.length v + n < 0 -> U.empty
| otherwise -> runST $ do
u <- MU.new (U.length v + n)
U.copy u (U.drop (- n) v)
U.unsafeFreeze u
-- do not shift
EQ -> v
-- shift left
GT -> runST $ do
u <- MU.new (U.length v + n)
MU.set (MU.take n u) (Bit False)
U.copy (MU.drop n u) v
U.unsafeFreeze u
rotate v n'
| U.null v = v
| otherwise = runST $ do
let l = U.length v
n = n' `mod` l
u <- MU.new l
U.copy (MU.drop n u) (U.take (l - n) v)
U.copy (MU.take n u) (U.drop (l - n) v)
U.unsafeFreeze u
-- | Cast an unboxed vector of words
-- to an unboxed vector of bits.
-- Cf. 'Data.Bit.castFromWordsM'.
--
-- >>> :set -XOverloadedLists
-- >>> castFromWords [123]
-- [1,1,0,1,1,1,1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0]
--
-- @since 1.0.0.0
castFromWords :: U.Vector Word -> U.Vector Bit
castFromWords ws = BitVec (mulWordSize off) (mulWordSize len) arr
where
P.Vector off len arr = toPrimVector ws
-- | Try to cast an unboxed vector of bits
-- to an unboxed vector of words.
-- It succeeds if the vector of bits is aligned.
-- Use 'cloneToWords' otherwise.
-- Cf. 'Data.Bit.castToWordsM'.
--
-- > castToWords (castFromWords v) == Just v
--
-- @since 1.0.0.0
castToWords :: U.Vector Bit -> Maybe (U.Vector Word)
castToWords (BitVec s n ws)
| aligned s, aligned n =
Just $ fromPrimVector $ P.Vector (divWordSize s) (divWordSize n) ws
| otherwise = Nothing
-- | Clone an unboxed vector of bits
-- to a new unboxed vector of words.
-- If the bits don't completely fill the words,
-- the last word will be zero-padded.
-- Cf. 'Data.Bit.cloneToWordsM'.
--
-- >>> :set -XOverloadedLists
-- >>> cloneToWords [1,1,0,1,1,1,1]
-- [123]
--
-- @since 1.0.0.0
cloneToWords :: U.Vector Bit -> U.Vector Word
cloneToWords v = runST $ do
v' <- U.unsafeThaw v
w <- cloneToWordsM v'
U.unsafeFreeze w
{-# INLINABLE cloneToWords #-}
-- | Cast an unboxed vector of 'Word8'
-- to an unboxed vector of bits.
--
-- On big-endian architectures 'castFromWords8'
-- resorts to copying instead of aliasing the underlying array.
--
-- >>> :set -XOverloadedLists
-- >>> castFromWords8 [123]
-- [1,1,0,1,1,1,1,0]
--
-- @since 1.0.3.0
castFromWords8 :: U.Vector Word8 -> U.Vector Bit
castFromWords8 ws = BitVec (off `shiftL` 3) (len `shiftL` 3) arr
where
#ifdef WORDS_BIGENDIAN
UB.V_Word8 (P.Vector off' len arr') = ws
off = 0
arr = runST $ do
let lenWords = nWords $ len `shiftL` 3
len' = wordsToBytes lenWords
marr <- newByteArray len'
copyByteArray marr 0 arr' off' len
fillByteArray marr len (len' - len) 0
forM_ [0..lenWords - 1] $ \i -> do
W# w <- readByteArray marr i
writeByteArray marr i (W# (byteSwap# w))
unsafeFreezeByteArray marr
#else
UB.V_Word8 (P.Vector off len arr) = ws
#endif
-- | Try to cast an unboxed vector of bits
-- to an unboxed vector of 'Word8'.
-- It succeeds if the vector of bits is aligned.
-- Use 'Data.Bit.cloneToWords8' otherwise.
--
-- > castToWords8 (castFromWords8 v) == Just v
--
-- @since 1.0.3.0
castToWords8 :: U.Vector Bit -> Maybe (U.Vector Word8)
#ifdef WORDS_BIGENDIAN
castToWords8 = const Nothing
#else
castToWords8 (BitVec s n ws)
| s .&. 7 == 0, n .&. 7 == 0
= Just $ UB.V_Word8 $ P.Vector (s `shiftR` 3) (n `shiftR` 3) ws
| otherwise = Nothing
#endif
-- | Clone an unboxed vector of bits
-- to a new unboxed vector of 'Word8'.
-- If the bits don't completely fill the bytes,
-- the last 'Word8' will be zero-padded.
--
-- >>> :set -XOverloadedLists
-- >>> cloneToWords8 [1,1,0,1,1,1,1]
-- [123]
--
-- @since 1.0.3.0
cloneToWords8 :: U.Vector Bit -> U.Vector Word8
cloneToWords8 v = runST $ do
v' <- U.unsafeThaw v
w <- cloneToWords8M v'
U.unsafeFreeze w
{-# INLINABLE cloneToWords8 #-}
-- | Clone a 'BS.ByteString' to a new unboxed vector of bits.
--
-- >>> :set -XOverloadedStrings
-- >>> cloneFromByteString "abc"
-- [1,0,0,0,0,1,1,0,0,1,0,0,0,1,1,0,1,1,0,0,0,1,1,0]
--
-- @since 1.1.0.0
cloneFromByteString :: BS.ByteString -> U.Vector Bit
cloneFromByteString
= castFromWords8
. U.convert
. uncurry3 S.unsafeFromForeignPtr
. BS.toForeignPtr
-- | Clone an unboxed vector of bits to a new 'BS.ByteString'.
-- If the bits don't completely fill the bytes,
-- the last character will be zero-padded.
--
-- >>> :set -XOverloadedLists
-- >>> cloneToByteString [1,0,0,0,0,1,1,0,0,1,0,0,0,1,1,0,1,1,0,0,0,1]
-- "ab#"
--
-- @since 1.1.0.0
cloneToByteString :: U.Vector Bit -> BS.ByteString
cloneToByteString
= uncurry3 BS.fromForeignPtr
. S.unsafeToForeignPtr
. U.convert
. cloneToWords8
uncurry3 :: (a -> b -> c -> d) -> (a, b, c) -> d
uncurry3 f (x, y, z) = f x y z
-- | Zip two vectors with the given function.
-- Similar to 'Data.Vector.Unboxed.zipWith',
-- but up to 3500x (!) faster.
--
-- Note: If one input is larger than the other, the remaining bits will be ignored.
--
-- For sufficiently dense sets, represented as bitmaps,
-- 'zipBits' is up to 64x faster than
-- 'Data.IntSet.union', 'Data.IntSet.intersection', etc.
--
-- The function passed to zipBits may only use the following
-- 'Bits' methods:
--
-- '.&.', '.|.', 'xor', 'complement', 'zeroBits', and (likely uselessly)
-- 'bitSizeMaybe' and 'isSigned'.
--
-- >>> :set -XOverloadedLists
-- >>> import Data.Bits
-- >>> zipBits (.&.) [1,1,0] [0,1,1] -- intersection
-- [0,1,0]
-- >>> zipBits (.|.) [1,1,0] [0,1,1] -- union
-- [1,1,1]
-- >>> zipBits (\x y -> x .&. complement y) [1,1,0] [0,1,1] -- difference
-- [1,0,0]
-- >>> zipBits xor [1,1,0] [0,1,1] -- symmetric difference
-- [1,0,1]
--
-- @since 1.0.0.0
zipBits
:: (forall a . Bits a => a -> a -> a)
-> U.Vector Bit
-> U.Vector Bit
-> U.Vector Bit
zipBits f = \xs ys -> case (xs, ys) of
(BitVec _ 0 _, !_) -> U.empty
(_, BitVec _ 0 _) -> U.empty
#if UseSIMD
(BitVec 0 l1 arg1, BitVec 0 l2 arg2) -> runST $ do
let
l = noinlineMin l1 l2
w = nWords l
b = wordsToBytes w
brr <- newByteArray b
-- We used to calculate (f False False, f False True, f True False, f True True).
-- Now we calculate all those in one go by passing all four possibilities within
-- a word.
case 0b1111 .&. (unBitsy $ f (Bitsy 0b0011) (Bitsy 0b0101)) of
0b0000 -> setByteArray brr 0 w (zeroBits :: Word)
0b0001 -> ompAnd brr arg1 arg2 b
0b0010 -> ompAndn brr arg1 arg2 b
0b0011 -> copyByteArray brr 0 arg1 0 b
0b0100 -> ompAndn brr arg2 arg1 b
0b0101 -> copyByteArray brr 0 arg2 0 b
0b0110 -> ompXor brr arg1 arg2 b
0b0111 -> ompIor brr arg1 arg2 b
0b1000 -> ompNior brr arg1 arg2 b
0b1001 -> ompXnor brr arg1 arg2 b
0b1010 -> ompCom brr arg2 b
0b1011 -> ompIorn brr arg1 arg2 b
0b1100 -> ompCom brr arg1 b
0b1101 -> ompIorn brr arg2 arg1 b
0b1110 -> ompNand brr arg1 arg2 b
_0b1111 -> setByteArray brr 0 w (complement zeroBits :: Word)
BitVec 0 l <$> unsafeFreezeByteArray brr
#endif
_ -> runST $ do
let n = noinlineMin (U.length xs) (U.length ys)
zs <- MU.new n
forM_ [0, wordSize .. n - 1] $ \i ->
writeWord zs i . unBitsy $ f (Bitsy $ indexWord xs i) (Bitsy $ indexWord ys i)
U.unsafeFreeze zs
{-# INLINE zipBits #-}
-- | This is hideous, but it keeps the code size down in applications of
-- 'zipBits'. Otherwise we end up taking different code paths depending
-- on how the comparison goes in the min calculation, and the Core gets
-- seriously ugly. Ugh!
noinlineMin :: Int -> Int -> Int
noinlineMin = min
{-# NOINLINE noinlineMin #-}
-- | A version of 'Word' that only supports operations that make sense in
-- zipBits. This ensures that if someone does something overly silly in the function
-- they pass to zipBits, then they'll get a helpful (albeit run-time) error rather than just
-- weird garbage results.
newtype Bitsy = Bitsy {unBitsy :: Word}
instance Eq Bitsy where
_ == _ = notBitsy "=="
instance Bits Bitsy where
Bitsy x .&. Bitsy y = Bitsy (x .&. y)
Bitsy x .|. Bitsy y = Bitsy (x .|. y)
Bitsy x `xor` Bitsy y = Bitsy (x `xor` y)
complement (Bitsy x) = Bitsy (complement x)
zeroBits = Bitsy zeroBits
bitSizeMaybe _ = Nothing
isSigned _ = False -- Not useful, but not harmful
{-# INLINE (.&.) #-}
{-# INLINE (.|.) #-}
{-# INLINE xor #-}
{-# INLINE complement #-}
{-# INLINE zeroBits #-}
shiftL _ _ = notBitsy "shiftL"
shiftR _ _ = notBitsy "shiftR"
shift _ _ = notBitsy "shift"
unsafeShiftL _ _ = notBitsy "unsafeShiftL"
unsafeShiftR _ _ = notBitsy "unsafeShiftR"
rotateL _ _ = notBitsy "rotateL"
rotateR _ _ = notBitsy "rotateR"
rotate _ _ = notBitsy "rotate"
bitSize _ = notBitsy "bitSize"
testBit _ _ = notBitsy "testBit"
bit _ = notBitsy "bit"
setBit _ _ = notBitsy "setBit"
clearBit _ _ = notBitsy "clearBit"
complementBit _ _ = notBitsy "complementBit"
popCount _ = notBitsy "popCount"
{-# NOINLINE notBitsy #-}
notBitsy :: String -> a
notBitsy fun = error $
"The function passed to zipBits may only use\n" ++
".&., .|., xor, complement, zeroBits, bitSizeMaybe, and isSigned.\n" ++
"You used " ++ fun
-- | Map a vectors with the given function.
-- Similar to 'Data.Vector.Unboxed.map',
-- but faster.
--
-- >>> :set -XOverloadedLists
-- >>> import Data.Bits
-- >>> mapBits complement [0,1,1]
-- [1,0,0]
--
-- @since 1.1.0.0
mapBits
:: (forall a . Bits a => a -> a)
-> U.Vector Bit
-> U.Vector Bit
mapBits f = case (unBit (f (Bit False)), unBit (f (Bit True))) of
(False, False) -> (`U.replicate` Bit False) . U.length
(False, True) -> id
(True, False) -> invertBits
(True, True) -> (`U.replicate` Bit True) . U.length
{-# INLINE mapBits #-}
-- | Invert (flip) all bits.
--
-- >>> :set -XOverloadedLists
-- >>> invertBits [0,1,0,1,0]
-- [1,0,1,0,1]
--
-- @since 1.0.1.0
invertBits
:: U.Vector Bit
-> U.Vector Bit
invertBits (BitVec _ 0 _) = U.empty
#if UseSIMD
invertBits (BitVec 0 l arg) = runST $ do
let w = nWords l
b = wordsToBytes w
brr <- newByteArray b
ompCom brr arg b
BitVec 0 l <$> unsafeFreezeByteArray brr
#endif
invertBits xs = runST $ do
let n = U.length xs
ys <- MU.new n
forM_ [0, wordSize .. n - 1] $ \i ->
writeWord ys i (complement (indexWord xs i))
U.unsafeFreeze ys
-- | For each set bit of the first argument, extract
-- the corresponding bit of the second argument
-- to the result. Similar to the
-- [parallel bit extract instruction (PEXT)](https://en.wikipedia.org/wiki/X86_Bit_manipulation_instruction_set#Parallel_bit_deposit_and_extract).
--
-- Note: If one input is larger than the other, the remaining bits will be ignored.
--
-- >>> :set -XOverloadedLists
-- >>> selectBits [0,1,0,1,1] [1,1,0,0,1]
-- [1,0,1]
--
-- Here is a reference (but slow) implementation:
--
-- > import qualified Data.Vector.Unboxed as U
-- > selectBits mask ws = U.map snd (U.filter (unBit . fst) (U.zip mask ws))
--
-- @since 0.1
selectBits :: U.Vector Bit -> U.Vector Bit -> U.Vector Bit
#ifdef UseSIMD
selectBits (BitVec 0 iLen iArr) (BitVec 0 xLen xArr) | modWordSize len == 0 = runST $ do
marr <- newByteArray (len `shiftR` 3)
n <- selectBitsC marr xArr iArr (divWordSize len) False
BitVec 0 n <$> unsafeFreezeByteArray marr
where
len = min iLen xLen
#endif
selectBits is xs = runST $ do
xs1 <- U.thaw xs
n <- selectBitsInPlace is xs1
U.unsafeFreeze (MU.take n xs1)
-- | For each unset bit of the first argument, extract
-- the corresponding bit of the second argument
-- to the result.
--
-- Note: If one input is larger than the other, the remaining bits will be ignored.
--
-- >>> :set -XOverloadedLists
-- >>> excludeBits [0,1,0,1,1] [1,1,0,0,1]
-- [1,0]
--
-- Here is a reference (but slow) implementation:
--
-- > import qualified Data.Vector.Unboxed as U
-- > excludeBits mask ws = U.map snd (U.filter (not . unBit . fst) (U.zip mask ws))
--
-- @since 0.1
excludeBits :: U.Vector Bit -> U.Vector Bit -> U.Vector Bit
#ifdef UseSIMD
excludeBits (BitVec 0 iLen iArr) (BitVec 0 xLen xArr) | modWordSize len == 0 = runST $ do
marr <- newByteArray (len `shiftR` 3)
n <- selectBitsC marr xArr iArr (divWordSize len) True
BitVec 0 n <$> unsafeFreezeByteArray marr
where
len = min iLen xLen
#endif
excludeBits is xs = runST $ do
xs1 <- U.thaw xs
n <- excludeBitsInPlace is xs1
U.unsafeFreeze (MU.take n xs1)
-- | Reverse the order of bits.
--
-- >>> :set -XOverloadedLists
-- >>> reverseBits [1,1,0,1,0]
-- [0,1,0,1,1]
--
-- Consider using the [vector-rotcev](https://hackage.haskell.org/package/vector-rotcev) package
-- to reverse vectors in O(1) time.
--
-- @since 1.0.1.0
reverseBits :: U.Vector Bit -> U.Vector Bit
#ifdef UseSIMD
reverseBits (BitVec 0 len arr) | modWordSize len == 0 = runST $ do
marr <- newByteArray (len `shiftR` 3)
reverseBitsC marr arr (divWordSize len)
BitVec 0 len <$> unsafeFreezeByteArray marr
#endif
reverseBits xs = runST $ do
let n = U.length xs
ys <- MU.new n
forM_ [0, wordSize .. n - wordSize] $ \i ->
writeWord ys (n - i - wordSize) (reverseWord (indexWord xs i))
let nMod = modWordSize n
when (nMod /= 0) $ do
let x = indexWord xs (mulWordSize (divWordSize n))
y <- readWord ys 0
writeWord ys 0 (meld nMod (reversePartialWord nMod x) y)
U.unsafeFreeze ys
clipLoBits :: Bit -> Int -> Word -> Word
clipLoBits (Bit True ) k w = w `unsafeShiftR` k
clipLoBits (Bit False) k w = (w `unsafeShiftR` k) .|. hiMask (wordSize - k)
clipHiBits :: Bit -> Int -> Word -> Word
clipHiBits (Bit True ) k w = w .&. loMask k
clipHiBits (Bit False) k w = w .|. hiMask k
-- | Return the index of the first bit in the vector
-- with the specified value, if any.
-- Similar to 'Data.Vector.Unboxed.elemIndex', but up to 64x faster.
--
-- >>> :set -XOverloadedLists
-- >>> bitIndex 1 [0,0,1,0,1]
-- Just 2
-- >>> bitIndex 1 [0,0,0,0,0]
-- Nothing
--
-- > bitIndex bit == nthBitIndex bit 1
--
-- One can also use it to reduce a vector with disjunction or conjunction:
--
-- > import Data.Maybe
-- > isAnyBitSet = isJust . bitIndex 1
-- > areAllBitsSet = isNothing . bitIndex 0
--
-- @since 1.0.0.0
bitIndex :: Bit -> U.Vector Bit -> Maybe Int
#if UseSIMD
bitIndex (Bit b) (BitVec 0 len arr) | modWordSize len == 0 =
let res = bitIndexC arr (divWordSize len) b
in if res < 0 then Nothing else Just res
#endif
bitIndex b (BitVec off len arr)
| len == 0 = Nothing
| offBits == 0 = case modWordSize len of
0 -> bitIndexInWords b offWords lWords arr
nMod -> case bitIndexInWords b offWords (lWords - 1) arr of
r@Just{} -> r
Nothing -> (+ mulWordSize (lWords - 1)) <$> bitIndexInWord
b
(clipHiBits b nMod (indexByteArray arr (offWords + lWords - 1)))
| otherwise = case modWordSize (off + len) of
0 ->
case
bitIndexInWord b (clipLoBits b offBits (indexByteArray arr offWords))
of
r@Just{} -> r
Nothing ->
(+ (wordSize - offBits))
<$> bitIndexInWords b (offWords + 1) (lWords - 1) arr
nMod -> case lWords of
1 -> bitIndexInWord
b
(clipHiBits b len (clipLoBits b offBits (indexByteArray arr offWords)))
_ ->
case
bitIndexInWord
b
(clipLoBits b offBits (indexByteArray arr offWords))
of
r@Just{} -> r
Nothing ->
(+ (wordSize - offBits))
<$> case bitIndexInWords b (offWords + 1) (lWords - 2) arr of
r@Just{} -> r
Nothing ->
(+ mulWordSize (lWords - 2)) <$> bitIndexInWord
b
(clipHiBits
b
nMod
(indexByteArray arr (offWords + lWords - 1))
)
where
offBits = modWordSize off
offWords = divWordSize off
lWords = nWords (offBits + len)
bitIndexInWord :: Bit -> Word -> Maybe Int
bitIndexInWord (Bit True ) = ffs
bitIndexInWord (Bit False) = ffs . complement
bitIndexInWords :: Bit -> Int -> Int -> ByteArray -> Maybe Int
bitIndexInWords (Bit True) !off !len !arr = go off
where
go !n
| n >= off + len = Nothing
| otherwise = case ffs (indexByteArray arr n) of
Nothing -> go (n + 1)
Just r -> Just $ mulWordSize (n - off) + r
bitIndexInWords (Bit False) !off !len !arr = go off
where
go !n
| n >= off + len = Nothing
| otherwise = case ffs (complement (indexByteArray arr n)) of
Nothing -> go (n + 1)
Just r -> Just $ mulWordSize (n - off) + r
-- | Return the index of the @n@-th bit in the vector
-- with the specified value, if any.
-- Here @n@ is 1-based and the index is 0-based.
-- Non-positive @n@ results in an error.
--
-- >>> :set -XOverloadedLists
-- >>> nthBitIndex 1 2 [0,1,0,1,1,1,0] -- 2nd occurence of 1
-- Just 3
-- >>> nthBitIndex 1 5 [0,1,0,1,1,1,0] -- 5th occurence of 1
-- Nothing
--
-- One can use 'nthBitIndex' to implement
-- to implement @select{0,1}@ queries
-- for <https://en.wikipedia.org/wiki/Succinct_data_structure succinct dictionaries>.
--
-- @since 1.0.0.0
nthBitIndex :: Bit -> Int -> U.Vector Bit -> Maybe Int
nthBitIndex _ k _ | k <= 0 = error "nthBitIndex: n must be positive"
#if UseSIMD
nthBitIndex (Bit b) n (BitVec 0 len arr) | modWordSize len == 0 =
let res = nthBitIndexC arr (divWordSize len) b n
in if res < 0 then Nothing else Just res
#endif
nthBitIndex b k (BitVec off len arr)
| len == 0 = Nothing
| offBits == 0 = either (const Nothing) Just $ case modWordSize len of
0 -> nthInWords b k offWords lWords arr
nMod -> case nthInWords b k offWords (lWords - 1) arr of
r@Right{} -> r
Left k' -> (+ mulWordSize (lWords - 1)) <$> nthInWord
b
k'
(clipHiBits b nMod (indexByteArray arr (offWords + lWords - 1)))
| otherwise = either (const Nothing) Just $ case modWordSize (off + len) of
0 ->
case nthInWord b k (clipLoBits b offBits (indexByteArray arr offWords)) of
r@Right{} -> r
Left k' ->
(+ (wordSize - offBits))
<$> nthInWords b k' (offWords + 1) (lWords - 1) arr
nMod -> case lWords of
1 -> nthInWord
b
k
(clipHiBits b len (clipLoBits b offBits (indexByteArray arr offWords)))
_ ->
case
nthInWord b k (clipLoBits b offBits (indexByteArray arr offWords))
of
r@Right{} -> r
Left k' ->
(+ (wordSize - offBits))
<$> case nthInWords b k' (offWords + 1) (lWords - 2) arr of
r@Right{} -> r
Left k'' -> (+ mulWordSize (lWords - 2)) <$> nthInWord
b
k''
(clipHiBits
b
nMod
(indexByteArray arr (offWords + lWords - 1))
)
where
offBits = modWordSize off
offWords = divWordSize off
lWords = nWords (offBits + len)
nthInWord :: Bit -> Int -> Word -> Either Int Int
nthInWord (Bit b) k v = if k > c then Left (k - c) else Right (unsafeNthTrueInWord k w)
where
w = if b then v else complement v
c = popCount w
nthInWords :: Bit -> Int -> Int -> Int -> ByteArray -> Either Int Int
nthInWords (Bit True) !k !off !len !arr = go off k
where
go !n !l
| n >= off + len = Left l
| otherwise = if l > c
then go (n + 1) (l - c)
else Right (mulWordSize (n - off) + unsafeNthTrueInWord l w)
where
w = indexByteArray arr n
c = popCount w
nthInWords (Bit False) !k !off !len !arr = go off k
where
go !n !l
| n >= off + len = Left l
| otherwise = if l > c
then go (n + 1) (l - c)
else Right (mulWordSize (n - off) + unsafeNthTrueInWord l w)
where
w = complement (indexByteArray arr n)
c = popCount w
unsafeNthTrueInWord :: Int -> Word -> Int
unsafeNthTrueInWord l w = countTrailingZeros (pdep (1 `shiftL` (l - 1)) w)
-- | Return the number of set bits in a vector (population count, popcount).
--
-- >>> :set -XOverloadedLists
-- >>> countBits [1,1,0,1,0,1]
-- 4
--
-- One can combine 'countBits' with 'Data.Vector.Unboxed.take'
-- to implement @rank{0,1}@ queries
-- for <https://en.wikipedia.org/wiki/Succinct_data_structure succinct dictionaries>.
--
-- @since 0.1
countBits :: U.Vector Bit -> Int
countBits (BitVec _ 0 _) = 0
#if UseSIMD
countBits (BitVec 0 len arr) | modWordSize len == 0 =
ompPopcount arr (len `shiftR` 5)
#endif
countBits (BitVec off len arr) | offBits == 0 = case modWordSize len of
0 -> countBitsInWords (P.Vector offWords lWords arr)
nMod -> countBitsInWords (P.Vector offWords (lWords - 1) arr)
+ popCount (indexByteArray arr (offWords + lWords - 1) .&. loMask nMod)
where
offBits = modWordSize off
offWords = divWordSize off
lWords = nWords (offBits + len)
countBits (BitVec off len arr) = case modWordSize (off + len) of
0 -> popCount (indexByteArray arr offWords `unsafeShiftR` offBits :: Word)
+ countBitsInWords (P.Vector (offWords + 1) (lWords - 1) arr)
nMod -> case lWords of
1 -> popCount
((indexByteArray arr offWords `unsafeShiftR` offBits) .&. loMask len)
_ ->
popCount (indexByteArray arr offWords `unsafeShiftR` offBits :: Word)
+ countBitsInWords (P.Vector (offWords + 1) (lWords - 2) arr)
+ popCount (indexByteArray arr (offWords + lWords - 1) .&. loMask nMod)
where
offBits = modWordSize off
offWords = divWordSize off
lWords = nWords (offBits + len)
countBitsInWords :: P.Vector Word -> Int
countBitsInWords = P.foldl' (\acc word -> popCount word + acc) 0
-- | Return 0-based indices of set bits in a vector.
--
-- >>> :set -XOverloadedLists
-- >>> listBits [1,1,0,1,0,1]
-- [0,1,3,5]
--
-- @since 0.1
listBits :: U.Vector Bit -> [Int]
listBits (BitVec _ 0 _) = []
listBits (BitVec off len arr) | offBits == 0 = case modWordSize len of
0 -> listBitsInWords 0 (P.Vector offWords lWords arr) []
nMod ->
listBitsInWords 0 (P.Vector offWords (lWords - 1) arr)
$ map (+ mulWordSize (lWords - 1))
$ filter (testBit (indexByteArray arr (offWords + lWords - 1) :: Word))
[0 .. nMod - 1]
where
offBits = modWordSize off
offWords = divWordSize off
lWords = nWords (offBits + len)
listBits (BitVec off len arr) = case modWordSize (off + len) of
0 ->
filter
(testBit (indexByteArray arr offWords `unsafeShiftR` offBits :: Word))
[0 .. wordSize - offBits - 1]
++ listBitsInWords (wordSize - offBits)
(P.Vector (offWords + 1) (lWords - 1) arr)
[]
nMod -> case lWords of
1 -> filter
(testBit (indexByteArray arr offWords `unsafeShiftR` offBits :: Word))
[0 .. len - 1]
_ ->
filter
(testBit (indexByteArray arr offWords `unsafeShiftR` offBits :: Word))
[0 .. wordSize - offBits - 1]
++ ( listBitsInWords (wordSize - offBits)
(P.Vector (offWords + 1) (lWords - 2) arr)
$ map (+ (mulWordSize (lWords - 1) - offBits))
$ filter
(testBit (indexByteArray arr (offWords + lWords - 1) :: Word))
[0 .. nMod - 1]
)
where
offBits = modWordSize off
offWords = divWordSize off
lWords = nWords (offBits + len)
listBitsInWord :: Int -> Word -> [Int]
listBitsInWord offset word =
map (+ offset) $ filter (testBit word) $ [0 .. wordSize - 1]
listBitsInWords :: Int -> P.Vector Word -> [Int] -> [Int]
listBitsInWords offset = flip $ P.ifoldr
(\i word acc -> listBitsInWord (offset + mulWordSize i) word ++ acc)