module Codec.Elias
(
encodeGamma
, decodeGamma
, encodeDelta
, decodeDelta
, encodeOmega
, decodeOmega
) where
import qualified Data.Bits as Bits
import Data.Bifunctor (Bifunctor(first))
import Codec.Arithmetic.Variety.BitVec (BitVec)
import qualified Codec.Arithmetic.Variety.BitVec as BV
boundsError :: a
boundsError :: forall a. a
boundsError = [Char] -> a
forall a. HasCallStack => [Char] -> a
error [Char]
"Elias: Number must be positive and non-zero"
encodeGamma :: Integer -> BitVec
encodeGamma :: Integer -> BitVec
encodeGamma Integer
x | Integer
x Integer -> Integer -> Bool
forall a. Ord a => a -> a -> Bool
> Integer
0 = Int -> Bool -> BitVec
BV.replicate Int
n Bool
False BitVec -> BitVec -> BitVec
forall a. Semigroup a => a -> a -> a
<> BitVec
xBits
| Bool
otherwise = BitVec
forall a. a
boundsError
where
xBits :: BitVec
xBits = Integer -> BitVec
BV.fromInteger Integer
x
n :: Int
n = BitVec -> Int
BV.length BitVec
xBits Int -> Int -> Int
forall a. Num a => a -> a -> a
- Int
1
decodeGamma :: BitVec -> Maybe (Integer, BitVec)
decodeGamma :: BitVec -> Maybe (Integer, BitVec)
decodeGamma BitVec
bv | BitVec -> Int
BV.length BitVec
xBits Int -> Int -> Bool
forall a. Eq a => a -> a -> Bool
/= Int
xLen = Maybe (Integer, BitVec)
forall a. Maybe a
Nothing
| Bool
otherwise = (Integer, BitVec) -> Maybe (Integer, BitVec)
forall a. a -> Maybe a
Just (Integer
x, BitVec
bv'')
where
n :: Int
n = BitVec -> Int
BV.countLeadingZeros BitVec
bv
xLen :: Int
xLen = Int
n Int -> Int -> Int
forall a. Num a => a -> a -> a
+ Int
1
bv' :: BitVec
bv' = Int -> Integer -> BitVec
BV.bitVec (BitVec -> Int
BV.length BitVec
bv Int -> Int -> Int
forall a. Num a => a -> a -> a
- Int
n) (Integer -> BitVec) -> Integer -> BitVec
forall a b. (a -> b) -> a -> b
$ BitVec -> Integer
BV.toInteger BitVec
bv
(BitVec
xBits, BitVec
bv'') = Int -> BitVec -> (BitVec, BitVec)
BV.splitAt Int
xLen BitVec
bv'
x :: Integer
x = BitVec -> Integer
BV.toInteger BitVec
xBits
encodeDelta :: Integer -> BitVec
encodeDelta :: Integer -> BitVec
encodeDelta Integer
x | Integer
x Integer -> Integer -> Bool
forall a. Ord a => a -> a -> Bool
> Integer
0 = Integer -> BitVec
encodeGamma (Int -> Integer
forall a b. (Integral a, Num b) => a -> b
fromIntegral Int
xLen) BitVec -> BitVec -> BitVec
forall a. Semigroup a => a -> a -> a
<> BitVec
tailBits
| Bool
otherwise = BitVec
forall a. a
boundsError
where
xBits :: BitVec
xBits = Integer -> BitVec
BV.fromInteger Integer
x
xLen :: Int
xLen = BitVec -> Int
BV.length BitVec
xBits
n :: Int
n = Int
xLen Int -> Int -> Int
forall a. Num a => a -> a -> a
- Int
1
tailBits :: BitVec
tailBits = Int -> Integer -> BitVec
BV.bitVec Int
n (Integer -> BitVec) -> Integer -> BitVec
forall a b. (a -> b) -> a -> b
$ Integer -> Int -> Integer
forall a. Bits a => a -> Int -> a
Bits.clearBit Integer
x Int
n
decodeDelta :: BitVec -> Maybe (Integer, BitVec)
decodeDelta :: BitVec -> Maybe (Integer, BitVec)
decodeDelta BitVec
bv = do
(Int
xLen, BitVec
bv') <- (Integer -> Int) -> (Integer, BitVec) -> (Int, BitVec)
forall a b c. (a -> b) -> (a, c) -> (b, c)
forall (p :: * -> * -> *) a b c.
Bifunctor p =>
(a -> b) -> p a c -> p b c
first Integer -> Int
forall a b. (Integral a, Num b) => a -> b
fromIntegral ((Integer, BitVec) -> (Int, BitVec))
-> Maybe (Integer, BitVec) -> Maybe (Int, BitVec)
forall (f :: * -> *) a b. Functor f => (a -> b) -> f a -> f b
<$> BitVec -> Maybe (Integer, BitVec)
decodeGamma BitVec
bv
let n :: Int
n = Int
xLen Int -> Int -> Int
forall a. Num a => a -> a -> a
- Int
1
(BitVec
xTail, BitVec
bv'') = Int -> BitVec -> (BitVec, BitVec)
BV.splitAt Int
n BitVec
bv'
xBits :: BitVec
xBits = Bool -> BitVec
BV.singleton Bool
True BitVec -> BitVec -> BitVec
forall a. Semigroup a => a -> a -> a
<> BitVec
xTail
if BitVec -> Int
BV.length BitVec
xBits Int -> Int -> Bool
forall a. Eq a => a -> a -> Bool
/= Int
xLen then Maybe (Integer, BitVec)
forall a. Maybe a
Nothing
else (Integer, BitVec) -> Maybe (Integer, BitVec)
forall a. a -> Maybe a
Just (BitVec -> Integer
BV.toInteger BitVec
xBits, BitVec
bv'')
encodeOmega :: Integer -> BitVec
encodeOmega :: Integer -> BitVec
encodeOmega Integer
x0 | Integer
x0 Integer -> Integer -> Bool
forall a. Ord a => a -> a -> Bool
> Integer
0 = Integer -> BitVec -> BitVec
go Integer
x0 BitVec
eom
| Bool
otherwise = BitVec
forall a. a
boundsError
where
eom :: BitVec
eom = Int -> Integer -> BitVec
BV.bitVec Int
1 Integer
0
go :: Integer -> BitVec -> BitVec
go Integer
1 = BitVec -> BitVec
forall a. a -> a
id
go Integer
n = Integer -> BitVec -> BitVec
go (Integer
lenInteger -> Integer -> Integer
forall a. Num a => a -> a -> a
-Integer
1) (BitVec -> BitVec) -> (BitVec -> BitVec) -> BitVec -> BitVec
forall b c a. (b -> c) -> (a -> b) -> a -> c
. (BitVec
bv BitVec -> BitVec -> BitVec
forall a. Semigroup a => a -> a -> a
<>)
where
bv :: BitVec
bv = Integer -> BitVec
BV.fromInteger Integer
n
len :: Integer
len = Int -> Integer
forall a b. (Integral a, Num b) => a -> b
fromIntegral (Int -> Integer) -> Int -> Integer
forall a b. (a -> b) -> a -> b
$ BitVec -> Int
BV.length BitVec
bv
decodeOmega :: BitVec -> Maybe (Integer, BitVec)
decodeOmega :: BitVec -> Maybe (Integer, BitVec)
decodeOmega = Integer -> BitVec -> Maybe (Integer, BitVec)
go Integer
1
where
go :: Integer -> BitVec -> Maybe (Integer, BitVec)
go Integer
n BitVec
bv = do
Bool
b <- BitVec
bv BitVec -> Int -> Maybe Bool
BV.!? Int
0
case Bool
b of
Bool
True | BitVec -> Int
BV.length BitVec
valBits Int -> Int -> Bool
forall a. Eq a => a -> a -> Bool
/= Int
len -> Maybe (Integer, BitVec)
forall a. Maybe a
Nothing
| Bool
otherwise -> Integer -> BitVec -> Maybe (Integer, BitVec)
go Integer
n' BitVec
bv'
where
len :: Int
len = Integer -> Int
forall a b. (Integral a, Num b) => a -> b
fromIntegral Integer
n Int -> Int -> Int
forall a. Num a => a -> a -> a
+ Int
1
(BitVec
valBits, BitVec
bv') = Int -> BitVec -> (BitVec, BitVec)
BV.splitAt Int
len BitVec
bv
n' :: Integer
n' = BitVec -> Integer
BV.toInteger BitVec
valBits
Bool
False -> (Integer, BitVec) -> Maybe (Integer, BitVec)
forall a. a -> Maybe a
Just (Integer
n, Int -> BitVec -> BitVec
BV.drop Int
1 BitVec
bv)