use core::arch::x86_64::*;
use crate::convolution::{Coefficients, CoefficientsChunk};
use crate::pixels::F32;
use crate::{simd_utils, ImageView, ImageViewMut};
#[inline]
pub(crate) fn horiz_convolution(
src_view: &impl ImageView<Pixel = F32>,
dst_view: &mut impl ImageViewMut<Pixel = F32>,
offset: u32,
coeffs: &Coefficients,
) {
let coefficients_chunks = coeffs.get_chunks();
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_rows(src_rows, dst_rows, &coefficients_chunks);
}
}
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_rows([src_row], [dst_row], &coefficients_chunks);
}
}
}
#[target_feature(enable = "avx2")]
unsafe fn horiz_convolution_rows<const ROWS_COUNT: usize>(
src_rows: [&[F32]; ROWS_COUNT],
dst_rows: [&mut [F32]; ROWS_COUNT],
coefficients_chunks: &[CoefficientsChunk],
) {
let mut ll_buf = [0f64; 2];
for (dst_x, coeffs_chunk) in coefficients_chunks.iter().enumerate() {
let mut x: usize = coeffs_chunk.start as usize;
let mut sums = [_mm256_set1_pd(0.); ROWS_COUNT];
let mut coeffs = coeffs_chunk.values;
let coeffs_by_8 = coeffs.chunks_exact(8);
coeffs = coeffs_by_8.remainder();
for k in coeffs_by_8 {
let coeff03_f64x4 = simd_utils::loadu_pd256(k, 0);
let coeff47_f64x4 = simd_utils::loadu_pd256(k, 4);
for i in 0..ROWS_COUNT {
let mut sum = sums[i];
let source = simd_utils::loadu_ps256(src_rows[i], x);
let pixels03_f64x4 = _mm256_cvtps_pd(_mm256_extractf128_ps::<0>(source));
sum = _mm256_add_pd(sum, _mm256_mul_pd(pixels03_f64x4, coeff03_f64x4));
let pixels47_f64x4 = _mm256_cvtps_pd(_mm256_extractf128_ps::<1>(source));
sum = _mm256_add_pd(sum, _mm256_mul_pd(pixels47_f64x4, coeff47_f64x4));
sums[i] = sum;
}
x += 8;
}
let coeffs_by_4 = coeffs.chunks_exact(4);
coeffs = coeffs_by_4.remainder();
for k in coeffs_by_4 {
let coeff03_f64x4 = simd_utils::loadu_pd256(k, 0);
for i in 0..ROWS_COUNT {
let mut sum = sums[i];
let source = simd_utils::loadu_ps(src_rows[i], x);
let pixels03_f64x4 = _mm256_cvtps_pd(source);
sum = _mm256_add_pd(sum, _mm256_mul_pd(pixels03_f64x4, coeff03_f64x4));
sums[i] = sum;
}
x += 4;
}
let coeffs_by_2 = coeffs.chunks_exact(2);
coeffs = coeffs_by_2.remainder();
for k in coeffs_by_2 {
let coeff01_f64x4 = _mm256_set_pd(0., 0., k[1], k[0]);
for i in 0..ROWS_COUNT {
let pixel0 = src_rows[i].get_unchecked(x).0;
let pixel1 = src_rows[i].get_unchecked(x + 1).0;
let pixel01_f64x4 = _mm256_set_pd(0., 0., pixel1 as f64, pixel0 as f64);
sums[i] = _mm256_add_pd(sums[i], _mm256_mul_pd(pixel01_f64x4, coeff01_f64x4));
}
x += 2;
}
if let Some(&k) = coeffs.first() {
let coeff0_f64x4 = _mm256_set_pd(0., 0., 0., k);
for i in 0..ROWS_COUNT {
let pixel0 = src_rows[i].get_unchecked(x).0;
let pixel0_f64x4 = _mm256_set_pd(0., 0., 0., pixel0 as f64);
sums[i] = _mm256_add_pd(sums[i], _mm256_mul_pd(pixel0_f64x4, coeff0_f64x4));
}
}
for i in 0..ROWS_COUNT {
let sum_f64x2 = _mm_add_pd(
_mm256_extractf128_pd::<0>(sums[i]),
_mm256_extractf128_pd::<1>(sums[i]),
);
_mm_storeu_pd(ll_buf.as_mut_ptr(), sum_f64x2);
let dst_pixel = dst_rows[i].get_unchecked_mut(dst_x);
dst_pixel.0 = (ll_buf[0] + ll_buf[1]) as f32;
}
}
}