use core::arch::x86_64::*;
use super::*;
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_420_to_rgb_row(
y: &[u8],
u_half: &[u8],
v_half: &[u8],
rgb_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420_to_rgb_or_rgba_row::<false, false>(
y, u_half, v_half, None, rgb_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_420_to_rgba_row(
y: &[u8],
u_half: &[u8],
v_half: &[u8],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420_to_rgb_or_rgba_row::<true, false>(
y, u_half, v_half, None, rgba_out, width, matrix, full_range,
);
}
}
#[cfg(feature = "yuva")]
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_420_to_rgba_with_alpha_src_row(
y: &[u8],
u_half: &[u8],
v_half: &[u8],
a_src: &[u8],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420_to_rgb_or_rgba_row::<true, true>(
y,
u_half,
v_half,
Some(a_src),
rgba_out,
width,
matrix,
full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
#[allow(clippy::too_many_arguments)]
unsafe fn yuv_420_to_rgb_or_rgba_row<const ALPHA: bool, const ALPHA_SRC: bool>(
y: &[u8],
u_half: &[u8],
v_half: &[u8],
a_src: Option<&[u8]>,
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const { assert!(!ALPHA_SRC || ALPHA) };
debug_assert_eq!(width & 1, 0, "YUV 4:2:0 requires even width");
debug_assert!(y.len() >= width);
debug_assert!(u_half.len() >= width / 2);
debug_assert!(v_half.len() >= width / 2);
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(out.len() >= width * bpp);
if ALPHA_SRC {
debug_assert!(a_src.as_ref().is_some_and(|s| s.len() >= width));
}
let coeffs = scalar::Coefficients::for_matrix(matrix);
let (y_off, y_scale, c_scale) = scalar::range_params_n::<8, 8>(full_range);
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 mid128 = _mm512_set1_epi16(128);
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 alpha_u8 = _mm512_set1_epi8(-1);
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);
let mut x = 0usize;
while x + 64 <= width {
let y_vec = _mm512_loadu_si512(y.as_ptr().add(x).cast());
let u_vec_256 = _mm256_loadu_si256(u_half.as_ptr().add(x / 2).cast());
let v_vec_256 = _mm256_loadu_si256(v_half.as_ptr().add(x / 2).cast());
let u_i16 = _mm512_sub_epi16(_mm512_cvtepu8_epi16(u_vec_256), mid128);
let v_i16 = _mm512_sub_epi16(_mm512_cvtepu8_epi16(v_vec_256), mid128);
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_low_i16 = _mm512_cvtepu8_epi16(_mm512_castsi512_si256(y_vec));
let y_high_i16 = _mm512_cvtepu8_epi16(_mm512_extracti64x4_epi64::<1>(y_vec));
let y_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let b_lo = _mm512_adds_epi16(y_scaled_lo, b_dup_lo);
let b_hi = _mm512_adds_epi16(y_scaled_hi, b_dup_hi);
let g_lo = _mm512_adds_epi16(y_scaled_lo, g_dup_lo);
let g_hi = _mm512_adds_epi16(y_scaled_hi, g_dup_hi);
let r_lo = _mm512_adds_epi16(y_scaled_lo, r_dup_lo);
let r_hi = _mm512_adds_epi16(y_scaled_hi, r_dup_hi);
let b_u8 = narrow_u8x64(b_lo, b_hi, pack_fixup);
let g_u8 = narrow_u8x64(g_lo, g_hi, pack_fixup);
let r_u8 = narrow_u8x64(r_lo, r_hi, pack_fixup);
if ALPHA {
let a_u8 = if ALPHA_SRC {
_mm512_loadu_si512(a_src.as_ref().unwrap_unchecked().as_ptr().add(x).cast())
} else {
alpha_u8
};
write_rgba_64(r_u8, g_u8, b_u8, a_u8, out.as_mut_ptr().add(x * 4));
} else {
write_rgb_64(r_u8, g_u8, b_u8, out.as_mut_ptr().add(x * 3));
}
x += 64;
}
if x < width {
let tail_a = if ALPHA_SRC {
Some(&a_src.as_ref().unwrap_unchecked()[x..width])
} else {
None
};
scalar::yuv_420_to_rgb_or_rgba_row::<ALPHA, ALPHA_SRC>(
&y[x..width],
&u_half[x / 2..width / 2],
&v_half[x / 2..width / 2],
tail_a,
&mut out[x * bpp..width * bpp],
width - x,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_410_to_rgb_row(
y: &[u8],
u_quarter: &[u8],
v_quarter: &[u8],
rgb_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_410_to_rgb_or_rgba_row::<false>(
y, u_quarter, v_quarter, rgb_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_410_to_rgba_row(
y: &[u8],
u_quarter: &[u8],
v_quarter: &[u8],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_410_to_rgb_or_rgba_row::<true>(
y, u_quarter, v_quarter, rgba_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
unsafe fn yuv_410_to_rgb_or_rgba_row<const ALPHA: bool>(
y: &[u8],
u_quarter: &[u8],
v_quarter: &[u8],
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
debug_assert_eq!(width & 3, 0, "YUV 4:1:0 requires width % 4 == 0");
debug_assert!(y.len() >= width);
debug_assert!(u_quarter.len() >= width / 4);
debug_assert!(v_quarter.len() >= width / 4);
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::<8, 8>(full_range);
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 mid128_256 = _mm256_set1_epi16(128);
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 alpha_u8 = _mm512_set1_epi8(-1);
let pack_fixup = _mm512_setr_epi64(0, 2, 4, 6, 1, 3, 5, 7);
#[rustfmt::skip]
let dup_lo_idx = _mm512_set_epi16(
7, 7, 7, 7, 6, 6, 6, 6, 5, 5, 5, 5, 4, 4, 4, 4,
3, 3, 3, 3, 2, 2, 2, 2, 1, 1, 1, 1, 0, 0, 0, 0,
);
#[rustfmt::skip]
let dup_hi_idx = _mm512_set_epi16(
15, 15, 15, 15, 14, 14, 14, 14, 13, 13, 13, 13, 12, 12, 12, 12,
11, 11, 11, 11, 10, 10, 10, 10, 9, 9, 9, 9, 8, 8, 8, 8,
);
let mut x = 0usize;
while x + 64 <= width {
let y_vec = _mm512_loadu_si512(y.as_ptr().add(x).cast());
let u_xmm = _mm_loadu_si128(u_quarter.as_ptr().add(x / 4).cast());
let v_xmm = _mm_loadu_si128(v_quarter.as_ptr().add(x / 4).cast());
let u_i16x16 = _mm256_sub_epi16(_mm256_cvtepu8_epi16(u_xmm), mid128_256);
let v_i16x16 = _mm256_sub_epi16(_mm256_cvtepu8_epi16(v_xmm), mid128_256);
let u_i32x16 = _mm512_cvtepi16_epi32(u_i16x16);
let v_i32x16 = _mm512_cvtepi16_epi32(v_i16x16);
let u_d = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_i32x16, c_scale_v),
rnd_v,
));
let v_d = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_i32x16, c_scale_v),
rnd_v,
));
let r_i32 = q15_shift(_mm512_add_epi32(
_mm512_add_epi32(_mm512_mullo_epi32(cru, u_d), _mm512_mullo_epi32(crv, v_d)),
rnd_v,
));
let g_i32 = q15_shift(_mm512_add_epi32(
_mm512_add_epi32(_mm512_mullo_epi32(cgu, u_d), _mm512_mullo_epi32(cgv, v_d)),
rnd_v,
));
let b_i32 = q15_shift(_mm512_add_epi32(
_mm512_add_epi32(_mm512_mullo_epi32(cbu, u_d), _mm512_mullo_epi32(cbv, v_d)),
rnd_v,
));
let r_packed = _mm512_permutexvar_epi64(pack_fixup, _mm512_packs_epi32(r_i32, r_i32));
let g_packed = _mm512_permutexvar_epi64(pack_fixup, _mm512_packs_epi32(g_i32, g_i32));
let b_packed = _mm512_permutexvar_epi64(pack_fixup, _mm512_packs_epi32(b_i32, b_i32));
let r_dup_lo = _mm512_permutexvar_epi16(dup_lo_idx, r_packed);
let r_dup_hi = _mm512_permutexvar_epi16(dup_hi_idx, r_packed);
let g_dup_lo = _mm512_permutexvar_epi16(dup_lo_idx, g_packed);
let g_dup_hi = _mm512_permutexvar_epi16(dup_hi_idx, g_packed);
let b_dup_lo = _mm512_permutexvar_epi16(dup_lo_idx, b_packed);
let b_dup_hi = _mm512_permutexvar_epi16(dup_hi_idx, b_packed);
let y_low_i16 = _mm512_cvtepu8_epi16(_mm512_castsi512_si256(y_vec));
let y_high_i16 = _mm512_cvtepu8_epi16(_mm512_extracti64x4_epi64::<1>(y_vec));
let y_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let b_lo = _mm512_adds_epi16(y_scaled_lo, b_dup_lo);
let b_hi = _mm512_adds_epi16(y_scaled_hi, b_dup_hi);
let g_lo = _mm512_adds_epi16(y_scaled_lo, g_dup_lo);
let g_hi = _mm512_adds_epi16(y_scaled_hi, g_dup_hi);
let r_lo = _mm512_adds_epi16(y_scaled_lo, r_dup_lo);
let r_hi = _mm512_adds_epi16(y_scaled_hi, r_dup_hi);
let b_u8 = narrow_u8x64(b_lo, b_hi, pack_fixup);
let g_u8 = narrow_u8x64(g_lo, g_hi, pack_fixup);
let r_u8 = narrow_u8x64(r_lo, r_hi, pack_fixup);
if ALPHA {
write_rgba_64(r_u8, g_u8, b_u8, alpha_u8, out.as_mut_ptr().add(x * 4));
} else {
write_rgb_64(r_u8, g_u8, b_u8, out.as_mut_ptr().add(x * 3));
}
x += 64;
}
if x < width {
scalar::yuv_410_to_rgb_or_rgba_row::<ALPHA>(
&y[x..width],
&u_quarter[x / 4..width / 4],
&v_quarter[x / 4..width / 4],
&mut out[x * bpp..width * bpp],
width - x,
matrix,
full_range,
);
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_444_to_rgb_row(
y: &[u8],
u: &[u8],
v: &[u8],
rgb_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444_to_rgb_or_rgba_row::<false, false>(y, u, v, None, rgb_out, width, matrix, full_range);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_444_to_rgba_row(
y: &[u8],
u: &[u8],
v: &[u8],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444_to_rgb_or_rgba_row::<true, false>(y, u, v, None, rgba_out, width, matrix, full_range);
}
}
#[cfg(feature = "yuva")]
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_444_to_rgba_with_alpha_src_row(
y: &[u8],
u: &[u8],
v: &[u8],
a_src: &[u8],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444_to_rgb_or_rgba_row::<true, true>(
y,
u,
v,
Some(a_src),
rgba_out,
width,
matrix,
full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
#[allow(clippy::too_many_arguments)]
unsafe fn yuv_444_to_rgb_or_rgba_row<const ALPHA: bool, const ALPHA_SRC: bool>(
y: &[u8],
u: &[u8],
v: &[u8],
a_src: Option<&[u8]>,
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const { assert!(!ALPHA_SRC || ALPHA) };
debug_assert!(y.len() >= width);
debug_assert!(u.len() >= width);
debug_assert!(v.len() >= width);
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(out.len() >= width * bpp);
if ALPHA_SRC {
debug_assert!(a_src.as_ref().is_some_and(|s| s.len() >= width));
}
let coeffs = scalar::Coefficients::for_matrix(matrix);
let (y_off, y_scale, c_scale) = scalar::range_params_n::<8, 8>(full_range);
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 mid128 = _mm512_set1_epi16(128);
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 alpha_u8 = _mm512_set1_epi8(-1);
let pack_fixup = _mm512_setr_epi64(0, 2, 4, 6, 1, 3, 5, 7);
let mut x = 0usize;
while x + 64 <= width {
let y_vec = _mm512_loadu_si512(y.as_ptr().add(x).cast());
let u_vec = _mm512_loadu_si512(u.as_ptr().add(x).cast());
let v_vec = _mm512_loadu_si512(v.as_ptr().add(x).cast());
let u_lo_i16 = _mm512_sub_epi16(_mm512_cvtepu8_epi16(_mm512_castsi512_si256(u_vec)), mid128);
let u_hi_i16 = _mm512_sub_epi16(
_mm512_cvtepu8_epi16(_mm512_extracti64x4_epi64::<1>(u_vec)),
mid128,
);
let v_lo_i16 = _mm512_sub_epi16(_mm512_cvtepu8_epi16(_mm512_castsi512_si256(v_vec)), mid128);
let v_hi_i16 = _mm512_sub_epi16(
_mm512_cvtepu8_epi16(_mm512_extracti64x4_epi64::<1>(v_vec)),
mid128,
);
let u_lo_a = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(u_lo_i16));
let u_lo_b = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(u_lo_i16));
let u_hi_a = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(u_hi_i16));
let u_hi_b = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(u_hi_i16));
let v_lo_a = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(v_lo_i16));
let v_lo_b = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(v_lo_i16));
let v_hi_a = _mm512_cvtepi16_epi32(_mm512_castsi512_si256(v_hi_i16));
let v_hi_b = _mm512_cvtepi16_epi32(_mm512_extracti64x4_epi64::<1>(v_hi_i16));
let u_d_lo_a = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_lo_a, c_scale_v),
rnd_v,
));
let u_d_lo_b = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_lo_b, c_scale_v),
rnd_v,
));
let u_d_hi_a = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_hi_a, c_scale_v),
rnd_v,
));
let u_d_hi_b = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_hi_b, c_scale_v),
rnd_v,
));
let v_d_lo_a = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_lo_a, c_scale_v),
rnd_v,
));
let v_d_lo_b = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_lo_b, c_scale_v),
rnd_v,
));
let v_d_hi_a = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_hi_a, c_scale_v),
rnd_v,
));
let v_d_hi_b = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_hi_b, c_scale_v),
rnd_v,
));
let r_chroma_lo = chroma_i16x32(
cru, crv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, rnd_v, pack_fixup,
);
let r_chroma_hi = chroma_i16x32(
cru, crv, u_d_hi_a, v_d_hi_a, u_d_hi_b, v_d_hi_b, rnd_v, pack_fixup,
);
let g_chroma_lo = chroma_i16x32(
cgu, cgv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, rnd_v, pack_fixup,
);
let g_chroma_hi = chroma_i16x32(
cgu, cgv, u_d_hi_a, v_d_hi_a, u_d_hi_b, v_d_hi_b, rnd_v, pack_fixup,
);
let b_chroma_lo = chroma_i16x32(
cbu, cbv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, rnd_v, pack_fixup,
);
let b_chroma_hi = chroma_i16x32(
cbu, cbv, u_d_hi_a, v_d_hi_a, u_d_hi_b, v_d_hi_b, rnd_v, pack_fixup,
);
let y_low_i16 = _mm512_cvtepu8_epi16(_mm512_castsi512_si256(y_vec));
let y_high_i16 = _mm512_cvtepu8_epi16(_mm512_extracti64x4_epi64::<1>(y_vec));
let y_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let b_lo = _mm512_adds_epi16(y_scaled_lo, b_chroma_lo);
let b_hi = _mm512_adds_epi16(y_scaled_hi, b_chroma_hi);
let g_lo = _mm512_adds_epi16(y_scaled_lo, g_chroma_lo);
let g_hi = _mm512_adds_epi16(y_scaled_hi, g_chroma_hi);
let r_lo = _mm512_adds_epi16(y_scaled_lo, r_chroma_lo);
let r_hi = _mm512_adds_epi16(y_scaled_hi, r_chroma_hi);
let b_u8 = narrow_u8x64(b_lo, b_hi, pack_fixup);
let g_u8 = narrow_u8x64(g_lo, g_hi, pack_fixup);
let r_u8 = narrow_u8x64(r_lo, r_hi, pack_fixup);
if ALPHA {
let a_u8 = if ALPHA_SRC {
_mm512_loadu_si512(a_src.as_ref().unwrap_unchecked().as_ptr().add(x).cast())
} else {
alpha_u8
};
write_rgba_64(r_u8, g_u8, b_u8, a_u8, out.as_mut_ptr().add(x * 4));
} else {
write_rgb_64(r_u8, g_u8, b_u8, out.as_mut_ptr().add(x * 3));
}
x += 64;
}
if x < width {
let tail_y = &y[x..width];
let tail_u = &u[x..width];
let tail_v = &v[x..width];
let tail_w = width - x;
let tail_out = &mut out[x * bpp..width * bpp];
if ALPHA_SRC {
let tail_a = &a_src.as_ref().unwrap_unchecked()[x..width];
scalar::yuv_444_to_rgba_with_alpha_src_row(
tail_y, tail_u, tail_v, tail_a, tail_out, tail_w, matrix, full_range,
);
} else if ALPHA {
scalar::yuv_444_to_rgba_row(tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range);
} else {
scalar::yuv_444_to_rgb_row(tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range);
}
}
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_411_to_rgb_row(
y: &[u8],
u_quarter: &[u8],
v_quarter: &[u8],
rgb_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_411_to_rgb_or_rgba_row::<false>(
y, u_quarter, v_quarter, rgb_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
pub(crate) unsafe fn yuv_411_to_rgba_row(
y: &[u8],
u_quarter: &[u8],
v_quarter: &[u8],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_411_to_rgb_or_rgba_row::<true>(
y, u_quarter, v_quarter, rgba_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx512f,avx512bw")]
unsafe fn yuv_411_to_rgb_or_rgba_row<const ALPHA: bool>(
y: &[u8],
u_quarter: &[u8],
v_quarter: &[u8],
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
debug_assert!(y.len() >= width);
debug_assert!(u_quarter.len() >= width.div_ceil(4));
debug_assert!(v_quarter.len() >= width.div_ceil(4));
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::<8, 8>(full_range);
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 mid128 = _mm512_set1_epi16(128);
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 alpha_u8 = _mm512_set1_epi8(-1);
let pack_fixup = _mm512_setr_epi64(0, 2, 4, 6, 1, 3, 5, 7);
let dup_lo32_idx = _mm512_set_epi16(
7, 7, 7, 7, 6, 6, 6, 6, 5, 5, 5, 5, 4, 4, 4, 4, 3, 3, 3, 3, 2, 2, 2, 2, 1, 1, 1, 1, 0, 0, 0,
0,
);
let dup_hi32_idx = _mm512_set_epi16(
15, 15, 15, 15, 14, 14, 14, 14, 13, 13, 13, 13, 12, 12, 12, 12, 11, 11, 11, 11, 10, 10, 10,
10, 9, 9, 9, 9, 8, 8, 8, 8,
);
let mut x = 0usize;
while x + 64 <= width {
let y_vec = _mm512_loadu_si512(y.as_ptr().add(x).cast());
let u_16 = _mm_loadu_si128(u_quarter.as_ptr().add(x / 4).cast());
let v_16 = _mm_loadu_si128(v_quarter.as_ptr().add(x / 4).cast());
let u_i16_256 = _mm256_sub_epi16(_mm256_cvtepu8_epi16(u_16), _mm512_castsi512_si256(mid128));
let v_i16_256 = _mm256_sub_epi16(_mm256_cvtepu8_epi16(v_16), _mm512_castsi512_si256(mid128));
let u_i32 = _mm512_cvtepi16_epi32(u_i16_256);
let v_i32 = _mm512_cvtepi16_epi32(v_i16_256);
let u_d = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(u_i32, c_scale_v),
rnd_v,
));
let v_d = q15_shift(_mm512_add_epi32(
_mm512_mullo_epi32(v_i32, c_scale_v),
rnd_v,
));
let r_i32 = q15_shift(_mm512_add_epi32(
_mm512_add_epi32(_mm512_mullo_epi32(cru, u_d), _mm512_mullo_epi32(crv, v_d)),
rnd_v,
));
let g_i32 = q15_shift(_mm512_add_epi32(
_mm512_add_epi32(_mm512_mullo_epi32(cgu, u_d), _mm512_mullo_epi32(cgv, v_d)),
rnd_v,
));
let b_i32 = q15_shift(_mm512_add_epi32(
_mm512_add_epi32(_mm512_mullo_epi32(cbu, u_d), _mm512_mullo_epi32(cbv, v_d)),
rnd_v,
));
let r_c16 = _mm512_permutexvar_epi64(pack_fixup, _mm512_packs_epi32(r_i32, r_i32));
let g_c16 = _mm512_permutexvar_epi64(pack_fixup, _mm512_packs_epi32(g_i32, g_i32));
let b_c16 = _mm512_permutexvar_epi64(pack_fixup, _mm512_packs_epi32(b_i32, b_i32));
let r_dup_lo = _mm512_permutexvar_epi16(dup_lo32_idx, r_c16);
let r_dup_hi = _mm512_permutexvar_epi16(dup_hi32_idx, r_c16);
let g_dup_lo = _mm512_permutexvar_epi16(dup_lo32_idx, g_c16);
let g_dup_hi = _mm512_permutexvar_epi16(dup_hi32_idx, g_c16);
let b_dup_lo = _mm512_permutexvar_epi16(dup_lo32_idx, b_c16);
let b_dup_hi = _mm512_permutexvar_epi16(dup_hi32_idx, b_c16);
let y_low_i16 = _mm512_cvtepu8_epi16(_mm512_castsi512_si256(y_vec));
let y_high_i16 = _mm512_cvtepu8_epi16(_mm512_extracti64x4_epi64::<1>(y_vec));
let y_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v, pack_fixup);
let b_lo = _mm512_adds_epi16(y_scaled_lo, b_dup_lo);
let b_hi = _mm512_adds_epi16(y_scaled_hi, b_dup_hi);
let g_lo = _mm512_adds_epi16(y_scaled_lo, g_dup_lo);
let g_hi = _mm512_adds_epi16(y_scaled_hi, g_dup_hi);
let r_lo = _mm512_adds_epi16(y_scaled_lo, r_dup_lo);
let r_hi = _mm512_adds_epi16(y_scaled_hi, r_dup_hi);
let b_u8 = narrow_u8x64(b_lo, b_hi, pack_fixup);
let g_u8 = narrow_u8x64(g_lo, g_hi, pack_fixup);
let r_u8 = narrow_u8x64(r_lo, r_hi, pack_fixup);
if ALPHA {
write_rgba_64(r_u8, g_u8, b_u8, alpha_u8, out.as_mut_ptr().add(x * 4));
} else {
write_rgb_64(r_u8, g_u8, b_u8, out.as_mut_ptr().add(x * 3));
}
x += 64;
}
if x < width {
let tail_w = width - x;
let chroma_end = width.div_ceil(4);
let tail_u = &u_quarter[x / 4..chroma_end];
let tail_v = &v_quarter[x / 4..chroma_end];
let tail_out = &mut out[x * bpp..width * bpp];
if ALPHA {
scalar::yuv_411_to_rgba_row(
&y[x..width],
tail_u,
tail_v,
tail_out,
tail_w,
matrix,
full_range,
);
} else {
scalar::yuv_411_to_rgb_row(
&y[x..width],
tail_u,
tail_v,
tail_out,
tail_w,
matrix,
full_range,
);
}
}
}
}