use std::mem::size_of;
use num_traits::PrimInt;
pub trait Fixed {
fn floor_log2(&self, n: usize) -> usize;
fn ceil_log2(&self, n: usize) -> usize;
fn align_power_of_two(&self, n: usize) -> usize;
fn align_power_of_two_and_shift(&self, n: usize) -> usize;
}
impl Fixed for usize {
#[inline]
fn floor_log2(&self, n: usize) -> usize {
self & !((1 << n) - 1)
}
#[inline]
fn ceil_log2(&self, n: usize) -> usize {
(self + (1 << n) - 1).floor_log2(n)
}
#[inline]
fn align_power_of_two(&self, n: usize) -> usize {
self.ceil_log2(n)
}
#[inline]
fn align_power_of_two_and_shift(&self, n: usize) -> usize {
(self + (1 << n) - 1) >> n
}
}
pub fn clamp<T: PartialOrd>(input: T, min: T, max: T) -> T {
if input < min {
min
} else if input > max {
max
} else {
input
}
}
pub trait ILog: PrimInt {
fn ilog(self) -> usize {
size_of::<Self>() * 8 - self.leading_zeros() as usize
}
}
impl<T> ILog for T where T: PrimInt
{
}
#[inline]
pub fn msb(x: i32) -> i32 {
debug_assert!(x > 0);
31 ^ (x.leading_zeros() as i32)
}
#[inline]
#[allow(dead_code)]
pub const fn round_shift(value: i32, bit: usize) -> i32 {
(value + (1 << bit >> 1)) >> bit
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn floor_log2() {
assert_eq!(123usize.floor_log2(4), 112);
assert_eq!(16usize.floor_log2(4), 16);
assert_eq!(0usize.floor_log2(4), 0);
}
#[test]
fn ceil_log2() {
assert_eq!(123usize.ceil_log2(4), 128);
assert_eq!(16usize.ceil_log2(4), 16);
assert_eq!(0usize.ceil_log2(4), 0);
}
#[test]
fn align_power_of_two() {
assert_eq!(123usize.align_power_of_two(4), 128);
assert_eq!(16usize.align_power_of_two(4), 16);
assert_eq!(0usize.align_power_of_two(4), 0);
}
#[test]
fn align_power_of_two_and_shift() {
assert_eq!(123usize.align_power_of_two_and_shift(4), 8);
assert_eq!(16usize.align_power_of_two_and_shift(4), 1);
assert_eq!(0usize.align_power_of_two_and_shift(4), 0);
}
#[test]
fn clamp() {
use super::clamp;
assert_eq!(clamp(5, 0, 10), 5);
assert_eq!(clamp(-1, 0, 10), 0);
assert_eq!(clamp(11, 0, 10), 10);
}
#[test]
fn ilog() {
assert_eq!(ILog::ilog(0i32), 0);
assert_eq!(ILog::ilog(1i32), 1);
assert_eq!(ILog::ilog(2i32), 2);
assert_eq!(ILog::ilog(3i32), 2);
assert_eq!(ILog::ilog(4i32), 3);
}
#[test]
fn msb() {
use super::msb;
assert_eq!(msb(1), 0);
assert_eq!(msb(2), 1);
assert_eq!(msb(3), 1);
assert_eq!(msb(4), 2);
}
#[test]
fn round_shift() {
use super::round_shift;
assert_eq!(round_shift(7, 2), 2);
assert_eq!(round_shift(8, 2), 2);
assert_eq!(round_shift(9, 2), 2);
assert_eq!(round_shift(10, 2), 3);
}
}