use crate::afv::AFV_BASIS_TRANSPOSE;
use crate::dct::DctInput;
#[cfg(target_arch = "x86")]
use std::arch::x86::*;
#[cfg(target_arch = "x86_64")]
use std::arch::x86_64::*;
use super::dct::{dct1d_4, dct1d_8, transpose_4x4};
#[inline]
#[target_feature(enable = "sse4.1")]
fn afv_basis<const KIND: usize>(input: DctInput<'_, 8, 8>) -> [__m128; 4] {
let afv_x = KIND & 1;
let afv_y = KIND >> 1;
let mut out = [_mm_setzero_ps(); 4];
for j in 0..16 {
let dy = j / 4;
let dx = j % 4;
let sy = if afv_y == 1 { 3 - dy } else { dy } + 4 * afv_y;
let sx = if afv_x == 1 { 3 - dx } else { dx } + 4 * afv_x;
let px = _mm_set1_ps(input.row(sy)[sx]);
for (chunk, acc) in out.iter_mut().enumerate() {
let basis = unsafe { _mm_loadu_ps(AFV_BASIS_TRANSPOSE[j][chunk * 4..].as_ptr()) };
*acc = _mm_add_ps(*acc, _mm_mul_ps(px, basis));
}
}
out
}
#[inline]
#[target_feature(enable = "sse4.1")]
fn adjacent_dct4x4<const KIND: usize>(input: DctInput<'_, 8, 8>) -> [__m128; 4] {
let afv_x = KIND & 1;
let afv_y = KIND >> 1;
let qx = if afv_x == 1 { 0 } else { 4 };
let mut rows: [__m128; 4] =
std::array::from_fn(|y| unsafe { _mm_loadu_ps(input.row(y + 4 * afv_y)[qx..].as_ptr()) });
transpose_4x4(&mut rows);
dct1d_4(&mut rows);
transpose_4x4(&mut rows);
dct1d_4(&mut rows);
transpose_4x4(&mut rows);
let scale = _mm_set1_ps(1.0 / 16.0);
rows.map(|row| _mm_mul_ps(row, scale))
}
#[inline]
#[target_feature(enable = "sse4.1")]
fn opposite_dct4x8<const KIND: usize>(input: DctInput<'_, 8, 8>) -> ([__m128; 4], [__m128; 4]) {
let afv_y = KIND >> 1;
let hy = if afv_y == 1 { 0 } else { 4 };
let mut left: [__m128; 4] =
std::array::from_fn(|y| unsafe { _mm_loadu_ps(input.row(hy + y).as_ptr()) });
let mut right: [__m128; 4] =
std::array::from_fn(|y| unsafe { _mm_loadu_ps(input.row(hy + y)[4..].as_ptr()) });
dct1d_4(&mut left);
dct1d_4(&mut right);
transpose_4x4(&mut left);
transpose_4x4(&mut right);
let mut freq = [left[0]; 8];
freq[..4].copy_from_slice(&left);
freq[4..].copy_from_slice(&right);
dct1d_8(&mut freq);
left.copy_from_slice(&freq[..4]);
right.copy_from_slice(&freq[4..]);
transpose_4x4(&mut left);
transpose_4x4(&mut right);
let scale = _mm_set1_ps(1.0 / 32.0);
(
left.map(|row| _mm_mul_ps(row, scale)),
right.map(|row| _mm_mul_ps(row, scale)),
)
}
#[inline]
#[target_feature(enable = "sse4.1")]
fn afv<const KIND: usize>(input: DctInput<'_, 8, 8>, out: &mut [f32; 64]) {
let basis = afv_basis::<KIND>(input);
let adjacent = adjacent_dct4x4::<KIND>(input);
for y in 0..4 {
unsafe {
_mm_storeu_ps(
out[y * 16..].as_mut_ptr(),
_mm_unpacklo_ps(basis[y], adjacent[y]),
);
_mm_storeu_ps(
out[y * 16 + 4..].as_mut_ptr(),
_mm_unpackhi_ps(basis[y], adjacent[y]),
);
}
}
let (left, right) = opposite_dct4x8::<KIND>(input);
for y in 0..4 {
unsafe {
_mm_storeu_ps(out[(2 * y + 1) * 8..].as_mut_ptr(), left[y]);
_mm_storeu_ps(out[(2 * y + 1) * 8 + 4..].as_mut_ptr(), right[y]);
}
}
let block00 = out[0] * 0.25;
let block01 = out[1];
let block10 = out[8];
out[0] = (block00 + block01 + 2.0 * block10) * 0.25;
out[1] = (block00 - block01) * 0.5;
out[8] = (block00 + block01 - 2.0 * block10) * 0.25;
}
macro_rules! afv_kernel {
($name:ident, $kind:literal) => {
#[target_feature(enable = "sse4.1")]
pub(crate) fn $name(input: DctInput<'_, 8, 8>, out: &mut [f32; 64]) {
afv::<$kind>(input, out);
}
};
}
afv_kernel!(afv0_sse41, 0);
afv_kernel!(afv1_sse41, 1);
afv_kernel!(afv2_sse41, 2);
afv_kernel!(afv3_sse41, 3);