use core::arch::x86_64::*;
use super::*;
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_420p_n_to_rgb_row<const BITS: u32, const BE: bool>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
rgb_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420p_n_to_rgb_or_rgba_row::<BITS, false, false, BE>(
y, u_half, v_half, None, rgb_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_420p_n_to_rgba_row<const BITS: u32, const BE: bool>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420p_n_to_rgb_or_rgba_row::<BITS, true, false, BE>(
y, u_half, v_half, None, rgba_out, width, matrix, full_range,
);
}
}
#[cfg(feature = "yuva")]
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_420p_n_to_rgba_with_alpha_src_row<const BITS: u32, const BE: bool>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
a_src: &[u16],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420p_n_to_rgb_or_rgba_row::<BITS, true, true, BE>(
y,
u_half,
v_half,
Some(a_src),
rgba_out,
width,
matrix,
full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_420p_n_to_rgb_or_rgba_row<
const BITS: u32,
const ALPHA: bool,
const ALPHA_SRC: bool,
const BE: bool,
>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
a_src: Option<&[u16]>,
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const { assert!(BITS == 9 || BITS == 10 || BITS == 12 || BITS == 14) };
const { assert!(!ALPHA_SRC || ALPHA) };
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert_eq!(width & 1, 0);
debug_assert!(y.len() >= width);
debug_assert!(u_half.len() >= width / 2);
debug_assert!(v_half.len() >= width / 2);
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::<BITS, 8>(full_range);
let bias = scalar::chroma_bias::<BITS>();
const RND: i32 = 1 << 14;
unsafe {
let rnd_v = _mm256_set1_epi32(RND);
let y_off_v = _mm256_set1_epi16(y_off as i16);
let y_scale_v = _mm256_set1_epi32(y_scale);
let c_scale_v = _mm256_set1_epi32(c_scale);
let bias_v = _mm256_set1_epi16(bias as i16);
let mask_v = _mm256_set1_epi16(scalar::bits_mask::<BITS>() as i16);
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(-1);
let mut x = 0usize;
while x + 32 <= width {
let y_low_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x) as *const u8),
mask_v,
);
let y_high_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let u_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(u_half.as_ptr().add(x / 2) as *const u8),
mask_v,
);
let v_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(v_half.as_ptr().add(x / 2) as *const u8),
mask_v,
);
let u_i16 = _mm256_sub_epi16(u_vec, bias_v);
let v_i16 = _mm256_sub_epi16(v_vec, bias_v);
let u_lo_i32 = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(u_i16));
let u_hi_i32 = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(u_i16));
let v_lo_i32 = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(v_i16));
let v_hi_i32 = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(v_i16));
let u_d_lo = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_lo_i32, c_scale_v),
rnd_v,
));
let u_d_hi = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_hi_i32, c_scale_v),
rnd_v,
));
let v_d_lo = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_lo_i32, c_scale_v),
rnd_v,
));
let v_d_hi = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_hi_i32, c_scale_v),
rnd_v,
));
let r_chroma = chroma_i16x16(cru, crv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v);
let g_chroma = chroma_i16x16(cgu, cgv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v);
let b_chroma = chroma_i16x16(cbu, cbv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v);
let (r_dup_lo, r_dup_hi) = chroma_dup(r_chroma);
let (g_dup_lo, g_dup_hi) = chroma_dup(g_chroma);
let (b_dup_lo, b_dup_hi) = chroma_dup(b_chroma);
let y_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v);
let b_lo = _mm256_adds_epi16(y_scaled_lo, b_dup_lo);
let b_hi = _mm256_adds_epi16(y_scaled_hi, b_dup_hi);
let g_lo = _mm256_adds_epi16(y_scaled_lo, g_dup_lo);
let g_hi = _mm256_adds_epi16(y_scaled_hi, g_dup_hi);
let r_lo = _mm256_adds_epi16(y_scaled_lo, r_dup_lo);
let r_hi = _mm256_adds_epi16(y_scaled_hi, r_dup_hi);
let b_u8 = narrow_u8x32(b_lo, b_hi);
let g_u8 = narrow_u8x32(g_lo, g_hi);
let r_u8 = narrow_u8x32(r_lo, r_hi);
if ALPHA {
let a_u8 = if ALPHA_SRC {
let a_ptr = a_src.as_ref().unwrap_unchecked().as_ptr();
let a_lo = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x) as *const u8),
mask_v,
);
let a_hi = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x + 16) as *const u8),
mask_v,
);
let a_shr = _mm_cvtsi32_si128((BITS - 8) as i32);
let a_lo_shifted = _mm256_srl_epi16(a_lo, a_shr);
let a_hi_shifted = _mm256_srl_epi16(a_hi, a_shr);
narrow_u8x32(a_lo_shifted, a_hi_shifted)
} else {
alpha_u8
};
write_rgba_32(r_u8, g_u8, b_u8, a_u8, out.as_mut_ptr().add(x * 4));
} else {
write_rgb_32(r_u8, g_u8, b_u8, out.as_mut_ptr().add(x * 3));
}
x += 32;
}
if x < width {
let tail_y = &y[x..width];
let tail_u = &u_half[x / 2..width / 2];
let tail_v = &v_half[x / 2..width / 2];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
if ALPHA_SRC {
let tail_a = &a_src.as_ref().unwrap_unchecked()[x..width];
scalar::yuv_420p_n_to_rgba_with_alpha_src_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_a, tail_out, tail_w, matrix, full_range,
);
} else if ALPHA {
scalar::yuv_420p_n_to_rgba_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
} else {
scalar::yuv_420p_n_to_rgb_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
}
}
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_420p_n_to_rgb_u16_row<const BITS: u32, const BE: bool>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
rgb_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420p_n_to_rgb_or_rgba_u16_row::<BITS, false, false, BE>(
y, u_half, v_half, None, rgb_out, width, matrix, full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_420p_n_to_rgba_u16_row<const BITS: u32, const BE: bool>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
rgba_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420p_n_to_rgb_or_rgba_u16_row::<BITS, true, false, BE>(
y, u_half, v_half, None, rgba_out, width, matrix, full_range,
);
}
}
#[cfg(feature = "yuva")]
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_420p_n_to_rgba_u16_with_alpha_src_row<const BITS: u32, const BE: bool>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
a_src: &[u16],
rgba_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_420p_n_to_rgb_or_rgba_u16_row::<BITS, true, true, BE>(
y,
u_half,
v_half,
Some(a_src),
rgba_out,
width,
matrix,
full_range,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_420p_n_to_rgb_or_rgba_u16_row<
const BITS: u32,
const ALPHA: bool,
const ALPHA_SRC: bool,
const BE: bool,
>(
y: &[u16],
u_half: &[u16],
v_half: &[u16],
a_src: Option<&[u16]>,
out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
const { assert!(BITS == 9 || BITS == 10 || BITS == 12 || BITS == 14) };
const { assert!(!ALPHA_SRC || ALPHA) };
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert_eq!(width & 1, 0);
debug_assert!(y.len() >= width);
debug_assert!(u_half.len() >= width / 2);
debug_assert!(v_half.len() >= width / 2);
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::<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 rnd_v = _mm256_set1_epi32(RND);
let y_off_v = _mm256_set1_epi16(y_off as i16);
let y_scale_v = _mm256_set1_epi32(y_scale);
let c_scale_v = _mm256_set1_epi32(c_scale);
let bias_v = _mm256_set1_epi16(bias as i16);
let mask_v = _mm256_set1_epi16(scalar::bits_mask::<BITS>() as i16);
let max_v = _mm256_set1_epi16(out_max);
let zero_v = _mm256_set1_epi16(0);
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_u16 = _mm_set1_epi16(out_max);
let mut x = 0usize;
while x + 32 <= width {
let y_low_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x) as *const u8),
mask_v,
);
let y_high_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let u_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(u_half.as_ptr().add(x / 2) as *const u8),
mask_v,
);
let v_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(v_half.as_ptr().add(x / 2) as *const u8),
mask_v,
);
let u_i16 = _mm256_sub_epi16(u_vec, bias_v);
let v_i16 = _mm256_sub_epi16(v_vec, bias_v);
let u_lo_i32 = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(u_i16));
let u_hi_i32 = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(u_i16));
let v_lo_i32 = _mm256_cvtepi16_epi32(_mm256_castsi256_si128(v_i16));
let v_hi_i32 = _mm256_cvtepi16_epi32(_mm256_extracti128_si256::<1>(v_i16));
let u_d_lo = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_lo_i32, c_scale_v),
rnd_v,
));
let u_d_hi = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(u_hi_i32, c_scale_v),
rnd_v,
));
let v_d_lo = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_lo_i32, c_scale_v),
rnd_v,
));
let v_d_hi = q15_shift(_mm256_add_epi32(
_mm256_mullo_epi32(v_hi_i32, c_scale_v),
rnd_v,
));
let r_chroma = chroma_i16x16(cru, crv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v);
let g_chroma = chroma_i16x16(cgu, cgv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v);
let b_chroma = chroma_i16x16(cbu, cbv, u_d_lo, v_d_lo, u_d_hi, v_d_hi, rnd_v);
let (r_dup_lo, r_dup_hi) = chroma_dup(r_chroma);
let (g_dup_lo, g_dup_hi) = chroma_dup(g_chroma);
let (b_dup_lo, b_dup_hi) = chroma_dup(b_chroma);
let y_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v);
let r_lo = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_lo, r_dup_lo), zero_v, max_v);
let r_hi = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_hi, r_dup_hi), zero_v, max_v);
let g_lo = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_lo, g_dup_lo), zero_v, max_v);
let g_hi = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_hi, g_dup_hi), zero_v, max_v);
let b_lo = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_lo, b_dup_lo), zero_v, max_v);
let b_hi = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_hi, b_dup_hi), zero_v, max_v);
if ALPHA {
let (a0_v, a1_v, a2_v, a3_v) = if ALPHA_SRC {
let a_ptr = a_src.as_ref().unwrap_unchecked().as_ptr();
let a_lo = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x) as *const u8),
mask_v,
);
let a_hi = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x + 16) as *const u8),
mask_v,
);
(
_mm256_castsi256_si128(a_lo),
_mm256_extracti128_si256::<1>(a_lo),
_mm256_castsi256_si128(a_hi),
_mm256_extracti128_si256::<1>(a_hi),
)
} else {
(alpha_u16, alpha_u16, alpha_u16, alpha_u16)
};
let dst = out.as_mut_ptr().add(x * 4);
write_rgba_u16_8(
_mm256_castsi256_si128(r_lo),
_mm256_castsi256_si128(g_lo),
_mm256_castsi256_si128(b_lo),
a0_v,
dst,
);
write_rgba_u16_8(
_mm256_extracti128_si256::<1>(r_lo),
_mm256_extracti128_si256::<1>(g_lo),
_mm256_extracti128_si256::<1>(b_lo),
a1_v,
dst.add(32),
);
write_rgba_u16_8(
_mm256_castsi256_si128(r_hi),
_mm256_castsi256_si128(g_hi),
_mm256_castsi256_si128(b_hi),
a2_v,
dst.add(64),
);
write_rgba_u16_8(
_mm256_extracti128_si256::<1>(r_hi),
_mm256_extracti128_si256::<1>(g_hi),
_mm256_extracti128_si256::<1>(b_hi),
a3_v,
dst.add(96),
);
} else {
let dst = out.as_mut_ptr().add(x * 3);
write_rgb_u16_8(
_mm256_castsi256_si128(r_lo),
_mm256_castsi256_si128(g_lo),
_mm256_castsi256_si128(b_lo),
dst,
);
write_rgb_u16_8(
_mm256_extracti128_si256::<1>(r_lo),
_mm256_extracti128_si256::<1>(g_lo),
_mm256_extracti128_si256::<1>(b_lo),
dst.add(24),
);
write_rgb_u16_8(
_mm256_castsi256_si128(r_hi),
_mm256_castsi256_si128(g_hi),
_mm256_castsi256_si128(b_hi),
dst.add(48),
);
write_rgb_u16_8(
_mm256_extracti128_si256::<1>(r_hi),
_mm256_extracti128_si256::<1>(g_hi),
_mm256_extracti128_si256::<1>(b_hi),
dst.add(72),
);
}
x += 32;
}
if x < width {
let tail_y = &y[x..width];
let tail_u = &u_half[x / 2..width / 2];
let tail_v = &v_half[x / 2..width / 2];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
if ALPHA_SRC {
let tail_a = &a_src.as_ref().unwrap_unchecked()[x..width];
scalar::yuv_420p_n_to_rgba_u16_with_alpha_src_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_a, tail_out, tail_w, matrix, full_range,
);
} else if ALPHA {
scalar::yuv_420p_n_to_rgba_u16_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
} else {
scalar::yuv_420p_n_to_rgb_u16_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
}
}
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_444p_n_to_rgb_row<const BITS: u32, const BE: bool>(
y: &[u16],
u: &[u16],
v: &[u16],
rgb_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444p_n_to_rgb_or_rgba_row::<BITS, false, false, BE>(
y, u, v, rgb_out, width, matrix, full_range, None,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_444p_n_to_rgba_row<const BITS: u32, const BE: bool>(
y: &[u16],
u: &[u16],
v: &[u16],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444p_n_to_rgb_or_rgba_row::<BITS, true, false, BE>(
y, u, v, rgba_out, width, matrix, full_range, None,
);
}
}
#[cfg(feature = "yuva")]
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_444p_n_to_rgba_with_alpha_src_row<const BITS: u32, const BE: bool>(
y: &[u16],
u: &[u16],
v: &[u16],
a_src: &[u16],
rgba_out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444p_n_to_rgb_or_rgba_row::<BITS, true, true, BE>(
y,
u,
v,
rgba_out,
width,
matrix,
full_range,
Some(a_src),
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_444p_n_to_rgb_or_rgba_row<
const BITS: u32,
const ALPHA: bool,
const ALPHA_SRC: bool,
const BE: bool,
>(
y: &[u16],
u: &[u16],
v: &[u16],
out: &mut [u8],
width: usize,
matrix: ColorMatrix,
full_range: bool,
a_src: Option<&[u16]>,
) {
const { assert!(BITS == 9 || BITS == 10 || BITS == 12 || BITS == 14) };
const { assert!(!ALPHA_SRC || ALPHA) };
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(y.len() >= width);
debug_assert!(u.len() >= width);
debug_assert!(v.len() >= width);
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::<BITS, 8>(full_range);
let bias = scalar::chroma_bias::<BITS>();
const RND: i32 = 1 << 14;
unsafe {
let rnd_v = _mm256_set1_epi32(RND);
let y_off_v = _mm256_set1_epi16(y_off as i16);
let y_scale_v = _mm256_set1_epi32(y_scale);
let c_scale_v = _mm256_set1_epi32(c_scale);
let bias_v = _mm256_set1_epi16(bias as i16);
let mask_v = _mm256_set1_epi16(scalar::bits_mask::<BITS>() as i16);
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(-1);
let mut x = 0usize;
while x + 32 <= width {
let y_low_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x) as *const u8),
mask_v,
);
let y_high_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let u_lo_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(u.as_ptr().add(x) as *const u8),
mask_v,
);
let u_hi_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(u.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let v_lo_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(v.as_ptr().add(x) as *const u8),
mask_v,
);
let v_hi_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(v.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let u_lo_i16 = _mm256_sub_epi16(u_lo_vec, bias_v);
let u_hi_i16 = _mm256_sub_epi16(u_hi_vec, bias_v);
let v_lo_i16 = _mm256_sub_epi16(v_lo_vec, bias_v);
let v_hi_i16 = _mm256_sub_epi16(v_hi_vec, bias_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 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_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 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_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 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_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 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_lo = chroma_i16x16(cru, crv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, 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_lo = chroma_i16x16(cgu, cgv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_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_lo = chroma_i16x16(cbu, cbv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_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_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v);
let r_lo = _mm256_adds_epi16(y_scaled_lo, r_chroma_lo);
let r_hi = _mm256_adds_epi16(y_scaled_hi, r_chroma_hi);
let g_lo = _mm256_adds_epi16(y_scaled_lo, g_chroma_lo);
let g_hi = _mm256_adds_epi16(y_scaled_hi, g_chroma_hi);
let b_lo = _mm256_adds_epi16(y_scaled_lo, b_chroma_lo);
let b_hi = _mm256_adds_epi16(y_scaled_hi, b_chroma_hi);
let b_u8 = narrow_u8x32(b_lo, b_hi);
let g_u8 = narrow_u8x32(g_lo, g_hi);
let r_u8 = narrow_u8x32(r_lo, r_hi);
if ALPHA {
let a_u8 = if ALPHA_SRC {
let a_ptr = a_src.as_ref().unwrap_unchecked().as_ptr();
let a_lo = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x) as *const u8),
mask_v,
);
let a_hi = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x + 16) as *const u8),
mask_v,
);
let a_shr = _mm_cvtsi32_si128((BITS - 8) as i32);
let a_lo_shifted = _mm256_srl_epi16(a_lo, a_shr);
let a_hi_shifted = _mm256_srl_epi16(a_hi, a_shr);
narrow_u8x32(a_lo_shifted, a_hi_shifted)
} else {
alpha_u8
};
write_rgba_32(r_u8, g_u8, b_u8, a_u8, out.as_mut_ptr().add(x * 4));
} else {
write_rgb_32(r_u8, g_u8, b_u8, out.as_mut_ptr().add(x * 3));
}
x += 32;
}
if x < width {
let tail_y = &y[x..width];
let tail_u = &u[x..width];
let tail_v = &v[x..width];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
if ALPHA_SRC {
let tail_a = &a_src.as_ref().unwrap_unchecked()[x..width];
scalar::yuv_444p_n_to_rgba_with_alpha_src_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_a, tail_out, tail_w, matrix, full_range,
);
} else if ALPHA {
scalar::yuv_444p_n_to_rgba_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
} else {
scalar::yuv_444p_n_to_rgb_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
}
}
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_444p_n_to_rgb_u16_row<const BITS: u32, const BE: bool>(
y: &[u16],
u: &[u16],
v: &[u16],
rgb_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444p_n_to_rgb_or_rgba_u16_row::<BITS, false, false, BE>(
y, u, v, rgb_out, width, matrix, full_range, None,
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
pub(crate) unsafe fn yuv_444p_n_to_rgba_u16_row<const BITS: u32, const BE: bool>(
y: &[u16],
u: &[u16],
v: &[u16],
rgba_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444p_n_to_rgb_or_rgba_u16_row::<BITS, true, false, BE>(
y, u, v, rgba_out, width, matrix, full_range, None,
);
}
}
#[cfg(feature = "yuva")]
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_444p_n_to_rgba_u16_with_alpha_src_row<const BITS: u32, const BE: bool>(
y: &[u16],
u: &[u16],
v: &[u16],
a_src: &[u16],
rgba_out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
) {
unsafe {
yuv_444p_n_to_rgb_or_rgba_u16_row::<BITS, true, true, BE>(
y,
u,
v,
rgba_out,
width,
matrix,
full_range,
Some(a_src),
);
}
}
#[inline]
#[target_feature(enable = "avx2")]
#[allow(clippy::too_many_arguments)]
pub(crate) unsafe fn yuv_444p_n_to_rgb_or_rgba_u16_row<
const BITS: u32,
const ALPHA: bool,
const ALPHA_SRC: bool,
const BE: bool,
>(
y: &[u16],
u: &[u16],
v: &[u16],
out: &mut [u16],
width: usize,
matrix: ColorMatrix,
full_range: bool,
a_src: Option<&[u16]>,
) {
const { assert!(BITS == 9 || BITS == 10 || BITS == 12 || BITS == 14) };
const { assert!(!ALPHA_SRC || ALPHA) };
let bpp: usize = if ALPHA { 4 } else { 3 };
debug_assert!(y.len() >= width);
debug_assert!(u.len() >= width);
debug_assert!(v.len() >= width);
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::<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 rnd_v = _mm256_set1_epi32(RND);
let y_off_v = _mm256_set1_epi16(y_off as i16);
let y_scale_v = _mm256_set1_epi32(y_scale);
let c_scale_v = _mm256_set1_epi32(c_scale);
let bias_v = _mm256_set1_epi16(bias as i16);
let mask_v = _mm256_set1_epi16(scalar::bits_mask::<BITS>() as i16);
let max_v = _mm256_set1_epi16(out_max);
let zero_v = _mm256_set1_epi16(0);
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_u16 = _mm_set1_epi16(out_max);
let mut x = 0usize;
while x + 32 <= width {
let y_low_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x) as *const u8),
mask_v,
);
let y_high_i16 = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(y.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let u_lo_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(u.as_ptr().add(x) as *const u8),
mask_v,
);
let u_hi_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(u.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let v_lo_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(v.as_ptr().add(x) as *const u8),
mask_v,
);
let v_hi_vec = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(v.as_ptr().add(x + 16) as *const u8),
mask_v,
);
let u_lo_i16 = _mm256_sub_epi16(u_lo_vec, bias_v);
let u_hi_i16 = _mm256_sub_epi16(u_hi_vec, bias_v);
let v_lo_i16 = _mm256_sub_epi16(v_lo_vec, bias_v);
let v_hi_i16 = _mm256_sub_epi16(v_hi_vec, bias_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 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_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 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_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 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_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 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_lo = chroma_i16x16(cru, crv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_b, 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_lo = chroma_i16x16(cgu, cgv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_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_lo = chroma_i16x16(cbu, cbv, u_d_lo_a, v_d_lo_a, u_d_lo_b, v_d_lo_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_scaled_lo = scale_y(y_low_i16, y_off_v, y_scale_v, rnd_v);
let y_scaled_hi = scale_y(y_high_i16, y_off_v, y_scale_v, rnd_v);
let r_lo = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_lo, r_chroma_lo), zero_v, max_v);
let r_hi = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_hi, r_chroma_hi), zero_v, max_v);
let g_lo = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_lo, g_chroma_lo), zero_v, max_v);
let g_hi = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_hi, g_chroma_hi), zero_v, max_v);
let b_lo = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_lo, b_chroma_lo), zero_v, max_v);
let b_hi = clamp_u16_max_x16(_mm256_adds_epi16(y_scaled_hi, b_chroma_hi), zero_v, max_v);
if ALPHA {
let (a_lo_q0, a_lo_q1, a_hi_q0, a_hi_q1) = if ALPHA_SRC {
let a_ptr = a_src.as_ref().unwrap_unchecked().as_ptr();
let a_lo_v = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x) as *const u8),
mask_v,
);
let a_hi_v = _mm256_and_si256(
endian::load_endian_u16x16::<BE>(a_ptr.add(x + 16) as *const u8),
mask_v,
);
(
_mm256_castsi256_si128(a_lo_v),
_mm256_extracti128_si256::<1>(a_lo_v),
_mm256_castsi256_si128(a_hi_v),
_mm256_extracti128_si256::<1>(a_hi_v),
)
} else {
(alpha_u16, alpha_u16, alpha_u16, alpha_u16)
};
let dst = out.as_mut_ptr().add(x * 4);
write_rgba_u16_8(
_mm256_castsi256_si128(r_lo),
_mm256_castsi256_si128(g_lo),
_mm256_castsi256_si128(b_lo),
a_lo_q0,
dst,
);
write_rgba_u16_8(
_mm256_extracti128_si256::<1>(r_lo),
_mm256_extracti128_si256::<1>(g_lo),
_mm256_extracti128_si256::<1>(b_lo),
a_lo_q1,
dst.add(32),
);
write_rgba_u16_8(
_mm256_castsi256_si128(r_hi),
_mm256_castsi256_si128(g_hi),
_mm256_castsi256_si128(b_hi),
a_hi_q0,
dst.add(64),
);
write_rgba_u16_8(
_mm256_extracti128_si256::<1>(r_hi),
_mm256_extracti128_si256::<1>(g_hi),
_mm256_extracti128_si256::<1>(b_hi),
a_hi_q1,
dst.add(96),
);
} else {
let dst = out.as_mut_ptr().add(x * 3);
write_rgb_u16_8(
_mm256_castsi256_si128(r_lo),
_mm256_castsi256_si128(g_lo),
_mm256_castsi256_si128(b_lo),
dst,
);
write_rgb_u16_8(
_mm256_extracti128_si256::<1>(r_lo),
_mm256_extracti128_si256::<1>(g_lo),
_mm256_extracti128_si256::<1>(b_lo),
dst.add(24),
);
write_rgb_u16_8(
_mm256_castsi256_si128(r_hi),
_mm256_castsi256_si128(g_hi),
_mm256_castsi256_si128(b_hi),
dst.add(48),
);
write_rgb_u16_8(
_mm256_extracti128_si256::<1>(r_hi),
_mm256_extracti128_si256::<1>(g_hi),
_mm256_extracti128_si256::<1>(b_hi),
dst.add(72),
);
}
x += 32;
}
if x < width {
let tail_y = &y[x..width];
let tail_u = &u[x..width];
let tail_v = &v[x..width];
let tail_out = &mut out[x * bpp..width * bpp];
let tail_w = width - x;
if ALPHA_SRC {
let tail_a = &a_src.as_ref().unwrap_unchecked()[x..width];
scalar::yuv_444p_n_to_rgba_u16_with_alpha_src_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_a, tail_out, tail_w, matrix, full_range,
);
} else if ALPHA {
scalar::yuv_444p_n_to_rgba_u16_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
} else {
scalar::yuv_444p_n_to_rgb_u16_row::<BITS, BE>(
tail_y, tail_u, tail_v, tail_out, tail_w, matrix, full_range,
);
}
}
}
}