use core::arch::x86_64::*;
use super::{endian, *};
use crate::{ColorMatrix, row::scalar};
#[inline]
#[target_feature(enable = "avx2")]
unsafe fn deinterleave_ayuv64_16px_avx2<const BE: bool>(
ptr: *const u16,
) -> (__m256i, __m256i, __m256i, __m256i) {
unsafe {
let raw_c0 = endian::load_endian_u16x16::<BE>(ptr as *const u8);
let raw_c1 = endian::load_endian_u16x16::<BE>(ptr.add(16) as *const u8);
let raw_c2 = endian::load_endian_u16x16::<BE>(ptr.add(32) as *const u8);
let raw_c3 = endian::load_endian_u16x16::<BE>(ptr.add(48) as *const u8);
let raw0 = _mm256_permute2x128_si256::<0x20>(raw_c0, raw_c2);
let raw1 = _mm256_permute2x128_si256::<0x31>(raw_c0, raw_c2);
let raw2 = _mm256_permute2x128_si256::<0x20>(raw_c1, raw_c3);
let raw3 = _mm256_permute2x128_si256::<0x31>(raw_c1, raw_c3);
let s1_lo = _mm256_unpacklo_epi16(raw0, raw1);
let s1_hi = _mm256_unpackhi_epi16(raw0, raw1);
let s2_lo = _mm256_unpacklo_epi16(raw2, raw3);
let s2_hi = _mm256_unpackhi_epi16(raw2, raw3);
let s3_lo = _mm256_unpacklo_epi16(s1_lo, s1_hi);
let s3_hi = _mm256_unpackhi_epi16(s1_lo, s1_hi);
let s4_lo = _mm256_unpacklo_epi16(s2_lo, s2_hi);
let s4_hi = _mm256_unpackhi_epi16(s2_lo, s2_hi);
let a_vec = _mm256_unpacklo_epi64(s3_lo, s4_lo);
let y_vec = _mm256_unpackhi_epi64(s3_lo, s4_lo);
let u_vec = _mm256_unpacklo_epi64(s3_hi, s4_hi);
let v_vec = _mm256_unpackhi_epi64(s3_hi, s4_hi);
(a_vec, y_vec, u_vec, v_vec)
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_rgb_or_rgba_row<
const ALPHA: bool,
const ALPHA_SRC: bool,
const BE: bool,
>(
packed: &[u16],
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const { assert!(!ALPHA_SRC || ALPHA) };
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::<16, 8>(full_range);
const RND: i32 = 1 << 14;
unsafe {
let rnd_v = _mm256_set1_epi32(RND);
let y_off_v = _mm256_set1_epi32(y_off);
let y_scale_v = _mm256_set1_epi32(y_scale);
let c_scale_v = _mm256_set1_epi32(c_scale);
let bias16_v = _mm256_set1_epi16(-32768i16);
let cru = _mm256_set1_epi32(coeffs.r_u());
let crv = _mm256_set1_epi32(coeffs.r_v());
let cgu = _mm256_set1_epi32(coeffs.g_u());
let cgv = _mm256_set1_epi32(coeffs.g_v());
let cbu = _mm256_set1_epi32(coeffs.b_u());
let cbv = _mm256_set1_epi32(coeffs.b_v());
let alpha_u8 = _mm256_set1_epi8(-1i8);
let mut x = 0usize;
while x + 32 <= width {
let (a_lo_u16, y_lo_u16, u_lo_u16, v_lo_u16) =
deinterleave_ayuv64_16px_avx2::<BE>(packed.as_ptr().add(x * 4));
let u_lo_i16 = _mm256_sub_epi16(u_lo_u16, bias16_v);
let v_lo_i16 = _mm256_sub_epi16(v_lo_u16, bias16_v);
let u_lo_a = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(u_lo_i16));
let u_lo_b = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(u_lo_i16));
let v_lo_a = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(v_lo_i16));
let v_lo_b = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(v_lo_i16));
let u_d_lo_a = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_lo_a, c_scale_v),
rnd_v,
));
let u_d_lo_b = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_lo_b, c_scale_v),
rnd_v,
));
let v_d_lo_a = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_lo_a, c_scale_v),
rnd_v,
));
let v_d_lo_b = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_lo_b, c_scale_v),
rnd_v,
));
let r_chroma_lo = chroma_i16x16(cru, crv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, rnd_v);
let g_chroma_lo = chroma_i16x16(cgu, cgv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, rnd_v);
let b_chroma_lo = chroma_i16x16(cbu, cbv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, rnd_v);
let y_lo_scaled = scale_y_u16_avx2(y_lo_u16, y_off_v, y_scale_v, rnd_v);
let (a_hi_u16, y_hi_u16, u_hi_u16, v_hi_u16) =
deinterleave_ayuv64_16px_avx2::<BE>(packed.as_ptr().add(x * 4 + 64));
let u_hi_i16 = _mm256_sub_epi16(u_hi_u16, bias16_v);
let v_hi_i16 = _mm256_sub_epi16(v_hi_u16, bias16_v);
let u_hi_a = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(u_hi_i16));
let u_hi_b = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(u_hi_i16));
let v_hi_a = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(v_hi_i16));
let v_hi_b = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(v_hi_i16));
let u_d_hi_a = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_hi_a, c_scale_v),
rnd_v,
));
let u_d_hi_b = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_hi_b, c_scale_v),
rnd_v,
));
let v_d_hi_a = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_hi_a, c_scale_v),
rnd_v,
));
let v_d_hi_b = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_hi_b, c_scale_v),
rnd_v,
));
let r_chroma_hi = chroma_i16x16(cru, crv, u_d_hi_a, v_d_hi_a, u_d_hi_b, v_d_hi_b, rnd_v);
let g_chroma_hi = chroma_i16x16(cgu, cgv, u_d_hi_a, v_d_hi_a, u_d_hi_b, v_d_hi_b, rnd_v);
let b_chroma_hi = chroma_i16x16(cbu, cbv, u_d_hi_a, v_d_hi_a, u_d_hi_b, v_d_hi_b, rnd_v);
let y_hi_scaled = scale_y_u16_avx2(y_hi_u16, y_off_v, y_scale_v, rnd_v);
let r_u8 = narrow_u8x32(
_mm256_adds_epi16(y_lo_scaled, r_chroma_lo),
_mm256_adds_epi16(y_hi_scaled, r_chroma_hi),
);
let g_u8 = narrow_u8x32(
_mm256_adds_epi16(y_lo_scaled, g_chroma_lo),
_mm256_adds_epi16(y_hi_scaled, g_chroma_hi),
);
let b_u8 = narrow_u8x32(
_mm256_adds_epi16(y_lo_scaled, b_chroma_lo),
_mm256_adds_epi16(y_hi_scaled, b_chroma_hi),
);
let out_ptr = out.as_mut_ptr().add(x * bpp);
if ALPHA {
let a_vec: __m256i = if ALPHA_SRC {
let a_lo_shr = _mm256_srli_epi16::<8>(a_lo_u16);
let a_hi_shr = _mm256_srli_epi16::<8>(a_hi_u16);
narrow_u8x32(a_lo_shr, a_hi_shr)
} else {
alpha_u8 };
write_rgba_32(r_u8, g_u8, b_u8, a_vec, out_ptr);
} else {
write_rgb_32(r_u8, g_u8, b_u8, out_ptr);
}
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::ayuv64_to_rgb_or_rgba_row::<ALPHA, ALPHA_SRC, BE>(
tail_packed,
tail_out,
tail_w,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_rgb_u16_or_rgba_u16_row<
const ALPHA: bool,
const ALPHA_SRC: bool,
const BE: bool,
>(
packed: &[u16],
out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const { assert!(!ALPHA_SRC || ALPHA) };
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::<16, 16>(full_range);
const RND: i64 = 1 << 14;
unsafe {
let alpha_u16 = _mm_set1_epi16(-1i16); let rnd_v = _mm256_set1_epi64x(RND);
let rnd32_v = _mm256_set1_epi32(1 << 14);
let y_off_v = _mm256_set1_epi32(y_off);
let y_scale_v = _mm256_set1_epi32(y_scale);
let c_scale_v = _mm256_set1_epi32(c_scale);
let bias16_v = _mm256_set1_epi16(-32768i16);
let cru = _mm256_set1_epi32(coeffs.r_u());
let crv = _mm256_set1_epi32(coeffs.r_v());
let cgu = _mm256_set1_epi32(coeffs.g_u());
let cgv = _mm256_set1_epi32(coeffs.g_v());
let cbu = _mm256_set1_epi32(coeffs.b_u());
let cbv = _mm256_set1_epi32(coeffs.b_v());
let mut x = 0usize;
while x + 16 <= width {
let (a_u16, y_vec, u_u16, v_u16) =
deinterleave_ayuv64_16px_avx2::<BE>(packed.as_ptr().add(x * 4));
let u_i16 = _mm256_sub_epi16(u_u16, bias16_v);
let v_i16 = _mm256_sub_epi16(v_u16, bias16_v);
let u_lo_i32 = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(u_i16));
let v_lo_i32 = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(v_i16));
let u_d_lo = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_lo_i32, c_scale_v),
rnd32_v,
));
let v_d_lo = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_lo_i32, c_scale_v),
rnd32_v,
));
let u_hi_i32 = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(u_i16));
let v_hi_i32 = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(v_i16));
let u_d_hi = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_hi_i32, c_scale_v),
rnd32_v,
));
let v_d_hi = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_hi_i32, c_scale_v),
rnd32_v,
));
let u_d_lo_odd = _mm256_shuffle_epi32::<0xF5>(u_d_lo);
let v_d_lo_odd = _mm256_shuffle_epi32::<0xF5>(v_d_lo);
let u_d_hi_odd = _mm256_shuffle_epi32::<0xF5>(u_d_hi);
let v_d_hi_odd = _mm256_shuffle_epi32::<0xF5>(v_d_hi);
let r_ch_lo_even = chroma_i64x4_avx2(cru, crv, u_d_lo, v_d_lo, rnd_v);
let r_ch_lo_odd = chroma_i64x4_avx2(cru, crv, u_d_lo_odd, v_d_lo_odd, rnd_v);
let g_ch_lo_even = chroma_i64x4_avx2(cgu, cgv, u_d_lo, v_d_lo, rnd_v);
let g_ch_lo_odd = chroma_i64x4_avx2(cgu, cgv, u_d_lo_odd, v_d_lo_odd, rnd_v);
let b_ch_lo_even = chroma_i64x4_avx2(cbu, cbv, u_d_lo, v_d_lo, rnd_v);
let b_ch_lo_odd = chroma_i64x4_avx2(cbu, cbv, u_d_lo_odd, v_d_lo_odd, rnd_v);
let r_ch_hi_even = chroma_i64x4_avx2(cru, crv, u_d_hi, v_d_hi, rnd_v);
let r_ch_hi_odd = chroma_i64x4_avx2(cru, crv, u_d_hi_odd, v_d_hi_odd, rnd_v);
let g_ch_hi_even = chroma_i64x4_avx2(cgu, cgv, u_d_hi, v_d_hi, rnd_v);
let g_ch_hi_odd = chroma_i64x4_avx2(cgu, cgv, u_d_hi_odd, v_d_hi_odd, rnd_v);
let b_ch_hi_even = chroma_i64x4_avx2(cbu, cbv, u_d_hi, v_d_hi, rnd_v);
let b_ch_hi_odd = chroma_i64x4_avx2(cbu, cbv, u_d_hi_odd, v_d_hi_odd, rnd_v);
let r_ch_lo_i32 = reassemble_i64x4_to_i32x8(r_ch_lo_even, r_ch_lo_odd);
let g_ch_lo_i32 = reassemble_i64x4_to_i32x8(g_ch_lo_even, g_ch_lo_odd);
let b_ch_lo_i32 = reassemble_i64x4_to_i32x8(b_ch_lo_even, b_ch_lo_odd);
let r_ch_hi_i32 = reassemble_i64x4_to_i32x8(r_ch_hi_even, r_ch_hi_odd);
let g_ch_hi_i32 = reassemble_i64x4_to_i32x8(g_ch_hi_even, g_ch_hi_odd);
let b_ch_hi_i32 = reassemble_i64x4_to_i32x8(b_ch_hi_even, b_ch_hi_odd);
let y_lo_u16 = _mm256_castsi256_si128(y_vec);
let y_hi_u16 = _mm256_extracti128_si256::<1>(y_vec);
let y_lo_i32 = _mm256_sub_epi32(_mm256_cvtepu16_epi32(y_lo_u16), y_off_v);
let y_hi_i32 = _mm256_sub_epi32(_mm256_cvtepu16_epi32(y_hi_u16), y_off_v);
let y_lo_scaled = scale_y_i32x8_i64(y_lo_i32, y_scale_v, rnd_v);
let y_hi_scaled = scale_y_i32x8_i64(y_hi_i32, y_scale_v, rnd_v);
let r_u16 = _mm256_permute4x64_epi64::<0xD8>(_mm256_packus_epi32(
_mm256_add_epi32(y_lo_scaled, r_ch_lo_i32),
_mm256_add_epi32(y_hi_scaled, r_ch_hi_i32),
));
let g_u16 = _mm256_permute4x64_epi64::<0xD8>(_mm256_packus_epi32(
_mm256_add_epi32(y_lo_scaled, g_ch_lo_i32),
_mm256_add_epi32(y_hi_scaled, g_ch_hi_i32),
));
let b_u16 = _mm256_permute4x64_epi64::<0xD8>(_mm256_packus_epi32(
_mm256_add_epi32(y_lo_scaled, b_ch_lo_i32),
_mm256_add_epi32(y_hi_scaled, b_ch_hi_i32),
));
if ALPHA {
let dst = out.as_mut_ptr().add(x * 4);
let (a_lo, a_hi) = if ALPHA_SRC {
(
_mm256_castsi256_si128(a_u16),
_mm256_extracti128_si256::<1>(a_u16),
)
} else {
(alpha_u16, alpha_u16)
};
write_rgba_u16_8(
_mm256_castsi256_si128(r_u16),
_mm256_castsi256_si128(g_u16),
_mm256_castsi256_si128(b_u16),
a_lo,
dst,
);
write_rgba_u16_8(
_mm256_extracti128_si256::<1>(r_u16),
_mm256_extracti128_si256::<1>(g_u16),
_mm256_extracti128_si256::<1>(b_u16),
a_hi,
dst.add(32),
);
} else {
let dst = out.as_mut_ptr().add(x * 3);
write_rgb_u16_8(
_mm256_castsi256_si128(r_u16),
_mm256_castsi256_si128(g_u16),
_mm256_castsi256_si128(b_u16),
dst,
);
write_rgb_u16_8(
_mm256_extracti128_si256::<1>(r_u16),
_mm256_extracti128_si256::<1>(g_u16),
_mm256_extracti128_si256::<1>(b_u16),
dst.add(24),
);
}
x += 16;
}
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::ayuv64_to_rgb_u16_or_rgba_u16_row::<ALPHA, ALPHA_SRC, BE>(
tail_packed,
tail_out,
tail_w,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_rgb_row<const BE: bool>(
packed: &[u16],
rgb_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
ayuv64_to_rgb_or_rgba_row::<false, false, BE>(packed, rgb_out, width, matrix, full_range);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_rgba_row<const BE: bool>(
packed: &[u16],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
ayuv64_to_rgb_or_rgba_row::<true, true, BE>(packed, rgba_out, width, matrix, full_range);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_rgb_u16_row<const BE: bool>(
packed: &[u16],
rgb_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
ayuv64_to_rgb_u16_or_rgba_u16_row::<false, false, BE>(
packed, rgb_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_rgba_u16_row<const BE: bool>(
packed: &[u16],
rgba_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
ayuv64_to_rgb_u16_or_rgba_u16_row::<true, true, BE>(
packed, rgba_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_luma_row<const BE: bool>(
packed: &[u16],
luma_out: &mut [u8],
width: usize,
) {
debug_assert!(packed.len() >= width * 4, "packed row too short");
debug_assert!(luma_out.len() >= width, "luma row too short");
unsafe {
let mut x = 0usize;
while x + 16 <= width {
let (_a, y_vec, _u, _v) = deinterleave_ayuv64_16px_avx2::<BE>(packed.as_ptr().add(x * 4));
let y_shr = _mm256_srli_epi16::<8>(y_vec);
let zero = _mm256_setzero_si256();
let y_u8 = narrow_u8x32(y_shr, zero);
let mut tmp = [0u8; 32];
_mm256_storeu_si256(tmp.as_mut_ptr().cast(), y_u8);
luma_out[x..x + 16].copy_from_slice(&tmp[..16]);
x += 16;
}
if x < width {
scalar::ayuv64_to_luma_row::<BE>(
&packed[x * 4..width * 4],
&mut luma_out[x..width],
width - x,
);
}
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn ayuv64_to_luma_u16_row<const BE: bool>(
packed: &[u16],
luma_out: &mut [u16],
width: usize,
) {
debug_assert!(packed.len() >= width * 4, "packed row too short");
debug_assert!(luma_out.len() >= width, "luma row too short");
unsafe {
let mut x = 0usize;
while x + 16 <= width {
let (_a, y_vec, _u, _v) = deinterleave_ayuv64_16px_avx2::<BE>(packed.as_ptr().add(x * 4));
_mm256_storeu_si256(luma_out.as_mut_ptr().add(x).cast(), y_vec);
x += 16;
}
if x < width {
scalar::ayuv64_to_luma_u16_row::<BE>(
&packed[x * 4..width * 4],
&mut luma_out[x..width],
width - x,
);
}
}
}