use core::arch::x86_64::*;
use crate::convolution::optimisations::{CoefficientsI32Chunk, Normalizer32};
use crate::pixels::InnerPixel;
use crate::{simd_utils, ImageView, ImageViewMut};
pub(crate) fn vert_convolution<T>(
src_view: &impl ImageView<Pixel = T>,
dst_view: &mut impl ImageViewMut<Pixel = T>,
offset: u32,
normalizer: &Normalizer32,
) where
T: InnerPixel<Component = u16>,
{
let coefficients_chunks = normalizer.chunks();
let src_x = offset as usize * T::count_of_components();
let dst_rows = dst_view.iter_rows_mut(0);
for (dst_row, coeffs_chunk) in dst_rows.zip(coefficients_chunks) {
unsafe {
vert_convolution_into_one_row_u16(src_view, dst_row, src_x, coeffs_chunk, normalizer);
}
}
}
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn vert_convolution_into_one_row_u16<T>(
src_view: &impl ImageView<Pixel = T>,
dst_row: &mut [T],
mut src_x: usize,
coeffs_chunk: &CoefficientsI32Chunk,
normalizer: &Normalizer32,
) where
T: InnerPixel<Component = u16>,
{
let y_start = coeffs_chunk.start;
let coeffs = coeffs_chunk.values();
let mut dst_u16 = T::components_mut(dst_row);
let shuffles = [
_mm256_set_m128i(
_mm_set_epi8(-1, -1, -1, -1, -1, -1, 3, 2, -1, -1, -1, -1, -1, -1, 1, 0),
_mm_set_epi8(-1, -1, -1, -1, -1, -1, 3, 2, -1, -1, -1, -1, -1, -1, 1, 0),
),
_mm256_set_m128i(
_mm_set_epi8(-1, -1, -1, -1, -1, -1, 7, 6, -1, -1, -1, -1, -1, -1, 5, 4),
_mm_set_epi8(-1, -1, -1, -1, -1, -1, 7, 6, -1, -1, -1, -1, -1, -1, 5, 4),
),
_mm256_set_m128i(
_mm_set_epi8(-1, -1, -1, -1, -1, -1, 11, 10, -1, -1, -1, -1, -1, -1, 9, 8),
_mm_set_epi8(-1, -1, -1, -1, -1, -1, 11, 10, -1, -1, -1, -1, -1, -1, 9, 8),
),
_mm256_set_m128i(
_mm_set_epi8(
-1, -1, -1, -1, -1, -1, 15, 14, -1, -1, -1, -1, -1, -1, 13, 12,
),
_mm_set_epi8(
-1, -1, -1, -1, -1, -1, 15, 14, -1, -1, -1, -1, -1, -1, 13, 12,
),
),
];
let precision = normalizer.precision();
let initial = _mm256_set1_epi64x(1 << (precision - 1));
let mut comp_buf = [0i64; 4];
let mut dst_chunks_16 = dst_u16.chunks_exact_mut(16);
for dst_chunk in &mut dst_chunks_16 {
let mut sum = [initial; 4];
for (s_row, &coeff) in src_view.iter_rows(y_start).zip(coeffs) {
let components = T::components(s_row);
let coeff_i64x4 = _mm256_set1_epi64x(coeff as i64);
let source = simd_utils::loadu_si256(components, src_x);
for i in 0..4 {
let comp_i64x4 = _mm256_shuffle_epi8(source, shuffles[i]);
sum[i] = _mm256_add_epi64(sum[i], _mm256_mul_epi32(comp_i64x4, coeff_i64x4));
}
}
for i in 0..4 {
_mm256_storeu_si256(comp_buf.as_mut_ptr() as *mut __m256i, sum[i]);
let component = dst_chunk.get_unchecked_mut(i * 2);
*component = normalizer.clip(comp_buf[0]);
let component = dst_chunk.get_unchecked_mut(i * 2 + 1);
*component = normalizer.clip(comp_buf[1]);
let component = dst_chunk.get_unchecked_mut(i * 2 + 8);
*component = normalizer.clip(comp_buf[2]);
let component = dst_chunk.get_unchecked_mut(i * 2 + 9);
*component = normalizer.clip(comp_buf[3]);
}
src_x += 16;
}
dst_u16 = dst_chunks_16.into_remainder();
if !dst_u16.is_empty() {
let mut sum = [initial; 4];
let mut buf = [0u16; 16];
for (s_row, &coeff) in src_view.iter_rows(y_start).zip(coeffs) {
let components = T::components(s_row);
for (i, &v) in components
.get_unchecked(src_x..)
.iter()
.take(dst_u16.len())
.enumerate()
{
buf[i] = v;
}
let coeff_i64x4 = _mm256_set1_epi64x(coeff as i64);
let source = simd_utils::loadu_si256(&buf, 0);
for i in 0..4 {
let comp_i64x4 = _mm256_shuffle_epi8(source, shuffles[i]);
sum[i] = _mm256_add_epi64(sum[i], _mm256_mul_epi32(comp_i64x4, coeff_i64x4));
}
}
for i in 0..4 {
_mm256_storeu_si256(comp_buf.as_mut_ptr() as *mut __m256i, sum[i]);
let component = buf.get_unchecked_mut(i * 2);
*component = normalizer.clip(comp_buf[0]);
let component = buf.get_unchecked_mut(i * 2 + 1);
*component = normalizer.clip(comp_buf[1]);
let component = buf.get_unchecked_mut(i * 2 + 8);
*component = normalizer.clip(comp_buf[2]);
let component = buf.get_unchecked_mut(i * 2 + 9);
*component = normalizer.clip(comp_buf[3]);
}
for (i, v) in dst_u16.iter_mut().enumerate() {
*v = buf[i];
}
}
}