use core::arch::wasm32::*;
use crate::convolution::optimisations::Normalizer32;
use crate::pixels::U16x2;
use crate::{wasm32_utils, ImageView, ImageViewMut};
#[inline]
pub(crate) fn horiz_convolution(
src_view: &impl ImageView<Pixel = U16x2>,
dst_view: &mut impl ImageViewMut<Pixel = U16x2>,
offset: u32,
normalizer: &Normalizer32,
) {
let dst_height = dst_view.height();
let src_iter = src_view.iter_4_rows(offset, dst_height + offset);
let dst_iter = dst_view.iter_4_rows_mut();
for (src_rows, dst_rows) in src_iter.zip(dst_iter) {
unsafe {
horiz_convolution_four_rows(src_rows, dst_rows, normalizer);
}
}
let yy = dst_height - dst_height % 4;
let src_rows = src_view.iter_rows(yy + offset);
let dst_rows = dst_view.iter_rows_mut(yy);
for (src_row, dst_row) in src_rows.zip(dst_rows) {
unsafe {
horiz_convolution_one_row(src_row, dst_row, normalizer);
}
}
}
#[target_feature(enable = "simd128")]
unsafe fn horiz_convolution_four_rows(
src_rows: [&[U16x2]; 4],
dst_rows: [&mut [U16x2]; 4],
normalizer: &Normalizer32,
) {
let precision = normalizer.precision();
let half_error = 1i64 << (precision - 1);
let mut ll_buf = [0i64; 2];
const P0_SHUFFLE: v128 = i8x16(0, 1, -1, -1, -1, -1, -1, -1, 2, 3, -1, -1, -1, -1, -1, -1);
const P1_SHUFFLE: v128 = i8x16(4, 5, -1, -1, -1, -1, -1, -1, 6, 7, -1, -1, -1, -1, -1, -1);
const P2_SHUFFLE: v128 = i8x16(8, 9, -1, -1, -1, -1, -1, -1, 10, 11, -1, -1, -1, -1, -1, -1);
const P3_SHUFFLE: v128 = i8x16(
12, 13, -1, -1, -1, -1, -1, -1, 14, 15, -1, -1, -1, -1, -1, -1,
);
for (dst_x, coeffs_chunk) in normalizer.chunks().iter().enumerate() {
let mut x: usize = coeffs_chunk.start as usize;
let mut ll_sum = [i64x2_splat(half_error); 4];
let mut coeffs = coeffs_chunk.values();
let coeffs_by_4 = coeffs.chunks_exact(4);
coeffs = coeffs_by_4.remainder();
for k in coeffs_by_4 {
let coeff0_i64x2 = i64x2_splat(k[0] as i64);
let coeff1_i64x2 = i64x2_splat(k[1] as i64);
let coeff2_i64x2 = i64x2_splat(k[2] as i64);
let coeff3_i64x2 = i64x2_splat(k[3] as i64);
for i in 0..4 {
let mut sum = ll_sum[i];
let source = wasm32_utils::load_v128(src_rows[i], x);
let p_i64x2 = i8x16_swizzle(source, P0_SHUFFLE);
sum = i64x2_add(sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff0_i64x2));
let p_i64x2 = i8x16_swizzle(source, P1_SHUFFLE);
sum = i64x2_add(sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff1_i64x2));
let p_i64x2 = i8x16_swizzle(source, P2_SHUFFLE);
sum = i64x2_add(sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff2_i64x2));
let p_i64x2 = i8x16_swizzle(source, P3_SHUFFLE);
sum = i64x2_add(sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff3_i64x2));
ll_sum[i] = sum;
}
x += 4;
}
let coeffs_by_2 = coeffs.chunks_exact(2);
coeffs = coeffs_by_2.remainder();
for k in coeffs_by_2 {
let coeff0_i64x2 = i64x2_splat(k[0] as i64);
let coeff1_i64x2 = i64x2_splat(k[1] as i64);
for i in 0..4 {
let mut sum = ll_sum[i];
let source = wasm32_utils::loadl_i64(src_rows[i], x);
let p_i64x2 = i8x16_swizzle(source, P0_SHUFFLE);
sum = i64x2_add(sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff0_i64x2));
let p_i64x2 = i8x16_swizzle(source, P1_SHUFFLE);
sum = i64x2_add(sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff1_i64x2));
ll_sum[i] = sum;
}
x += 2;
}
if let Some(&k) = coeffs.first() {
let coeff0_i64x2 = i64x2_splat(k as i64);
for i in 0..4 {
let source = wasm32_utils::loadl_i32(src_rows[i], x);
let p_i64x2 = i8x16_swizzle(source, P0_SHUFFLE);
ll_sum[i] = i64x2_add(ll_sum[i], wasm32_utils::i64x2_mul_lo(p_i64x2, coeff0_i64x2));
}
}
for i in 0..4 {
v128_store(ll_buf.as_mut_ptr() as *mut v128, ll_sum[i]);
let dst_pixel = dst_rows[i].get_unchecked_mut(dst_x);
dst_pixel.0 = [normalizer.clip(ll_buf[0]), normalizer.clip(ll_buf[1])];
}
}
}
#[inline]
#[target_feature(enable = "simd128")]
unsafe fn horiz_convolution_one_row(
src_row: &[U16x2],
dst_row: &mut [U16x2],
normalizer: &Normalizer32,
) {
let precision = normalizer.precision();
let half_error = 1i64 << (precision - 1);
let mut ll_buf = [0i64; 2];
const P0_SHUFFLE: v128 = i8x16(0, 1, -1, -1, -1, -1, -1, -1, 2, 3, -1, -1, -1, -1, -1, -1);
const P1_SHUFFLE: v128 = i8x16(4, 5, -1, -1, -1, -1, -1, -1, 6, 7, -1, -1, -1, -1, -1, -1);
const P2_SHUFFLE: v128 = i8x16(8, 9, -1, -1, -1, -1, -1, -1, 10, 11, -1, -1, -1, -1, -1, -1);
const P3_SHUFFLE: v128 = i8x16(
12, 13, -1, -1, -1, -1, -1, -1, 14, 15, -1, -1, -1, -1, -1, -1,
);
for (dst_x, coeffs_chunk) in normalizer.chunks().iter().enumerate() {
let mut x: usize = coeffs_chunk.start as usize;
let mut ll_sum = i64x2_splat(half_error);
let mut coeffs = coeffs_chunk.values();
let coeffs_by_4 = coeffs.chunks_exact(4);
coeffs = coeffs_by_4.remainder();
for k in coeffs_by_4 {
let coeff0_i64x2 = i64x2_splat(k[0] as i64);
let coeff1_i64x2 = i64x2_splat(k[1] as i64);
let coeff2_i64x2 = i64x2_splat(k[2] as i64);
let coeff3_i64x2 = i64x2_splat(k[3] as i64);
let source = wasm32_utils::load_v128(src_row, x);
let p_i64x2 = i8x16_swizzle(source, P0_SHUFFLE);
ll_sum = i64x2_add(ll_sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff0_i64x2));
let p_i64x2 = i8x16_swizzle(source, P1_SHUFFLE);
ll_sum = i64x2_add(ll_sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff1_i64x2));
let p_i64x2 = i8x16_swizzle(source, P2_SHUFFLE);
ll_sum = i64x2_add(ll_sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff2_i64x2));
let p_i64x2 = i8x16_swizzle(source, P3_SHUFFLE);
ll_sum = i64x2_add(ll_sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff3_i64x2));
x += 4;
}
let coeffs_by_2 = coeffs.chunks_exact(2);
coeffs = coeffs_by_2.remainder();
for k in coeffs_by_2 {
let coeff0_i64x2 = i64x2_splat(k[0] as i64);
let coeff1_i64x2 = i64x2_splat(k[1] as i64);
let source = wasm32_utils::loadl_i64(src_row, x);
let p_i64x2 = i8x16_swizzle(source, P0_SHUFFLE);
ll_sum = i64x2_add(ll_sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff0_i64x2));
let p_i64x2 = i8x16_swizzle(source, P1_SHUFFLE);
ll_sum = i64x2_add(ll_sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff1_i64x2));
x += 2;
}
if let Some(&k) = coeffs.first() {
let coeff0_i64x2 = i64x2_splat(k as i64);
let source = wasm32_utils::loadl_i32(src_row, x);
let p_i64x2 = i8x16_swizzle(source, P0_SHUFFLE);
ll_sum = i64x2_add(ll_sum, wasm32_utils::i64x2_mul_lo(p_i64x2, coeff0_i64x2));
}
v128_store(ll_buf.as_mut_ptr() as *mut v128, ll_sum);
let dst_pixel = dst_row.get_unchecked_mut(dst_x);
dst_pixel.0 = [normalizer.clip(ll_buf[0]), normalizer.clip(ll_buf[1])];
}
}