use alloc::vec::Vec;
use crate::hevc::ChromaFormat;
pub fn row_pair(y: usize, ch: usize, chroma: ChromaFormat) -> (usize, usize, u32) {
if ch == 0 {
return (0, 0, 4);
}
if chroma.y_shift() == 0 {
let r = core::cmp::min(y, ch - 1);
return (r, r, 4);
}
let cy = core::cmp::min(y >> 1, ch - 1);
let near = if y & 1 == 0 {
cy.saturating_sub(1)
} else {
core::cmp::min(cy + 1, ch - 1)
};
(cy, near, 3)
}
pub fn row(dst: &mut [u16], src0: &[u16], src1: &[u16], w0: u32, x_shift: u32) {
let n = core::cmp::min(src0.len(), src1.len());
if n == 0 || dst.is_empty() {
return;
}
let done = if x_shift == 0 {
direct(dst, &src0[..n], &src1[..n], w0)
} else {
bilinear(dst, &src0[..n], &src1[..n], w0)
};
if done < dst.len() {
let edge = vblend(src0[n - 1], src1[n - 1], w0);
for d in &mut dst[done..] {
*d = edge;
}
}
}
fn direct(dst: &mut [u16], src0: &[u16], src1: &[u16], w0: u32) -> usize {
let n = core::cmp::min(dst.len(), src0.len());
for (d, (a, b)) in dst[..n].iter_mut().zip(src0[..n].iter().zip(&src1[..n])) {
*d = vblend(*a, *b, w0);
}
n
}
fn bilinear(dst: &mut [u16], src0: &[u16], src1: &[u16], w0: u32) -> usize {
let body = core::cmp::min(src0.len() - 1, dst.len() / 2);
for (i, px) in dst.chunks_exact_mut(2).take(body).enumerate() {
let (a0, a1) = (src0[i], src0[i + 1]);
let (b0, b1) = (src1[i], src1[i + 1]);
px[0] = vblend(a0, b0, w0);
px[1] = vblend(havg(a0, a1), havg(b0, b1), w0);
}
body * 2
}
pub fn horizontal(dst: &mut [u16], src: &[u16], x_shift: u32) {
let n = src.len();
if n == 0 || dst.is_empty() {
return;
}
let done = if x_shift == 0 {
let m = core::cmp::min(dst.len(), n);
dst[..m].copy_from_slice(&src[..m]);
m
} else {
let body = core::cmp::min(n - 1, dst.len() / 2);
for (i, px) in dst.chunks_exact_mut(2).take(body).enumerate() {
px[0] = src[i];
px[1] = havg(src[i], src[i + 1]);
}
body * 2
};
for d in &mut dst[done..] {
*d = src[n - 1];
}
}
#[inline(always)]
pub fn vblend(a: u16, b: u16, w0: u32) -> u16 {
((u32::from(a) * w0 + u32::from(b) * (4 - w0) + 2) >> 2) as u16
}
#[inline(always)]
fn havg(a: u16, b: u16) -> u16 {
((u32::from(a) + u32::from(b) + 1) >> 1) as u16
}
pub fn plane(
src: &[u16],
stride: u32,
cw: u32,
ch: u32,
w: u32,
h: u32,
chroma: ChromaFormat,
) -> Vec<u16> {
let (w, h, cw, ch) = (w as usize, h as usize, cw as usize, ch as usize);
let mut out = alloc::vec![0u16; w * h];
if cw == 0 || ch == 0 {
return out;
}
let x_shift = chroma.x_shift();
for y in 0..h {
let (r0, r1, w0) = row_pair(y, ch, chroma);
let (o0, o1) = (r0 * stride as usize, r1 * stride as usize);
let (Some(s0), Some(s1)) = (src.get(o0..o0 + cw), src.get(o1..o1 + cw)) else {
break;
};
let Some(dst) = out.get_mut(y * w..y * w + w) else {
break;
};
row(dst, s0, s1, w0, x_shift);
}
out
}