use crate::neon::{load_u8_s32_fast, store_u8_s32};
use crate::stackblur::neon::NeonVectorI32x4;
use crate::stackblur::stack_blur_pass::StackBlurWorkingPass;
use crate::unsafe_slice::UnsafeSlice;
use crate::util::ScratchBuffer;
use std::arch::aarch64::*;
pub(crate) struct VerticalNeonStackBlurPass<const CN: usize> {}
impl<const CN: usize> Default for VerticalNeonStackBlurPass<CN> {
fn default() -> Self {
VerticalNeonStackBlurPass {}
}
}
impl<const CN: usize> StackBlurWorkingPass<u8, CN> for VerticalNeonStackBlurPass<CN> {
fn pass(
&self,
pixels: &UnsafeSlice<u8>,
stride: u32,
width: u32,
height: u32,
radius: u32,
thread: usize,
total_threads: usize,
) {
unsafe {
let div = ((radius * 2) + 1) as usize;
let mut yp;
let mut sp;
let mut stack_start;
let mut scratch_buffer = ScratchBuffer::<[NeonVectorI32x4; 4], 2048>::new(div);
let stacks = scratch_buffer.as_mut_slice();
let hm = height - 1;
let div = (radius * 2) + 1;
let mul_value = vdupq_n_f32(1. / ((radius as f32 + 1.) * (radius as f32 + 1.)));
let min_x = (thread * width as usize / total_threads) * CN;
let max_x = ((thread + 1) * width as usize / total_threads) * CN;
let mut cx = min_x;
while cx + 16 <= max_x {
let mut sums0 = vdupq_n_s32(0i32);
let mut sums1 = vdupq_n_s32(0i32);
let mut sums2 = vdupq_n_s32(0i32);
let mut sums3 = vdupq_n_s32(0i32);
let mut sum_in0 = vdupq_n_s32(0i32);
let mut sum_in1 = vdupq_n_s32(0i32);
let mut sum_in2 = vdupq_n_s32(0i32);
let mut sum_in3 = vdupq_n_s32(0i32);
let mut sum_out0 = vdupq_n_s32(0i32);
let mut sum_out1 = vdupq_n_s32(0i32);
let mut sum_out2 = vdupq_n_s32(0i32);
let mut sum_out3 = vdupq_n_s32(0i32);
let mut src_ptr = cx;
{
let src_pixel0 = vld1q_u8(pixels.get_ptr(src_ptr));
let lo0 = vmovl_u8(vget_low_u8(src_pixel0));
let hi0 = vmovl_high_u8(src_pixel0);
let i16_l0 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(lo0)));
let i16_h0 = vreinterpretq_s32_u32(vmovl_high_u16(lo0));
let i16_l1 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(hi0)));
let i16_h1 = vreinterpretq_s32_u32(vmovl_high_u16(hi0));
for i in 0..=radius {
let stack_ptr = stacks.get_unchecked_mut(i as usize);
vst1q_s32(stack_ptr.as_mut_ptr().cast(), i16_l0);
vst1q_s32(stack_ptr[1..].as_mut_ptr().cast(), i16_h0);
vst1q_s32(stack_ptr[2..].as_mut_ptr().cast(), i16_l1);
vst1q_s32(stack_ptr[3..].as_mut_ptr().cast(), i16_h1);
let w = i as i32 + 1;
sums0 = vmlaq_n_s32(sums0, i16_l0, w);
sums1 = vmlaq_n_s32(sums1, i16_h0, w);
sums2 = vmlaq_n_s32(sums2, i16_l1, w);
sums3 = vmlaq_n_s32(sums3, i16_h1, w);
sum_out0 = vaddq_s32(sum_out0, i16_l0);
sum_out1 = vaddq_s32(sum_out1, i16_h0);
sum_out2 = vaddq_s32(sum_out2, i16_l1);
sum_out3 = vaddq_s32(sum_out3, i16_h1);
}
}
{
for i in 1..=radius {
if i <= hm {
src_ptr += stride as usize;
}
let stack_ptr = stacks.get_unchecked_mut((i + radius) as usize);
let src_pixel0 = vld1q_u8(pixels.get_ptr(src_ptr));
let lo0 = vmovl_u8(vget_low_u8(src_pixel0));
let hi0 = vmovl_high_u8(src_pixel0);
let i16_l0 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(lo0)));
let i16_h0 = vreinterpretq_s32_u32(vmovl_high_u16(lo0));
let i16_l1 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(hi0)));
let i16_h1 = vreinterpretq_s32_u32(vmovl_high_u16(hi0));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), i16_l0);
vst1q_s32(stack_ptr[1..].as_mut_ptr().cast(), i16_h0);
vst1q_s32(stack_ptr[2..].as_mut_ptr().cast(), i16_l1);
vst1q_s32(stack_ptr[3..].as_mut_ptr().cast(), i16_h1);
let vj = radius as i32 + 1 - i as i32;
sums0 = vmlaq_n_s32(sums0, i16_l0, vj);
sums1 = vmlaq_n_s32(sums1, i16_h0, vj);
sums2 = vmlaq_n_s32(sums2, i16_l1, vj);
sums3 = vmlaq_n_s32(sums3, i16_h1, vj);
sum_in0 = vaddq_s32(sum_in0, i16_l0);
sum_in1 = vaddq_s32(sum_in1, i16_h0);
sum_in2 = vaddq_s32(sum_in2, i16_l1);
sum_in3 = vaddq_s32(sum_in3, i16_h1);
}
}
sp = radius;
yp = radius;
if yp > hm {
yp = hm;
}
src_ptr = cx + yp as usize * stride as usize;
let mut dst_ptr = cx;
for _ in 0..height {
let casted_sum0 = vcvtq_f32_s32(sums0);
let casted_sum1 = vcvtq_f32_s32(sums1);
let casted_sum2 = vcvtq_f32_s32(sums2);
let casted_sum3 = vcvtq_f32_s32(sums3);
let a0 = vmulq_f32(casted_sum0, mul_value);
let a1 = vmulq_f32(casted_sum1, mul_value);
let a2 = vmulq_f32(casted_sum2, mul_value);
let a3 = vmulq_f32(casted_sum3, mul_value);
let scaled_val0 = vcvtaq_s32_f32(a0);
let scaled_val1 = vcvtaq_s32_f32(a1);
let scaled_val2 = vcvtaq_s32_f32(a2);
let scaled_val3 = vcvtaq_s32_f32(a3);
let jv0 = vcombine_u16(vqmovun_s32(scaled_val0), vqmovun_s32(scaled_val1));
let jv1 = vcombine_u16(vqmovun_s32(scaled_val2), vqmovun_s32(scaled_val3));
let values = vcombine_u8(vqmovn_u16(jv0), vqmovn_u16(jv1));
vst1q_u8(pixels.get_ptr(dst_ptr), values);
dst_ptr += stride as usize;
sums0 = vsubq_s32(sums0, sum_out0);
sums1 = vsubq_s32(sums1, sum_out1);
sums2 = vsubq_s32(sums2, sum_out2);
sums3 = vsubq_s32(sums3, sum_out3);
stack_start = sp + div - radius;
if stack_start >= div {
stack_start -= div;
}
let stack_ptr = stacks.get_unchecked_mut(stack_start as usize);
let stack_val0 = vld1q_s32(stack_ptr.as_ptr().cast());
let stack_val1 = vld1q_s32(stack_ptr[1..].as_ptr().cast());
let stack_val2 = vld1q_s32(stack_ptr[2..].as_ptr().cast());
let stack_val3 = vld1q_s32(stack_ptr[3..].as_ptr().cast());
sum_out0 = vsubq_s32(sum_out0, stack_val0);
sum_out1 = vsubq_s32(sum_out1, stack_val1);
sum_out2 = vsubq_s32(sum_out2, stack_val2);
sum_out3 = vsubq_s32(sum_out3, stack_val3);
if yp < hm {
src_ptr += stride as usize; yp += 1;
}
let src_pixel0 = vld1q_u8(pixels.get_ptr(src_ptr));
let lo0 = vmovl_u8(vget_low_u8(src_pixel0));
let hi0 = vmovl_high_u8(src_pixel0);
let i16_l0 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(lo0)));
let i16_h0 = vreinterpretq_s32_u32(vmovl_high_u16(lo0));
let i16_l1 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(hi0)));
let i16_h1 = vreinterpretq_s32_u32(vmovl_high_u16(hi0));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), i16_l0);
vst1q_s32(stack_ptr[1..].as_mut_ptr().cast(), i16_h0);
vst1q_s32(stack_ptr[2..].as_mut_ptr().cast(), i16_l1);
vst1q_s32(stack_ptr[3..].as_mut_ptr().cast(), i16_h1);
sum_in0 = vaddq_s32(sum_in0, i16_l0);
sum_in1 = vaddq_s32(sum_in1, i16_h0);
sum_in2 = vaddq_s32(sum_in2, i16_l1);
sum_in3 = vaddq_s32(sum_in3, i16_h1);
sums0 = vaddq_s32(sums0, sum_in0);
sums1 = vaddq_s32(sums1, sum_in1);
sums2 = vaddq_s32(sums2, sum_in2);
sums3 = vaddq_s32(sums3, sum_in3);
sp += 1;
if sp >= div {
sp = 0;
}
let stack_ptr = stacks.get_unchecked_mut(sp as usize);
let stack_val0 = vld1q_s32(stack_ptr.as_ptr().cast());
let stack_val1 = vld1q_s32(stack_ptr[1..].as_ptr().cast());
let stack_val2 = vld1q_s32(stack_ptr[2..].as_ptr().cast());
let stack_val3 = vld1q_s32(stack_ptr[3..].as_ptr().cast());
sum_out0 = vaddq_s32(sum_out0, stack_val0);
sum_out1 = vaddq_s32(sum_out1, stack_val1);
sum_out2 = vaddq_s32(sum_out2, stack_val2);
sum_out3 = vaddq_s32(sum_out3, stack_val3);
sum_in0 = vsubq_s32(sum_in0, stack_val0);
sum_in1 = vsubq_s32(sum_in1, stack_val1);
sum_in2 = vsubq_s32(sum_in2, stack_val2);
sum_in3 = vsubq_s32(sum_in3, stack_val3);
}
cx += 16;
}
while cx + 8 <= max_x {
let mut sums0 = vdupq_n_s32(0i32);
let mut sums1 = vdupq_n_s32(0i32);
let mut sum_in0 = vdupq_n_s32(0i32);
let mut sum_in1 = vdupq_n_s32(0i32);
let mut sum_out0 = vdupq_n_s32(0i32);
let mut sum_out1 = vdupq_n_s32(0i32);
let mut src_ptr = cx;
{
let src_pixel0 = vld1_u8(pixels.get_ptr(src_ptr));
let lo0 = vmovl_u8(src_pixel0);
let i16_l0 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(lo0)));
let i16_h0 = vreinterpretq_s32_u32(vmovl_high_u16(lo0));
for i in 0..=radius {
let stack_ptr = stacks.get_unchecked_mut(i as usize);
vst1q_s32(stack_ptr.as_mut_ptr().cast(), i16_l0);
vst1q_s32(stack_ptr[1..].as_mut_ptr().cast(), i16_h0);
let w = i as i32 + 1;
sums0 = vmlaq_n_s32(sums0, i16_l0, w);
sums1 = vmlaq_n_s32(sums1, i16_h0, w);
sum_out0 = vaddq_s32(sum_out0, i16_l0);
sum_out1 = vaddq_s32(sum_out1, i16_h0);
}
}
{
for i in 1..=radius {
if i <= hm {
src_ptr += stride as usize;
}
let stack_ptr = stacks.get_unchecked_mut((i + radius) as usize);
let src_pixel0 = vld1_u8(pixels.get_ptr(src_ptr));
let lo0 = vmovl_u8(src_pixel0);
let i16_l0 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(lo0)));
let i16_h0 = vreinterpretq_s32_u32(vmovl_high_u16(lo0));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), i16_l0);
vst1q_s32(stack_ptr[1..].as_mut_ptr().cast(), i16_h0);
let vj = radius as i32 + 1 - i as i32;
sums0 = vmlaq_n_s32(sums0, i16_l0, vj);
sums1 = vmlaq_n_s32(sums1, i16_h0, vj);
sum_in0 = vaddq_s32(sum_in0, i16_l0);
sum_in1 = vaddq_s32(sum_in1, i16_h0);
}
}
sp = radius;
yp = radius;
if yp > hm {
yp = hm;
}
src_ptr = cx + yp as usize * stride as usize;
let mut dst_ptr = cx;
for _ in 0..height {
let casted_sum0 = vcvtq_f32_s32(sums0);
let casted_sum1 = vcvtq_f32_s32(sums1);
let a0 = vmulq_f32(casted_sum0, mul_value);
let a1 = vmulq_f32(casted_sum1, mul_value);
let scaled_val0 = vcvtaq_s32_f32(a0);
let scaled_val1 = vcvtaq_s32_f32(a1);
let jv0 = vcombine_u16(vqmovun_s32(scaled_val0), vqmovun_s32(scaled_val1));
vst1_u8(pixels.get_ptr(dst_ptr), vqmovn_u16(jv0));
dst_ptr += stride as usize;
sums0 = vsubq_s32(sums0, sum_out0);
sums1 = vsubq_s32(sums1, sum_out1);
stack_start = sp + div - radius;
if stack_start >= div {
stack_start -= div;
}
let stack_ptr = stacks.get_unchecked_mut(stack_start as usize);
let stack_val0 = vld1q_s32(stack_ptr.as_ptr().cast());
let stack_val1 = vld1q_s32(stack_ptr[1..].as_ptr().cast());
sum_out0 = vsubq_s32(sum_out0, stack_val0);
sum_out1 = vsubq_s32(sum_out1, stack_val1);
if yp < hm {
src_ptr += stride as usize; yp += 1;
}
let src_pixel0 = vld1_u8(pixels.get_ptr(src_ptr));
let lo0 = vmovl_u8(src_pixel0);
let i16_l0 = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(lo0)));
let i16_h0 = vreinterpretq_s32_u32(vmovl_high_u16(lo0));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), i16_l0);
vst1q_s32(stack_ptr.get_unchecked_mut(1..).as_mut_ptr().cast(), i16_h0);
sum_in0 = vaddq_s32(sum_in0, i16_l0);
sum_in1 = vaddq_s32(sum_in1, i16_h0);
sums0 = vaddq_s32(sums0, sum_in0);
sums1 = vaddq_s32(sums1, sum_in1);
sp += 1;
if sp >= div {
sp = 0;
}
let stack_ptr = stacks.get_unchecked(sp as usize);
let stack_val0 = vld1q_s32(stack_ptr.as_ptr().cast());
let stack_val1 = vld1q_s32(stack_ptr[1..].as_ptr().cast());
sum_out0 = vaddq_s32(sum_out0, stack_val0);
sum_out1 = vaddq_s32(sum_out1, stack_val1);
sum_in0 = vsubq_s32(sum_in0, stack_val0);
sum_in1 = vsubq_s32(sum_in1, stack_val1);
}
cx += 8;
}
while cx + CN <= max_x {
let mut sums = vdupq_n_s32(0i32);
let mut sum_in = vdupq_n_s32(0i32);
let mut sum_out = vdupq_n_s32(0i32);
let mut src_ptr = cx;
let src_pixel = load_u8_s32_fast::<CN>(pixels.get_ptr(src_ptr));
for i in 0..=radius {
let stack_ptr = stacks.get_unchecked_mut(i as usize);
vst1q_s32(stack_ptr.as_mut_ptr().cast(), src_pixel);
sums = vmlaq_n_s32(sums, src_pixel, i as i32 + 1);
sum_out = vaddq_s32(sum_out, src_pixel);
}
for i in 1..=radius {
if i <= hm {
src_ptr += stride as usize;
}
let stack_ptr = stacks.get_unchecked_mut((i + radius) as usize);
let src_pixel = load_u8_s32_fast::<CN>(pixels.get_ptr(src_ptr));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), src_pixel);
sums = vmlaq_n_s32(sums, src_pixel, radius as i32 + 1 - i as i32);
sum_in = vaddq_s32(sum_in, src_pixel);
}
sp = radius;
yp = radius;
if yp > hm {
yp = hm;
}
src_ptr = cx + yp as usize * stride as usize;
let mut dst_ptr = cx;
for _ in 0..height {
let casted_sum = vcvtq_f32_s32(sums);
let scaled_val = vcvtaq_s32_f32(vmulq_f32(casted_sum, mul_value));
store_u8_s32::<CN>(pixels.get_ptr(dst_ptr), scaled_val);
dst_ptr += stride as usize;
sums = vsubq_s32(sums, sum_out);
stack_start = sp + div - radius;
if stack_start >= div {
stack_start -= div;
}
let stack_ptr = stacks.get_unchecked_mut(stack_start as usize);
let stack_val = vld1q_s32(stack_ptr.as_ptr().cast());
sum_out = vsubq_s32(sum_out, stack_val);
if yp < hm {
src_ptr += stride as usize; yp += 1;
}
let src_pixel = load_u8_s32_fast::<CN>(pixels.get_ptr(src_ptr));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), src_pixel);
sum_in = vaddq_s32(sum_in, src_pixel);
sums = vaddq_s32(sums, sum_in);
sp += 1;
if sp >= div {
sp = 0;
}
let stack_ptr = stacks.get_unchecked(sp as usize);
let stack_val = vld1q_s32(stack_ptr.as_ptr().cast());
sum_out = vaddq_s32(sum_out, stack_val);
sum_in = vsubq_s32(sum_in, stack_val);
}
cx += CN;
}
const TAIL: usize = 1;
while cx < max_x {
let mut sums = vdupq_n_s32(0i32);
let mut sum_in = vdupq_n_s32(0i32);
let mut sum_out = vdupq_n_s32(0i32);
let mut src_ptr = cx;
let src_pixel = load_u8_s32_fast::<TAIL>(pixels.get_ptr(src_ptr));
for i in 0..=radius {
let stack_ptr = stacks.get_unchecked_mut(i as usize);
vst1q_s32(stack_ptr.as_mut_ptr().cast(), src_pixel);
sums = vmlaq_n_s32(sums, src_pixel, i as i32 + 1);
sum_out = vaddq_s32(sum_out, src_pixel);
}
for i in 1..=radius {
if i <= hm {
src_ptr += stride as usize;
}
let stack_ptr = stacks.get_unchecked_mut((i + radius) as usize);
let src_pixel = load_u8_s32_fast::<TAIL>(pixels.get_ptr(src_ptr));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), src_pixel);
sums = vmlaq_n_s32(sums, src_pixel, radius as i32 + 1 - i as i32);
sum_in = vaddq_s32(sum_in, src_pixel);
}
sp = radius;
yp = radius;
if yp > hm {
yp = hm;
}
src_ptr = cx + yp as usize * stride as usize;
let mut dst_ptr = cx;
for _ in 0..height {
let casted_sum = vcvtq_f32_s32(sums);
let scaled_val = vcvtaq_s32_f32(vmulq_f32(casted_sum, mul_value));
store_u8_s32::<TAIL>(pixels.get_ptr(dst_ptr), scaled_val);
dst_ptr += stride as usize;
sums = vsubq_s32(sums, sum_out);
stack_start = sp + div - radius;
if stack_start >= div {
stack_start -= div;
}
let stack_ptr = stacks.get_unchecked_mut(stack_start as usize);
let stack_val = vld1q_s32(stack_ptr.as_ptr().cast());
sum_out = vsubq_s32(sum_out, stack_val);
if yp < hm {
src_ptr += stride as usize; yp += 1;
}
let src_pixel = load_u8_s32_fast::<TAIL>(pixels.get_ptr(src_ptr));
vst1q_s32(stack_ptr.as_mut_ptr().cast(), src_pixel);
sum_in = vaddq_s32(sum_in, src_pixel);
sums = vaddq_s32(sums, sum_in);
sp += 1;
if sp >= div {
sp = 0;
}
let stack_ptr = stacks.get_unchecked(sp as usize).as_ptr();
let stack_val = vld1q_s32(stack_ptr.cast());
sum_out = vaddq_s32(sum_out, stack_val);
sum_in = vsubq_s32(sum_in, stack_val);
}
cx += TAIL;
}
}
}
}