use crate::filter1d::arena::Arena;
use crate::img_size::ImageSize;
use crate::mlaf::mlaf;
use crate::primitives::PrimitiveCast;
use crate::to_storage::ToStorage;
use num_traits::MulAdd;
use std::ops::{Add, Mul};
pub(crate) fn filter_column<T, F>(
arena: Arena,
arena_src: &[&[T]],
dst: &mut [T],
image_size: ImageSize,
scanned_kernel: &[F],
) where
T: Copy + PrimitiveCast<F>,
F: ToStorage<T> + Mul<F, Output = F> + MulAdd<F, Output = F> + Add<F, Output = F>,
{
unsafe {
let full_width = image_size.width * arena.components;
let length = scanned_kernel.len();
let mut cx = 0usize;
let coeff = *scanned_kernel.get_unchecked(0);
while cx + 4 <= full_width {
let v_src = arena_src.get_unchecked(0).get_unchecked(cx..);
let mut k0 = v_src.get_unchecked(0).cast_().mul(coeff);
let mut k1 = v_src.get_unchecked(1).cast_().mul(coeff);
let mut k2 = v_src.get_unchecked(2).cast_().mul(coeff);
let mut k3 = v_src.get_unchecked(3).cast_().mul(coeff);
for i in 1..length {
let coeff = *scanned_kernel.get_unchecked(i);
k0 = mlaf(
k0,
arena_src.get_unchecked(i).get_unchecked(cx).cast_(),
coeff,
);
k1 = mlaf(
k1,
arena_src.get_unchecked(i).get_unchecked(cx + 1).cast_(),
coeff,
);
k2 = mlaf(
k2,
arena_src.get_unchecked(i).get_unchecked(cx + 2).cast_(),
coeff,
);
k3 = mlaf(
k3,
arena_src.get_unchecked(i).get_unchecked(cx + 3).cast_(),
coeff,
);
}
*dst.get_unchecked_mut(cx) = k0.to_();
*dst.get_unchecked_mut(cx + 1) = k1.to_();
*dst.get_unchecked_mut(cx + 2) = k2.to_();
*dst.get_unchecked_mut(cx + 3) = k3.to_();
cx += 4;
}
for x in cx..full_width {
let v_src = arena_src.get_unchecked(0).get_unchecked(x..);
let mut k0 = v_src.get_unchecked(0).cast_().mul(coeff);
for i in 1..length {
let coeff = *scanned_kernel.get_unchecked(i);
k0 = mlaf(
k0,
arena_src.get_unchecked(i).get_unchecked(x).cast_(),
coeff,
);
}
*dst.get_unchecked_mut(x) = k0.to_();
}
}
}