use crate::utils::clamp;
#[inline]
fn c(val: i32) -> i32 {
clamp(val, -128, 127)
}
#[inline]
fn u2s(val: u8) -> i32 {
i32::from(val) - 128
}
#[inline]
fn s2u(val: i32) -> u8 {
(c(val) + 128) as u8
}
#[inline]
fn diff(val1: u8, val2: u8) -> u8 {
if val1 > val2 {
val1 - val2
} else {
val2 - val1
}
}
fn common_adjust(use_outer_taps: bool, pixels: &mut [u8], point: usize, stride: usize) -> i32 {
let p1 = u2s(pixels[point - 2 * stride]);
let p0 = u2s(pixels[point - stride]);
let q0 = u2s(pixels[point]);
let q1 = u2s(pixels[point + stride]);
let outer = if use_outer_taps { c(p1 - q1) } else { 0 };
let mut a = c(outer + 3 * (q0 - p0));
let b = (c(a + 3)) >> 3;
a = (c(a + 4)) >> 3;
pixels[point] = s2u(q0 - a);
pixels[point - stride] = s2u(p0 + b);
a
}
fn simple_threshold(filter_limit: i32, pixels: &[u8], point: usize, stride: usize) -> bool {
i32::from(diff(pixels[point - stride], pixels[point])) * 2
+ i32::from(diff(pixels[point - 2 * stride], pixels[point + stride])) / 2
<= filter_limit
}
fn should_filter(
interior_limit: u8,
edge_limit: u8,
pixels: &[u8],
point: usize,
stride: usize,
) -> bool {
simple_threshold(i32::from(edge_limit), pixels, point, stride)
&& diff(pixels[point - 4 * stride], pixels[point - 3 * stride]) <= interior_limit
&& diff(pixels[point - 3 * stride], pixels[point - 2 * stride]) <= interior_limit
&& diff(pixels[point - 2 * stride], pixels[point - stride]) <= interior_limit
&& diff(pixels[point + 3 * stride], pixels[point + 2 * stride]) <= interior_limit
&& diff(pixels[point + 2 * stride], pixels[point + stride]) <= interior_limit
&& diff(pixels[point + stride], pixels[point]) <= interior_limit
}
fn high_edge_variance(threshold: u8, pixels: &[u8], point: usize, stride: usize) -> bool {
diff(pixels[point - 2 * stride], pixels[point - stride]) > threshold
|| diff(pixels[point + stride], pixels[point]) > threshold
}
pub(crate) fn simple_segment(edge_limit: u8, pixels: &mut [u8], point: usize, stride: usize) {
if simple_threshold(i32::from(edge_limit), pixels, point, stride) {
common_adjust(true, pixels, point, stride);
}
}
pub(crate) fn subblock_filter(
hev_threshold: u8,
interior_limit: u8,
edge_limit: u8,
pixels: &mut [u8],
point: usize,
stride: usize,
) {
if should_filter(interior_limit, edge_limit, pixels, point, stride) {
let hv = high_edge_variance(hev_threshold, pixels, point, stride);
let a = (common_adjust(hv, pixels, point, stride) + 1) >> 1;
if !hv {
pixels[point + stride] = s2u(u2s(pixels[point + stride]) - a);
pixels[point - 2 * stride] = s2u(u2s(pixels[point - 2 * stride]) - a);
}
}
}
pub(crate) fn macroblock_filter(
hev_threshold: u8,
interior_limit: u8,
edge_limit: u8,
pixels: &mut [u8],
point: usize,
stride: usize,
) {
let mut spixels = [0i32; 8];
for i in 0..8 {
spixels[i] = u2s(pixels[point + i * stride - 4 * stride]);
}
if should_filter(interior_limit, edge_limit, pixels, point, stride) {
if !high_edge_variance(hev_threshold, pixels, point, stride) {
let w = c(c(spixels[2] - spixels[5]) + 3 * (spixels[4] - spixels[3]));
let mut a = c((27 * w + 63) >> 7);
pixels[point] = s2u(spixels[4] - a);
pixels[point - stride] = s2u(spixels[3] + a);
a = c((18 * w + 63) >> 7);
pixels[point + stride] = s2u(spixels[5] - a);
pixels[point - 2 * stride] = s2u(spixels[2] + a);
a = c((9 * w + 63) >> 7);
pixels[point + 2 * stride] = s2u(spixels[6] - a);
pixels[point - 3 * stride] = s2u(spixels[1] + a);
} else {
common_adjust(true, pixels, point, stride);
}
}
}