use core::arch::x86_64::*;
use crate::convolution::{Coefficients, CoefficientsChunk};
use crate::pixels::{F32x3, InnerPixel};
use crate::{simd_utils, ImageView, ImageViewMut};
#[inline]
pub(crate) fn horiz_convolution(
src_view: &impl ImageView<Pixel = F32x3>,
dst_view: &mut impl ImageViewMut<Pixel = F32x3>,
offset: u32,
coeffs: &Coefficients,
) {
let coefficients_chunks = coeffs.get_chunks();
let dst_height = dst_view.height();
let src_iter = src_view.iter_2_rows(offset, dst_height + offset);
let dst_iter = dst_view.iter_2_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 % 2;
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 = "sse4.1")]
unsafe fn horiz_convolution_rows<const ROWS_COUNT: usize>(
src_rows: [&[F32x3]; ROWS_COUNT],
dst_rows: [&mut [F32x3]; ROWS_COUNT],
coefficients_chunks: &[CoefficientsChunk],
) {
let mut rg_buf = [0f64; 2];
let mut br_buf = [0f64; 2];
let mut gb_buf = [0f64; 2];
for (dst_x, coeffs_chunk) in coefficients_chunks.iter().enumerate() {
let mut x: usize = coeffs_chunk.start as usize;
let mut rg_sums = [_mm_set1_pd(0.); ROWS_COUNT];
let mut br_sums = [_mm_set1_pd(0.); ROWS_COUNT];
let mut gb_sums = [_mm_set1_pd(0.); ROWS_COUNT];
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 coeff00_f64x2 = _mm_set1_pd(k[0]);
let coeff01_f64x2 = _mm_set_pd(k[1], k[0]);
let coeff11_f64x2 = _mm_set1_pd(k[1]);
let coeff22_f64x2 = _mm_set1_pd(k[2]);
let coeff23_f64x2 = _mm_set_pd(k[3], k[2]);
let coeff33_f64x2 = _mm_set1_pd(k[3]);
for i in 0..ROWS_COUNT {
let c = x * 3;
let components = F32x3::components(src_rows[i]);
let rgb0r1 = simd_utils::loadu_ps(components, c);
let rg0_f64x2 = _mm_cvtps_pd(rgb0r1);
rg_sums[i] = _mm_add_pd(rg_sums[i], _mm_mul_pd(rg0_f64x2, coeff00_f64x2));
let b0r1_f64x2 = _mm_cvtps_pd(_mm_movehl_ps(rgb0r1, rgb0r1));
br_sums[i] = _mm_add_pd(br_sums[i], _mm_mul_pd(b0r1_f64x2, coeff01_f64x2));
let gb1rg2 = simd_utils::loadu_ps(components, c + 4);
let gb1_f64x2 = _mm_cvtps_pd(gb1rg2);
gb_sums[i] = _mm_add_pd(gb_sums[i], _mm_mul_pd(gb1_f64x2, coeff11_f64x2));
let rg2_f64x2 = _mm_cvtps_pd(_mm_movehl_ps(gb1rg2, gb1rg2));
rg_sums[i] = _mm_add_pd(rg_sums[i], _mm_mul_pd(rg2_f64x2, coeff22_f64x2));
let b2rgb3 = simd_utils::loadu_ps(components, c + 8);
let b2r3_f64x2 = _mm_cvtps_pd(b2rgb3);
br_sums[i] = _mm_add_pd(br_sums[i], _mm_mul_pd(b2r3_f64x2, coeff23_f64x2));
let gb3_f64x2 = _mm_cvtps_pd(_mm_movehl_ps(b2rgb3, b2rgb3));
gb_sums[i] = _mm_add_pd(gb_sums[i], _mm_mul_pd(gb3_f64x2, coeff33_f64x2));
}
x += 4;
}
let coeffs_by_2 = coeffs.chunks_exact(2);
coeffs = coeffs_by_2.remainder();
for k in coeffs_by_2 {
let coeff00_f64x2 = _mm_set1_pd(k[0]);
let coeff01_f64x2 = _mm_set_pd(k[1], k[0]);
let coeff11_f64x2 = _mm_set1_pd(k[1]);
for i in 0..ROWS_COUNT {
let c = x * 3;
let components = F32x3::components(src_rows[i]);
let rgb0r1 = simd_utils::loadu_ps(components, c);
let rg0_f64x2 = _mm_cvtps_pd(rgb0r1);
rg_sums[i] = _mm_add_pd(rg_sums[i], _mm_mul_pd(rg0_f64x2, coeff00_f64x2));
let b0r1_f64x2 = _mm_cvtps_pd(_mm_movehl_ps(rgb0r1, rgb0r1));
br_sums[i] = _mm_add_pd(br_sums[i], _mm_mul_pd(b0r1_f64x2, coeff01_f64x2));
let g1 = *components.get_unchecked(c + 4);
let b1 = *components.get_unchecked(c + 5);
let gb1_f64x2 = _mm_set_pd(b1 as f64, g1 as f64);
gb_sums[i] = _mm_add_pd(gb_sums[i], _mm_mul_pd(gb1_f64x2, coeff11_f64x2));
}
x += 2;
}
for &k in coeffs {
let coeff00_f64x2 = _mm_set1_pd(k);
let coeff0x_f64x2 = _mm_set_pd(0., k);
for i in 0..ROWS_COUNT {
let pixel = src_rows[i].get_unchecked(x);
let rgb0x = _mm_set_ps(0., pixel.0[2], pixel.0[1], pixel.0[0]);
let rg0_f64x2 = _mm_cvtps_pd(rgb0x);
rg_sums[i] = _mm_add_pd(rg_sums[i], _mm_mul_pd(rg0_f64x2, coeff00_f64x2));
let b0x_f64x2 = _mm_cvtps_pd(_mm_movehl_ps(rgb0x, rgb0x));
br_sums[i] = _mm_add_pd(br_sums[i], _mm_mul_pd(b0x_f64x2, coeff0x_f64x2));
}
x += 1;
}
for i in 0..ROWS_COUNT {
_mm_storeu_pd(rg_buf.as_mut_ptr(), rg_sums[i]);
_mm_storeu_pd(br_buf.as_mut_ptr(), br_sums[i]);
_mm_storeu_pd(gb_buf.as_mut_ptr(), gb_sums[i]);
let dst_pixel = dst_rows[i].get_unchecked_mut(dst_x);
dst_pixel.0 = [
(rg_buf[0] + br_buf[1]) as f32,
(rg_buf[1] + gb_buf[0]) as f32,
(br_buf[0] + gb_buf[1]) as f32,
];
}
}
}