use core::arch::x86_64::*;
use super::*;
use crate::{ColorMatrix, row::scalar};
const HOST_NATIVE_BE: bool = cfg!(target_endian = "big");
#[rustfmt::skip]
static Y_FROM_YUYV_IDX: [i16; 32] = [
0, 2, 4, 6, 8, 10, 12, 14, 16, 18, 20, 22, 24, 26, 28, 30,
32, 34, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62,
];
#[rustfmt::skip]
static CHROMA_FROM_YUYV_IDX: [i16; 32] = [
1, 3, 5, 7, 9, 11, 13, 15, 17, 19, 21, 23, 25, 27, 29, 31,
33, 35, 37, 39, 41, 43, 45, 47, 49, 51, 53, 55, 57, 59, 61, 63,
];
#[rustfmt::skip]
static U_FROM_UV_IDX: [i16; 32] = [
0, 2, 4, 6, 8, 10, 12, 14, 16, 18, 20, 22, 24, 26, 28, 30,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
];
#[rustfmt::skip]
static V_FROM_UV_IDX: [i16; 32] = [
1, 3, 5, 7, 9, 11, 13, 15, 17, 19, 21, 23, 25, 27, 29, 31,
1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
];
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
unsafe fn unpack_y2xx_32px_avx512(
ptr: *const u16,
shr_count: __m128i,
) -> (__m512i, __m512i, __m512i) {
unsafe {
let v0 = _mm512_loadu_si512(ptr.cast());
let v1 = _mm512_loadu_si512(ptr.add(32).cast());
let y_idx = _mm512_loadu_si512(Y_FROM_YUYV_IDX.as_ptr().cast());
let chroma_idx = _mm512_loadu_si512(CHROMA_FROM_YUYV_IDX.as_ptr().cast());
let y_raw = _mm512_permutex2var_epi16(v0, y_idx, v1);
let chroma_raw = _mm512_permutex2var_epi16(v0, chroma_idx, v1);
let y_vec = _mm512_srl_epi16(y_raw, shr_count);
let chroma = _mm512_srl_epi16(chroma_raw, shr_count);
let u_idx = _mm512_loadu_si512(U_FROM_UV_IDX.as_ptr().cast());
let v_idx = _mm512_loadu_si512(V_FROM_UV_IDX.as_ptr().cast());
let u_vec = _mm512_permutexvar_epi16(u_idx, chroma);
let v_vec = _mm512_permutexvar_epi16(v_idx, chroma);
(y_vec, u_vec, v_vec)
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn y2xx_n_to_rgb_or_rgba_row<
const BITS: u32,
const ALPHA: bool,
const BE: bool,
>(
packed: &[u16],
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const {
assert!(
BITS == 10 || BITS == 12,
"y2xx_n_to_rgb_or_rgba_row requires BITS in {{10, 12}}"
);
}
debug_assert!(width.is_multiple_of(2), "Y2xx requires even width");
debug_assert!(packed.len() >= width * 2);
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(out.len() >= width * bpp);
let coeffs = scalar::Coefficients::for_matrix(matrix);
let (y_off, y_scale, c_scale) = scalar::range_params_n::<BITS, 8>(full_range);
let bias = scalar::chroma_bias::<BITS>();
const RND: i32 = 1 << 14;
unsafe {
let mut x = 0usize;
if BE == HOST_NATIVE_BE {
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 shr_count = _mm_cvtsi32_si128((16 - BITS) as i32);
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 dup_lo_idx = _mm512_setr_epi64(0, 1, 8, 9, 2, 3, 10, 11);
let dup_hi_idx = _mm512_setr_epi64(4, 5, 12, 13, 6, 7, 14, 15);
while x + 32 <= width {
let (y_vec, u_vec, v_vec) = unpack_y2xx_32px_avx512(packed.as_ptr().add(x * 2), shr_count);
let y_i16 = y_vec;
let u_i16 = _mm512_sub_epi16(u_vec, bias_v);
let v_i16 = _mm512_sub_epi16(v_vec, bias_v);
let u_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(u_i16));
let u_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(u_i16));
let v_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(v_i16));
let v_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(v_i16));
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 (r_dup_lo, _r_dup_hi) = chroma_dup(r_chroma, dup_lo_idx, dup_hi_idx);
let (g_dup_lo, _g_dup_hi) = chroma_dup(g_chroma, dup_lo_idx, dup_hi_idx);
let (b_dup_lo, _b_dup_hi) = chroma_dup(b_chroma, dup_lo_idx, dup_hi_idx);
let y_scaled = scale_y(y_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let r_sum = _mm512_adds_epi16(y_scaled, r_dup_lo);
let g_sum = _mm512_adds_epi16(y_scaled, g_dup_lo);
let b_sum = _mm512_adds_epi16(y_scaled, b_dup_lo);
let zero = _mm512_setzero_si512();
let r_u8 = narrow_u8x64(r_sum, zero, pack_fixup);
let g_u8 = narrow_u8x64(g_sum, zero, pack_fixup);
let b_u8 = narrow_u8x64(b_sum, zero, pack_fixup);
if ALPHA {
let alpha = _mm_set1_epi8(-1);
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 * 2..width * 2];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
scalar::y2xx_n_to_rgb_or_rgba_row::<BITS, ALPHA, BE>(
tail_packed,
tail_out,
tail_w,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn y2xx_n_to_rgb_u16_or_rgba_u16_row<
const BITS: u32,
const ALPHA: bool,
const BE: bool,
>(
packed: &[u16],
out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const {
assert!(
BITS == 10 || BITS == 12,
"y2xx_n_to_rgb_u16_or_rgba_u16_row requires BITS in {{10, 12}}"
);
}
debug_assert!(width.is_multiple_of(2), "Y2xx requires even width");
debug_assert!(packed.len() >= width * 2);
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(out.len() >= width * bpp);
let coeffs = scalar::Coefficients::for_matrix(matrix);
let (y_off, y_scale, c_scale) = scalar::range_params_n::<BITS, BITS>(full_range);
let bias = scalar::chroma_bias::<BITS>();
const RND: i32 = 1 << 14;
let out_max: i16 = ((1i32 << BITS) - 1) as i16;
unsafe {
let mut x = 0usize;
if BE == HOST_NATIVE_BE {
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 shr_count = _mm_cvtsi32_si128((16 - BITS) as i32);
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 dup_lo_idx = _mm512_setr_epi64(0, 1, 8, 9, 2, 3, 10, 11);
let dup_hi_idx = _mm512_setr_epi64(4, 5, 12, 13, 6, 7, 14, 15);
while x + 32 <= width {
let (y_vec, u_vec, v_vec) = unpack_y2xx_32px_avx512(packed.as_ptr().add(x * 2), shr_count);
let y_i16 = y_vec;
let u_i16 = _mm512_sub_epi16(u_vec, bias_v);
let v_i16 = _mm512_sub_epi16(v_vec, bias_v);
let u_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(u_i16));
let u_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(u_i16));
let v_lo_i32 = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(v_i16));
let v_hi_i32 = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(v_i16));
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 (r_dup_lo, _r_dup_hi) = chroma_dup(r_chroma, dup_lo_idx, dup_hi_idx);
let (g_dup_lo, _g_dup_hi) = chroma_dup(g_chroma, dup_lo_idx, dup_hi_idx);
let (b_dup_lo, _b_dup_hi) = chroma_dup(b_chroma, dup_lo_idx, dup_hi_idx);
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_dup_lo), zero_v, max_v);
let g = clamp_u16_max_x32(_mm512_adds_epi16(y_scaled, g_dup_lo), zero_v, max_v);
let b = clamp_u16_max_x32(_mm512_adds_epi16(y_scaled, b_dup_lo), zero_v, max_v);
if ALPHA {
let alpha_u16 = _mm_set1_epi16(out_max);
write_rgba_u16_32(r, g, b, alpha_u16, out.as_mut_ptr().add(x * 4));
} 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 * 2..width * 2];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
scalar::y2xx_n_to_rgb_u16_or_rgba_u16_row::<BITS, ALPHA, BE>(
tail_packed,
tail_out,
tail_w,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn y2xx_n_to_luma_row<const BITS: u32, const BE: bool>(
packed: &[u16],
luma_out: &mut [u8],
width: usize,
) {
const {
assert!(
BITS == 10 || BITS == 12,
"y2xx_n_to_luma_row requires BITS in {{10, 12}}"
);
}
debug_assert!(width.is_multiple_of(2), "Y2xx requires even width");
debug_assert!(packed.len() >= width * 2);
debug_assert!(luma_out.len() >= width);
unsafe {
let mut x = 0usize;
if BE == HOST_NATIVE_BE {
let pack_fixup = _mm512_setr_epi64(0, 2, 4, 6, 1, 3, 5, 7);
let zero = _mm512_setzero_si512();
let y_idx = _mm512_loadu_si512(Y_FROM_YUYV_IDX.as_ptr().cast());
while x + 32 <= width {
let v0 = _mm512_loadu_si512(packed.as_ptr().add(x * 2).cast());
let v1 = _mm512_loadu_si512(packed.as_ptr().add(x * 2 + 32).cast());
let y_raw = _mm512_permutex2var_epi16(v0, y_idx, v1);
let y_shr = _mm512_srli_epi16::<8>(y_raw);
let y_u8 = narrow_u8x64(y_shr, zero, pack_fixup);
_mm256_storeu_si256(
luma_out.as_mut_ptr().add(x).cast(),
_mm512_castsi512_si256(y_u8),
);
x += 32;
}
}
if x < width {
let tail_packed = &packed[x * 2..width * 2];
let tail_out = &mut luma_out[x..width];
let tail_w = width - x;
scalar::y2xx_n_to_luma_row::<BITS, BE>(tail_packed, tail_out, tail_w);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn y2xx_n_to_luma_u16_row<const BITS: u32, const BE: bool>(
packed: &[u16],
luma_out: &mut [u16],
width: usize,
) {
const {
assert!(
BITS == 10 || BITS == 12,
"y2xx_n_to_luma_u16_row requires BITS in {{10, 12}}"
);
}
debug_assert!(width.is_multiple_of(2), "Y2xx requires even width");
debug_assert!(packed.len() >= width * 2);
debug_assert!(luma_out.len() >= width);
unsafe {
let mut x = 0usize;
if BE == HOST_NATIVE_BE {
let shr_count = _mm_cvtsi32_si128((16 - BITS) as i32);
let y_idx = _mm512_loadu_si512(Y_FROM_YUYV_IDX.as_ptr().cast());
while x + 32 <= width {
let v0 = _mm512_loadu_si512(packed.as_ptr().add(x * 2).cast());
let v1 = _mm512_loadu_si512(packed.as_ptr().add(x * 2 + 32).cast());
let y_raw = _mm512_permutex2var_epi16(v0, y_idx, v1);
let y_low = _mm512_srl_epi16(y_raw, shr_count);
_mm512_storeu_si512(luma_out.as_mut_ptr().add(x).cast(), y_low);
x += 32;
}
}
if x < width {
let tail_packed = &packed[x * 2..width * 2];
let tail_out = &mut luma_out[x..width];
let tail_w = width - x;
scalar::y2xx_n_to_luma_u16_row::<BITS, BE>(tail_packed, tail_out, tail_w);
}
}
}