use crate::intmap::int_scale;
#[inline(always)]
pub const fn qadd8(i: u8, j: u8) -> u8 {
i.saturating_add(j)
}
#[inline(always)]
pub const fn qadd7(i: i8, j: i8) -> i8 {
i.saturating_add(j)
}
#[inline(always)]
pub const fn qsub8(i: u8, j: u8) -> u8 {
i.saturating_sub(j)
}
#[inline(always)]
pub const fn add8(i: u8, j: u8) -> u8 {
i.wrapping_add(j)
}
#[inline(always)]
pub const fn add8to16(i: u8, j: u16) -> u16 {
(i as u16).wrapping_add(j)
}
#[inline(always)]
pub const fn sub8(i: u8, j: u8) -> u8 {
i.wrapping_sub(j)
}
#[inline(always)]
pub const fn avg8(i: u8, j: u8) -> u8 {
((i as u16 + j as u16) >> 1) as u8
}
#[inline(always)]
pub const fn avg8r(i: u8, j: u8) -> u8 {
((i as u16 + j as u16 + 1) >> 1) as u8
}
#[inline(always)]
pub const fn avg16(i: u16, j: u16) -> u16 {
((i as u32 + j as u32) >> 1) as u16
}
#[inline(always)]
pub const fn avg16r(i: u16, j: u16) -> u16 {
((i as u32 + j as u32 + 1) >> 1) as u16
}
#[inline(always)]
pub const fn avg7(i: i8, j: i8) -> i8 {
(i >> 1) + (j >> 1) + (i & 0x1)
}
#[inline(always)]
pub const fn avg15(i: i16, j: i16) -> i16 {
(i >> 1) + (j >> 1) + (i & 0x1)
}
#[inline(always)]
pub const fn mul8(i: u8, j: u8) -> u8 {
((i as u16 * j as u16) & 0xFF) as u8
}
#[inline(always)]
pub const fn qmul8(i: u8, j: u8) -> u8 {
let p = i as u16 * j as u16;
if p > 255 { 255 } else { p as u8 }
}
#[inline(always)]
pub const fn abs8(i: i8) -> i8 {
i.wrapping_abs()
}
#[inline(always)]
pub const fn blend8_8bit(a: u8, b: u8, amount_of_b: u8) -> u8 {
let mut partial: u16 = (a as u16) << 8;
partial = partial.wrapping_add(b as u16 * amount_of_b as u16);
partial = partial.wrapping_sub(a as u16 * amount_of_b as u16);
partial = partial.wrapping_add(0x80);
(partial >> 8) as u8
}
#[inline(always)]
pub const fn blend8_16bit(a: u8, b: u8, amount_of_b: u8) -> u8 {
let delta = b as i16 - a as i16;
let mut partial: u32 = (a as u32) << 16;
partial = partial.wrapping_add((delta as i32 * amount_of_b as i32 * 257) as u32);
partial = partial.wrapping_add(0x8000);
(partial >> 16) as u8
}
#[inline(always)]
pub const fn blend8(a: u8, b: u8, amount_of_b: u8) -> u8 {
blend8_16bit(a, b, amount_of_b)
}
#[inline(always)]
pub const fn mod8(a: u8, m: u8) -> u8 {
a % m
}
#[inline(always)]
pub const fn addmod8(a: u8, b: u8, m: u8) -> u8 {
a.wrapping_add(b) % m
}
#[inline(always)]
pub const fn submod8(a: u8, b: u8, m: u8) -> u8 {
a.wrapping_sub(b) % m
}
pub const fn sqrt16(x: u16) -> u8 {
if x <= 1 {
return x as u8;
}
let mut low: u8 = 1;
let mut hi: u8 = if x > 7904 { 255 } else { ((x >> 5) + 8) as u8 };
loop {
let mid: u8 = ((low as u16 + hi as u16) >> 1) as u8;
if (mid as u16 * mid as u16) > x {
hi = mid - 1;
} else {
if mid == 255 {
return 255;
}
low = mid + 1;
}
if hi < low {
break;
}
}
low - 1
}
#[inline(always)]
pub fn sqrt8(x: u8) -> u8 {
sqrt16(int_scale::<u8, u16>(x))
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn saturating_add_sub() {
assert_eq!(qadd8(200, 100), 255);
assert_eq!(qadd8(10, 20), 30);
assert_eq!(qsub8(10, 20), 0);
assert_eq!(qsub8(30, 10), 20);
assert_eq!(qadd7(100, 100), 127);
assert_eq!(qadd7(-100, -100), -128);
}
#[test]
fn wrapping_add_sub() {
assert_eq!(add8(200, 100), 44);
assert_eq!(sub8(10, 20), 246);
assert_eq!(add8to16(200, 65500), 164); }
#[test]
fn averages() {
assert_eq!(avg8(10, 11), 10);
assert_eq!(avg8r(10, 11), 11);
assert_eq!(avg16(10, 11), 10);
assert_eq!(avg16r(10, 11), 11);
assert_eq!(avg7(4, 6), 5);
assert_eq!(avg15(4, 6), 5);
}
#[test]
fn multiplication() {
assert_eq!(mul8(100, 100), (10000u32 & 0xFF) as u8);
assert_eq!(qmul8(100, 100), 255);
assert_eq!(qmul8(2, 3), 6);
}
#[test]
fn absolute_value() {
assert_eq!(abs8(-5), 5);
assert_eq!(abs8(5), 5);
assert_eq!(abs8(i8::MIN), i8::MIN);
}
#[test]
fn blending() {
assert_eq!(blend8(100, 200, 0), 100);
assert_eq!(blend8(100, 200, 255), 200);
assert_eq!(blend8_8bit(0, 255, 128), 128);
assert_eq!(blend8_16bit(0, 255, 128), 128);
}
#[test]
fn modulo() {
assert_eq!(mod8(10, 7), 3);
assert_eq!(addmod8(5, 3, 7), 1);
assert_eq!(submod8(2, 5, 7), 1);
}
#[test]
#[should_panic]
fn mod8_by_zero_panics() {
let _ = mod8(10, 0);
}
#[test]
fn integer_sqrt() {
assert_eq!(sqrt16(0), 0);
assert_eq!(sqrt16(1), 1);
assert_eq!(sqrt16(16), 4);
assert_eq!(sqrt16(65535), 255);
assert_eq!(sqrt8(255), 255);
assert_eq!(sqrt8(0), 0);
}
}