use core::arch::x86_64::*;
use super::{endian, *};
use crate::{ColorMatrix, row::scalar};
#[rustfmt::skip]
static UV_FROM_PAIR_IDX: [i16; 32] = [
0, 4, 8, 12, 16, 20, 24, 28,
32, 36, 40, 44, 48, 52, 56, 60,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
];
#[rustfmt::skip]
static Y_FROM_PAIR_IDX: [i16; 32] = [
1, 5, 9, 13, 17, 21, 25, 29,
33, 37, 41, 45, 49, 53, 57, 61,
1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
];
#[rustfmt::skip]
static V_FROM_PAIR_IDX: [i16; 32] = [
2, 6, 10, 14, 18, 22, 26, 30,
34, 38, 42, 46, 50, 54, 58, 62,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
];
#[rustfmt::skip]
static COMBINE_IDX: [i16; 32] = [
0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47,
];
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
unsafe fn unpack_xv36_32px_avx512<const BE: bool>(ptr: *const u16) -> (__m512i, __m512i, __m512i) {
unsafe {
let v0 = endian::load_endian_u16x32::<BE>(ptr as *const u8); let v1 = endian::load_endian_u16x32::<BE>(ptr.add(32) as *const u8); let v2 = endian::load_endian_u16x32::<BE>(ptr.add(64) as *const u8); let v3 = endian::load_endian_u16x32::<BE>(ptr.add(96) as *const u8);
let uv_idx = _mm512_loadu_si512(UV_FROM_PAIR_IDX.as_ptr().cast());
let y_idx = _mm512_loadu_si512(Y_FROM_PAIR_IDX.as_ptr().cast());
let v_idx_tbl = _mm512_loadu_si512(V_FROM_PAIR_IDX.as_ptr().cast());
let comb_idx = _mm512_loadu_si512(COMBINE_IDX.as_ptr().cast());
let u_01 = _mm512_permutex2var_epi16(v0, uv_idx, v1); let u_23 = _mm512_permutex2var_epi16(v2, uv_idx, v3); let y_01 = _mm512_permutex2var_epi16(v0, y_idx, v1); let y_23 = _mm512_permutex2var_epi16(v2, y_idx, v3); let v_01 = _mm512_permutex2var_epi16(v0, v_idx_tbl, v1); let v_23 = _mm512_permutex2var_epi16(v2, v_idx_tbl, v3);
let u_raw = _mm512_permutex2var_epi16(u_01, comb_idx, u_23);
let y_raw = _mm512_permutex2var_epi16(y_01, comb_idx, y_23);
let v_raw = _mm512_permutex2var_epi16(v_01, comb_idx, v_23);
let u_vec = _mm512_srli_epi16::<4>(u_raw);
let y_vec = _mm512_srli_epi16::<4>(y_raw);
let v_vec = _mm512_srli_epi16::<4>(v_raw);
(u_vec, y_vec, v_vec)
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn xv36_to_rgb_or_rgba_row<const ALPHA: bool, const BE: bool>(
packed: &[u16],
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
debug_assert!(packed.len() >= width * 4, "packed row too short");
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(out.len() >= width * bpp, "out row too short");
let coeffs = scalar::Coefficients::for_matrix(matrix);
let (y_off, y_scale, c_scale) = scalar::range_params_n::<12, 8>(full_range);
let bias = scalar::chroma_bias::<12>();
const RND: i32 = 1 << 14;
unsafe {
let rnd_v = _mm512_set1_epi32(RND);
let y_off_v = _mm512_set1_epi16(y_off as i16);
let y_scale_v = _mm512_set1_epi32(y_scale);
let c_scale_v = _mm512_set1_epi32(c_scale);
let bias_v = _mm512_set1_epi16(bias as i16);
let cru = _mm512_set1_epi32(coeffs.r_u());
let crv = _mm512_set1_epi32(coeffs.r_v());
let cgu = _mm512_set1_epi32(coeffs.g_u());
let cgv = _mm512_set1_epi32(coeffs.g_v());
let cbu = _mm512_set1_epi32(coeffs.b_u());
let cbv = _mm512_set1_epi32(coeffs.b_v());
let pack_fixup = _mm512_setr_epi64(0, 2, 4, 6, 1, 3, 5, 7);
let mut x = 0usize;
while x + 32 <= width {
let (u_u16, y_u16, v_u16) = unpack_xv36_32px_avx512::<BE>(packed.as_ptr().add(x * 4));
let u_i16 = u_u16;
let y_i16 = y_u16;
let v_i16 = v_u16;
let u_sub = _mm512_sub_epi16(u_i16, bias_v);
let v_sub = _mm512_sub_epi16(v_i16, bias_v);
let u_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(u_sub));
let u_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(u_sub));
let v_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(v_sub));
let v_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(v_sub));
let u_d_lo = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_lo_i32, c_scale_v),
rnd_v,
));
let u_d_hi = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_hi_i32, c_scale_v),
rnd_v,
));
let v_d_lo = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_lo_i32, c_scale_v),
rnd_v,
));
let v_d_hi = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_hi_i32, c_scale_v),
rnd_v,
));
let r_chroma = chroma_i16x32(cru, crv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v, pack_fixup);
let g_chroma = chroma_i16x32(cgu, cgv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v, pack_fixup);
let b_chroma = chroma_i16x32(cbu, cbv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v, pack_fixup);
let y_scaled = scale_y(y_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let zero = _mm512_setzero_si512();
let r_u8 = narrow_u8x64(_mm512_adds_epi16(y_scaled, r_chroma), zero, pack_fixup);
let g_u8 = narrow_u8x64(_mm512_adds_epi16(y_scaled, g_chroma), zero, pack_fixup);
let b_u8 = narrow_u8x64(_mm512_adds_epi16(y_scaled, b_chroma), zero, pack_fixup);
if ALPHA {
let alpha = _mm_set1_epi8(-1i8);
let r0 = _mm512_castsi512_si128(r_u8);
let r1 = _mm512_extracti32x4_epi32::<1>(r_u8);
let g0 = _mm512_castsi512_si128(g_u8);
let g1 = _mm512_extracti32x4_epi32::<1>(g_u8);
let b0 = _mm512_castsi512_si128(b_u8);
let b1 = _mm512_extracti32x4_epi32::<1>(b_u8);
let dst = out.as_mut_ptr().add(x * 4);
write_rgba_16(r0, g0, b0, alpha, dst);
write_rgba_16(r1, g1, b1, alpha, dst.add(64));
} else {
let r0 = _mm512_castsi512_si128(r_u8);
let r1 = _mm512_extracti32x4_epi32::<1>(r_u8);
let g0 = _mm512_castsi512_si128(g_u8);
let g1 = _mm512_extracti32x4_epi32::<1>(g_u8);
let b0 = _mm512_castsi512_si128(b_u8);
let b1 = _mm512_extracti32x4_epi32::<1>(b_u8);
let dst = out.as_mut_ptr().add(x * 3);
write_rgb_16(r0, g0, b0, dst);
write_rgb_16(r1, g1, b1, dst.add(48));
}
x += 32;
}
if x < width {
let tail_packed = &packed[x * 4..width * 4];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
scalar::xv36_to_rgb_or_rgba_row::<ALPHA, BE>(
tail_packed,
tail_out,
tail_w,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn xv36_to_rgb_u16_or_rgba_u16_row<const ALPHA: bool, const BE: bool>(
packed: &[u16],
out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
debug_assert!(packed.len() >= width * 4, "packed row too short");
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(out.len() >= width * bpp, "out row too short");
let coeffs = scalar::Coefficients::for_matrix(matrix);
let (y_off, y_scale, c_scale) = scalar::range_params_n::<12, 12>(full_range);
let bias = scalar::chroma_bias::<12>();
const RND: i32 = 1 << 14;
let out_max: i16 = 0x0FFF;
let alpha_u16: u16 = 0x0FFF;
unsafe {
let rnd_v = _mm512_set1_epi32(RND);
let y_off_v = _mm512_set1_epi16(y_off as i16);
let y_scale_v = _mm512_set1_epi32(y_scale);
let c_scale_v = _mm512_set1_epi32(c_scale);
let bias_v = _mm512_set1_epi16(bias as i16);
let max_v = _mm512_set1_epi16(out_max);
let zero_v = _mm512_set1_epi16(0);
let cru = _mm512_set1_epi32(coeffs.r_u());
let crv = _mm512_set1_epi32(coeffs.r_v());
let cgu = _mm512_set1_epi32(coeffs.g_u());
let cgv = _mm512_set1_epi32(coeffs.g_v());
let cbu = _mm512_set1_epi32(coeffs.b_u());
let cbv = _mm512_set1_epi32(coeffs.b_v());
let pack_fixup = _mm512_setr_epi64(0, 2, 4, 6, 1, 3, 5, 7);
let mut x = 0usize;
while x + 32 <= width {
let (u_u16, y_u16, v_u16) = unpack_xv36_32px_avx512::<BE>(packed.as_ptr().add(x * 4));
let u_i16 = u_u16;
let y_i16 = y_u16;
let v_i16 = v_u16;
let u_sub = _mm512_sub_epi16(u_i16, bias_v);
let v_sub = _mm512_sub_epi16(v_i16, bias_v);
let u_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(u_sub));
let u_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(u_sub));
let v_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(v_sub));
let v_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(v_sub));
let u_d_lo = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_lo_i32, c_scale_v),
rnd_v,
));
let u_d_hi = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_hi_i32, c_scale_v),
rnd_v,
));
let v_d_lo = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_lo_i32, c_scale_v),
rnd_v,
));
let v_d_hi = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_hi_i32, c_scale_v),
rnd_v,
));
let r_chroma = chroma_i16x32(cru, crv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v, pack_fixup);
let g_chroma = chroma_i16x32(cgu, cgv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v, pack_fixup);
let b_chroma = chroma_i16x32(cbu, cbv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v, pack_fixup);
let y_scaled = scale_y(y_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let r = clamp_u16_max_x32(_mm512_adds_epi16(y_scaled, r_chroma), zero_v, max_v);
let g = clamp_u16_max_x32(_mm512_adds_epi16(y_scaled, g_chroma), zero_v, max_v);
let b = clamp_u16_max_x32(_mm512_adds_epi16(y_scaled, b_chroma), zero_v, max_v);
if ALPHA {
let alpha_v = _mm_set1_epi16(out_max);
write_rgba_u16_32(r, g, b, alpha_v, out.as_mut_ptr().add(x * 4));
let _ = alpha_u16; } else {
write_rgb_u16_32(r, g, b, out.as_mut_ptr().add(x * 3));
}
x += 32;
}
if x < width {
let tail_packed = &packed[x * 4..width * 4];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
scalar::xv36_to_rgb_u16_or_rgba_u16_row::<ALPHA, BE>(
tail_packed,
tail_out,
tail_w,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn xv36_to_luma_row<const BE: bool>(
packed: &[u16],
out: &mut [u8],
width: usize,
) {
debug_assert!(packed.len() >= width * 4);
debug_assert!(out.len() >= width);
unsafe {
let pack_fixup = _mm512_setr_epi64(0, 2, 4, 6, 1, 3, 5, 7);
let zero = _mm512_setzero_si512();
let mut x = 0usize;
while x + 32 <= width {
let (_u_vec, y_vec, _v_vec) = unpack_xv36_32px_avx512::<BE>(packed.as_ptr().add(x * 4));
let y_shr = _mm512_srli_epi16::<4>(y_vec);
let y_u8 = narrow_u8x64(y_shr, zero, pack_fixup);
_mm256_storeu_si256(out.as_mut_ptr().add(x).cast(), _mm512_castsi512_si256(y_u8));
x += 32;
}
if x < width {
scalar::xv36_to_luma_row::<BE>(&packed[x * 4..width * 4], &mut out[x..width], width - x);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn xv36_to_luma_u16_row<const BE: bool>(
packed: &[u16],
out: &mut [u16],
width: usize,
) {
debug_assert!(packed.len() >= width * 4);
debug_assert!(out.len() >= width);
unsafe {
let mut x = 0usize;
while x + 32 <= width {
let (_u_vec, y_vec, _v_vec) = unpack_xv36_32px_avx512::<BE>(packed.as_ptr().add(x * 4));
_mm512_storeu_si512(out.as_mut_ptr().add(x).cast(), y_vec);
x += 32;
}
if x < width {
scalar::xv36_to_luma_u16_row::<BE>(&packed[x * 4..width * 4], &mut out[x..width], width - x);
}
}
}