use crate::dct::{WC4, WC8, WC16, WC32};
use std::arch::aarch64::*;
use std::mem::MaybeUninit;
#[derive(Clone, Copy)]
struct NeonDoubledVector {
lo: float32x4_t,
hi: float32x4_t,
}
impl NeonDoubledVector {
#[inline]
#[target_feature(enable = "neon")]
fn add(self, rhs: NeonDoubledVector) -> NeonDoubledVector {
NeonDoubledVector {
lo: vaddq_f32(self.lo, rhs.lo),
hi: vaddq_f32(self.hi, rhs.hi),
}
}
#[inline]
#[target_feature(enable = "neon")]
fn sub(self, rhs: NeonDoubledVector) -> NeonDoubledVector {
NeonDoubledVector {
lo: vsubq_f32(self.lo, rhs.lo),
hi: vsubq_f32(self.hi, rhs.hi),
}
}
#[inline]
#[target_feature(enable = "neon")]
fn muls(self, s: f32) -> NeonDoubledVector {
NeonDoubledVector {
lo: vmulq_n_f32(self.lo, s),
hi: vmulq_n_f32(self.hi, s),
}
}
#[inline]
#[target_feature(enable = "neon")]
fn fma(self, b: NeonDoubledVector, s: f32) -> NeonDoubledVector {
NeonDoubledVector {
lo: vfmaq_n_f32(self.lo, b.lo, s),
hi: vfmaq_n_f32(self.hi, b.hi, s),
}
}
}
#[inline]
#[target_feature(enable = "neon")]
fn dct1d_4_v(c: &mut [NeonDoubledVector; 4]) {
let t0 = c[0].add(c[3]);
let t1 = c[1].add(c[2]);
let sum = t0.add(t1);
let diff = t0.sub(t1);
let t2 = c[0].sub(c[3]).muls(WC4[0]);
let t3 = c[1].sub(c[2]).muls(WC4[1]);
let t2p = t2.add(t3);
let t3p = t2.sub(t3);
let t2pp = t3p.fma(t2p, std::f32::consts::SQRT_2);
c[0] = sum;
c[1] = t2pp;
c[2] = diff;
c[3] = t3p;
}
#[inline]
#[target_feature(enable = "neon")]
fn dct1d_8_v(c: &mut [NeonDoubledVector; 8]) {
let mut evens = [
c[0].add(c[7]),
c[1].add(c[6]),
c[2].add(c[5]),
c[3].add(c[4]),
];
dct1d_4_v(&mut evens);
let mut odds = [
c[0].sub(c[7]).muls(WC8[0]),
c[1].sub(c[6]).muls(WC8[1]),
c[2].sub(c[5]).muls(WC8[2]),
c[3].sub(c[4]).muls(WC8[3]),
];
dct1d_4_v(&mut odds);
odds[0] = odds[1].fma(odds[0], std::f32::consts::SQRT_2);
odds[1] = odds[1].add(odds[2]);
odds[2] = odds[2].add(odds[3]);
c[0] = evens[0];
c[1] = odds[0];
c[2] = evens[1];
c[3] = odds[1];
c[4] = evens[2];
c[5] = odds[2];
c[6] = evens[3];
c[7] = odds[3];
}
#[inline]
#[target_feature(enable = "neon")]
fn transpose_4x4(
r0: float32x4_t,
r1: float32x4_t,
r2: float32x4_t,
r3: float32x4_t,
) -> (float32x4_t, float32x4_t, float32x4_t, float32x4_t) {
let v0 = vtrn1q_f32(r0, r1);
let v1 = vtrn2q_f32(r0, r1);
let v2 = vtrn1q_f32(r2, r3);
let v3 = vtrn2q_f32(r2, r3);
let c0 = vreinterpretq_f32_f64(vtrn1q_f64(
vreinterpretq_f64_f32(v0),
vreinterpretq_f64_f32(v2),
));
let c1 = vreinterpretq_f32_f64(vtrn1q_f64(
vreinterpretq_f64_f32(v1),
vreinterpretq_f64_f32(v3),
));
let c2 = vreinterpretq_f32_f64(vtrn2q_f64(
vreinterpretq_f64_f32(v0),
vreinterpretq_f64_f32(v2),
));
let c3 = vreinterpretq_f32_f64(vtrn2q_f64(
vreinterpretq_f64_f32(v1),
vreinterpretq_f64_f32(v3),
));
(c0, c1, c2, c3)
}
#[inline]
#[target_feature(enable = "neon")]
fn transpose_8x8(c: &mut [NeonDoubledVector; 8]) {
let (a0, a1, a2, a3) = transpose_4x4(c[0].lo, c[1].lo, c[2].lo, c[3].lo);
let (b0, b1, b2, b3) = transpose_4x4(c[0].hi, c[1].hi, c[2].hi, c[3].hi);
let (cc0, cc1, cc2, cc3) = transpose_4x4(c[4].lo, c[5].lo, c[6].lo, c[7].lo);
let (d0, d1, d2, d3) = transpose_4x4(c[4].hi, c[5].hi, c[6].hi, c[7].hi);
c[0] = NeonDoubledVector { lo: a0, hi: cc0 };
c[1] = NeonDoubledVector { lo: a1, hi: cc1 };
c[2] = NeonDoubledVector { lo: a2, hi: cc2 };
c[3] = NeonDoubledVector { lo: a3, hi: cc3 };
c[4] = NeonDoubledVector { lo: b0, hi: d0 };
c[5] = NeonDoubledVector { lo: b1, hi: d1 };
c[6] = NeonDoubledVector { lo: b2, hi: d2 };
c[7] = NeonDoubledVector { lo: b3, hi: d3 };
}
#[inline]
#[target_feature(enable = "neon")]
fn load<const N: usize>(ptr: &[f32; N], stride: usize) -> [NeonDoubledVector; 8] {
let row = |y: usize| -> NeonDoubledVector {
unsafe {
let p = &ptr[y * stride..];
NeonDoubledVector {
lo: vld1q_f32(p.as_ptr()),
hi: vld1q_f32(p[4..].as_ptr()),
}
}
};
[
row(0),
row(1),
row(2),
row(3),
row(4),
row(5),
row(6),
row(7),
]
}
#[inline]
#[target_feature(enable = "neon")]
fn scale_and_store(cols: &[NeonDoubledVector; 8], scale: f32, out: &mut [f32; 64]) {
for (k, col) in cols.iter().enumerate() {
unsafe {
vst1q_f32(out[k * 8..].as_mut_ptr(), vmulq_n_f32(col.lo, scale));
vst1q_f32(out[k * 8 + 4..].as_mut_ptr(), vmulq_n_f32(col.hi, scale));
}
}
}
#[inline]
#[target_feature(enable = "neon")]
fn scale_and_store_uninit(
cols: &[NeonDoubledVector; 8],
scale: f32,
out: &mut MaybeUninit<[f32; 64]>,
) {
for (k, col) in cols.iter().enumerate() {
unsafe {
let dst_ptr = out.as_mut_ptr() as *mut f32;
vst1q_f32(dst_ptr.add(k * 8), vmulq_n_f32(col.lo, scale));
vst1q_f32(dst_ptr.add(k * 8 + 4), vmulq_n_f32(col.hi, scale));
}
}
}
#[target_feature(enable = "neon")]
pub(crate) fn dct8x8_neon(input: &[f32; 64], output: &mut [f32; 64]) {
let mut cols = load(input, 8);
dct1d_8_v(&mut cols);
transpose_8x8(&mut cols);
dct1d_8_v(&mut cols);
scale_and_store(&cols, 1.0 / 64.0, output);
}
#[inline]
#[target_feature(enable = "neon")]
fn dct1d_16_v(c: &mut [NeonDoubledVector; 16]) {
let mut evens = [
c[0].add(c[15]),
c[1].add(c[14]),
c[2].add(c[13]),
c[3].add(c[12]),
c[4].add(c[11]),
c[5].add(c[10]),
c[6].add(c[9]),
c[7].add(c[8]),
];
let mut odds = [
c[0].sub(c[15]).muls(WC16[0]),
c[1].sub(c[14]).muls(WC16[1]),
c[2].sub(c[13]).muls(WC16[2]),
c[3].sub(c[12]).muls(WC16[3]),
c[4].sub(c[11]).muls(WC16[4]),
c[5].sub(c[10]).muls(WC16[5]),
c[6].sub(c[9]).muls(WC16[6]),
c[7].sub(c[8]).muls(WC16[7]),
];
dct1d_8_v(&mut evens);
dct1d_8_v(&mut odds);
odds[0] = odds[1].fma(odds[0], std::f32::consts::SQRT_2);
odds[1] = odds[1].add(odds[2]);
odds[2] = odds[2].add(odds[3]);
odds[3] = odds[3].add(odds[4]);
odds[4] = odds[4].add(odds[5]);
odds[5] = odds[5].add(odds[6]);
odds[6] = odds[6].add(odds[7]);
c[0] = evens[0];
c[1] = odds[0];
c[2] = evens[1];
c[3] = odds[1];
c[4] = evens[2];
c[5] = odds[2];
c[6] = evens[3];
c[7] = odds[3];
c[8] = evens[4];
c[9] = odds[4];
c[10] = evens[5];
c[11] = odds[5];
c[12] = evens[6];
c[13] = odds[6];
c[14] = evens[7];
c[15] = odds[7];
}
#[inline]
#[target_feature(enable = "neon")]
fn load8_128(ptr: &[f32], stride: usize) -> [NeonDoubledVector; 8] {
let row = |y: usize| unsafe {
let p = ptr.get_unchecked(y * stride..);
NeonDoubledVector {
lo: vld1q_f32(p.as_ptr()),
hi: vld1q_f32(p.get_unchecked(4..).as_ptr()),
}
};
[
row(0),
row(1),
row(2),
row(3),
row(4),
row(5),
row(6),
row(7),
]
}
#[target_feature(enable = "neon")]
pub(crate) fn dct8x16_neon(input: &[f32; 128], output: &mut [f32; 128]) {
let mut left = load8_128(input, 16);
let mut right = load8_128(&input[8..], 16);
let mut c = [NeonDoubledVector {
lo: vdupq_n_f32(0.0),
hi: vdupq_n_f32(0.0),
}; 16];
transpose_8x8(&mut left);
transpose_8x8(&mut right);
c[0..8].copy_from_slice(&left);
c[8..16].copy_from_slice(&right);
dct1d_16_v(&mut c);
let mut cl: [NeonDoubledVector; 8] = c[0..8].try_into().unwrap();
let mut cr: [NeonDoubledVector; 8] = c[8..16].try_into().unwrap();
transpose_8x8(&mut cl);
transpose_8x8(&mut cr);
dct1d_8_v(&mut cl);
dct1d_8_v(&mut cr);
let scale = 1.0 / 128.0;
for m in 0..8 {
let base = &mut output[m * 16..];
unsafe {
vst1q_f32(base.as_mut_ptr(), vmulq_n_f32(cl[m].lo, scale));
vst1q_f32(&mut base[4], vmulq_n_f32(cl[m].hi, scale));
vst1q_f32(&mut base[8], vmulq_n_f32(cr[m].lo, scale));
vst1q_f32(&mut base[12], vmulq_n_f32(cr[m].hi, scale));
}
}
}
#[target_feature(enable = "neon")]
pub(crate) fn dct16x8_neon(input: &[f32; 128], output: &mut [f32; 128]) {
let mut c = [NeonDoubledVector {
lo: vdupq_n_f32(0.0),
hi: vdupq_n_f32(0.0),
}; 16];
for v in 0..16 {
let p = &input[v * 8..];
unsafe {
c[v] = NeonDoubledVector {
lo: vld1q_f32(p.as_ptr()),
hi: vld1q_f32(p[4..].as_ptr()),
};
}
}
dct1d_16_v(&mut c);
let mut top: [NeonDoubledVector; 8] = c[0..8].try_into().unwrap();
let mut bot: [NeonDoubledVector; 8] = c[8..16].try_into().unwrap();
transpose_8x8(&mut top);
transpose_8x8(&mut bot);
dct1d_8_v(&mut top);
dct1d_8_v(&mut bot);
let scale = 1.0 / 128.0;
for m in 0..8 {
let base = &mut output[m * 16..];
unsafe {
vst1q_f32(base.as_mut_ptr(), vmulq_n_f32(top[m].lo, scale)); vst1q_f32(base[4..].as_mut_ptr(), vmulq_n_f32(top[m].hi, scale)); vst1q_f32(base[8..].as_mut_ptr(), vmulq_n_f32(bot[m].lo, scale)); vst1q_f32(base[12..].as_mut_ptr(), vmulq_n_f32(bot[m].hi, scale)); }
}
}
#[inline]
#[target_feature(enable = "neon")]
fn load16_256(ptr: &[f32], stride: usize) -> [NeonDoubledVector; 16] {
let row = |y: usize| unsafe {
let p = ptr.get_unchecked(y * stride..);
NeonDoubledVector {
lo: vld1q_f32(p.as_ptr()),
hi: vld1q_f32(p.get_unchecked(4..).as_ptr()),
}
};
[
row(0),
row(1),
row(2),
row(3),
row(4),
row(5),
row(6),
row(7),
row(8),
row(9),
row(10),
row(11),
row(12),
row(13),
row(14),
row(15),
]
}
#[target_feature(enable = "neon")]
pub(crate) fn dct16x16_neon(input: &[f32; 256], output: &mut [f32; 256]) {
let mut c_l = load16_256(input.as_slice(), 16);
let mut c_r = load16_256(&input[8..], 16);
dct1d_16_v(&mut c_l);
dct1d_16_v(&mut c_r);
let mut top_l: [NeonDoubledVector; 8] = c_l[0..8].try_into().unwrap();
let mut bot_l: [NeonDoubledVector; 8] = c_l[8..16].try_into().unwrap();
let mut top_r: [NeonDoubledVector; 8] = c_r[0..8].try_into().unwrap();
let mut bot_r: [NeonDoubledVector; 8] = c_r[8..16].try_into().unwrap();
transpose_8x8(&mut top_l);
transpose_8x8(&mut bot_l);
transpose_8x8(&mut top_r);
transpose_8x8(&mut bot_r);
let mut d_a = [NeonDoubledVector {
lo: vdupq_n_f32(0.0),
hi: vdupq_n_f32(0.0),
}; 16];
let mut d_b = d_a;
d_a[0..8].copy_from_slice(&top_l);
d_a[8..16].copy_from_slice(&top_r);
d_b[0..8].copy_from_slice(&bot_l);
d_b[8..16].copy_from_slice(&bot_r);
dct1d_16_v(&mut d_a);
dct1d_16_v(&mut d_b);
let scale = 1.0 / 256.0;
for u in 0..16 {
let base = &mut output[u * 16..];
unsafe {
vst1q_f32(base.as_mut_ptr(), vmulq_n_f32(d_a[u].lo, scale));
vst1q_f32(base[4..].as_mut_ptr(), vmulq_n_f32(d_a[u].hi, scale));
vst1q_f32(base[8..].as_mut_ptr(), vmulq_n_f32(d_b[u].lo, scale));
vst1q_f32(base[12..].as_mut_ptr(), vmulq_n_f32(d_b[u].hi, scale));
}
}
}
#[target_feature(enable = "neon")]
fn dct1d_32_v(c: &mut [NeonDoubledVector; 32]) {
let mut evens = [c[0]; 16];
let mut odds = [c[0]; 16];
for i in 0..16 {
evens[i] = c[i].add(c[31 - i]);
odds[i] = c[i].sub(c[31 - i]).muls(WC32[i]);
}
dct1d_16_v(&mut evens);
dct1d_16_v(&mut odds);
odds[0] = odds[1].fma(odds[0], std::f32::consts::SQRT_2);
for i in 1..15 {
odds[i] = odds[i].add(odds[i + 1]);
}
for i in 0..16 {
c[2 * i] = evens[i];
c[2 * i + 1] = odds[i];
}
}
#[target_feature(enable = "neon")]
pub(crate) fn dct32x32_neon(input: &[f32; 1024], output: &mut [f32; 1024]) {
let zero = NeonDoubledVector {
lo: vdupq_n_f32(0.0),
hi: vdupq_n_f32(0.0),
};
let mut after_col_u = MaybeUninit::<[f32; 1024]>::uninit();
for g in 0..4 {
let mut c = [zero; 32];
for r in 0..32 {
let p = unsafe { input.get_unchecked(r * 32 + g * 8..) };
c[r] = NeonDoubledVector {
lo: unsafe { vld1q_f32(p.as_ptr()) },
hi: unsafe { vld1q_f32(p.get_unchecked(4..).as_ptr()) },
};
}
dct1d_32_v(&mut c);
for v in 0..32 {
let after_col_dst = after_col_u.as_mut_ptr() as *mut f32;
let p = unsafe { after_col_dst.add(v * 32 + g * 8) };
unsafe {
vst1q_f32(p, c[v].lo);
vst1q_f32(p.add(4), c[v].hi);
}
}
}
let after_col = unsafe { after_col_u.assume_init() };
for g in 0..4 {
let mut c = [zero; 32];
for u in 0..32 {
let b = g * 8;
let lanes = [
after_col[b * 32 + u],
after_col[(b + 1) * 32 + u],
after_col[(b + 2) * 32 + u],
after_col[(b + 3) * 32 + u],
after_col[(b + 4) * 32 + u],
after_col[(b + 5) * 32 + u],
after_col[(b + 6) * 32 + u],
after_col[(b + 7) * 32 + u],
];
c[u] = NeonDoubledVector {
lo: unsafe { vld1q_f32(lanes.as_ptr()) },
hi: unsafe { vld1q_f32(lanes.as_ptr().add(4)) },
};
}
dct1d_32_v(&mut c);
let scale = 1.0 / 1024.0;
for u in 0..32 {
let p = unsafe { output.get_unchecked_mut(u * 32 + g * 8..) };
unsafe {
vst1q_f32(p.as_mut_ptr(), vmulq_n_f32(c[u].lo, scale));
vst1q_f32(
p.get_unchecked_mut(4..).as_mut_ptr(),
vmulq_n_f32(c[u].hi, scale),
);
}
}
}
}
#[target_feature(enable = "neon")]
fn dct1d_4_q(c: &mut [float32x4_t; 4]) {
let t0 = vaddq_f32(c[0], c[3]);
let t1 = vaddq_f32(c[1], c[2]);
let sum = vaddq_f32(t0, t1);
let diff = vsubq_f32(t0, t1);
let t2 = vmulq_n_f32(vsubq_f32(c[0], c[3]), WC4[0]);
let t3 = vmulq_n_f32(vsubq_f32(c[1], c[2]), WC4[1]);
let t2p = vaddq_f32(t2, t3);
let t3p = vsubq_f32(t2, t3);
let t2pp = vfmaq_n_f32(t3p, t2p, std::f32::consts::SQRT_2);
c[0] = sum;
c[1] = t2pp;
c[2] = diff;
c[3] = t3p;
}
#[target_feature(enable = "neon")]
pub(crate) fn dct4x4_neon(input: &[f32; 64], output: &mut [f32; 64]) {
let mut q = [vdupq_n_f32(0.0); 16];
for r in 0..4 {
for col in 0..4 {
let lanes = [
input[r * 8 + col], input[r * 8 + (4 + col)], input[(4 + r) * 8 + col], input[(4 + r) * 8 + (4 + col)], ];
q[r * 4 + col] = unsafe { vld1q_f32(lanes.as_ptr()) };
}
}
for r in 0..4 {
let mut row = [q[r * 4], q[r * 4 + 1], q[r * 4 + 2], q[r * 4 + 3]];
dct1d_4_q(&mut row);
for col in 0..4 {
q[r * 4 + col] = row[col];
}
}
let mut d = [[0.0f32; 4]; 16];
for col in 0..4 {
let mut cc = [q[col], q[4 + col], q[8 + col], q[12 + col]];
dct1d_4_q(&mut cc);
for i in 0..4 {
unsafe { vst1q_f32(d[col * 4 + i].as_mut_ptr(), vmulq_n_f32(cc[i], 1.0 / 16.0)) };
}
}
for iy in 0..4 {
for ix in 0..4 {
let dd = &d[iy * 4 + ix];
for k in 0..4 {
let qy = k / 2;
let qx = k % 2;
output[(qy + iy * 2) * 8 + (qx + ix * 2)] = dd[k];
}
}
}
let b00 = output[0];
let b01 = output[1];
let b10 = output[8];
let b11 = output[9];
output[0] = (b00 + b01 + b10 + b11) * 0.25;
output[1] = (b00 + b01 - b10 - b11) * 0.25;
output[8] = (b00 - b01 + b10 - b11) * 0.25;
output[9] = (b00 - b01 - b10 + b11) * 0.25;
}
#[target_feature(enable = "neon")]
pub(crate) fn dct4x8_neon(input: &[f32; 64], output: &mut [f32; 64]) {
let rows = load(input, 8);
let mut top: [NeonDoubledVector; 4] = [rows[0], rows[1], rows[2], rows[3]];
let mut bot: [NeonDoubledVector; 4] = [rows[4], rows[5], rows[6], rows[7]];
dct1d_4_v(&mut top);
dct1d_4_v(&mut bot);
let mut r: [NeonDoubledVector; 8] = [
top[0], top[1], top[2], top[3], bot[0], bot[1], bot[2], bot[3],
];
transpose_8x8(&mut r);
dct1d_8_v(&mut r);
transpose_8x8(&mut r);
let mut buf_u = MaybeUninit::<[f32; 64]>::uninit();
scale_and_store_uninit(&r, 1.0 / 32.0, &mut buf_u);
let buf = unsafe { buf_u.assume_init() };
for k in 0..8 {
let vf = k % 4;
let half = k / 4;
for hf in 0..8 {
output[(half + vf * 2) * 8 + hf] = buf[k * 8 + hf];
}
}
let b0 = output[0];
let b1 = output[8];
output[0] = (b0 + b1) * 0.5;
output[8] = (b0 - b1) * 0.5;
}
#[target_feature(enable = "neon")]
pub(crate) fn dct8x4_neon(input: &[f32; 64], output: &mut [f32; 64]) {
let mut rows = load(input, 8);
dct1d_8_v(&mut rows);
transpose_8x8(&mut rows);
let mut left: [NeonDoubledVector; 4] = [rows[0], rows[1], rows[2], rows[3]];
let mut right: [NeonDoubledVector; 4] = [rows[4], rows[5], rows[6], rows[7]];
dct1d_4_v(&mut left);
dct1d_4_v(&mut right);
let combo: [NeonDoubledVector; 8] = [
left[0], left[1], left[2], left[3], right[0], right[1], right[2], right[3],
];
let mut buf_u = MaybeUninit::<[f32; 64]>::uninit();
scale_and_store_uninit(&combo, 1.0 / 32.0, &mut buf_u);
let buf = unsafe { buf_u.assume_init() };
for hf in 0..4 {
for vf in 0..8 {
output[(hf * 2) * 8 + vf] = buf[hf * 8 + vf];
output[(1 + hf * 2) * 8 + vf] = buf[(4 + hf) * 8 + vf];
}
}
let b0 = output[0];
let b1 = output[8];
output[0] = (b0 + b1) * 0.5;
output[8] = (b0 - b1) * 0.5;
}
#[target_feature(enable = "neon")]
pub(crate) fn dct32x16_neon(input: &[f32; 512], output: &mut [f32; 512]) {
let zero = NeonDoubledVector {
lo: vdupq_n_f32(0.0),
hi: vdupq_n_f32(0.0),
};
let mut after_col_u = MaybeUninit::<[f32; 512]>::uninit();
for g in 0..2 {
let mut c = [zero; 32];
for r in 0..32 {
let p = unsafe { input.get_unchecked(r * 16 + g * 8..) };
c[r] = NeonDoubledVector {
lo: unsafe { vld1q_f32(p.as_ptr()) },
hi: unsafe { vld1q_f32(p.get_unchecked(4..).as_ptr()) },
};
}
dct1d_32_v(&mut c);
for v in 0..32 {
let after_col_dst = after_col_u.as_mut_ptr() as *mut f32;
let p = unsafe { after_col_dst.add(v * 16 + g * 8) };
unsafe {
vst1q_f32(p, c[v].lo);
vst1q_f32(p.add(4), c[v].hi);
}
}
}
let after_col = unsafe { after_col_u.assume_init() };
let scale = 1.0 / 512.0;
for g in 0..4 {
let b = g * 8;
let mut c = [zero; 16];
for u in 0..16 {
let lanes = [
after_col[b * 16 + u],
after_col[(b + 1) * 16 + u],
after_col[(b + 2) * 16 + u],
after_col[(b + 3) * 16 + u],
after_col[(b + 4) * 16 + u],
after_col[(b + 5) * 16 + u],
after_col[(b + 6) * 16 + u],
after_col[(b + 7) * 16 + u],
];
c[u] = NeonDoubledVector {
lo: unsafe { vld1q_f32(lanes.as_ptr()) },
hi: unsafe { vld1q_f32(lanes.as_ptr().add(4)) },
};
}
dct1d_16_v(&mut c);
for u in 0..16 {
let p = unsafe { output.get_unchecked_mut(u * 32 + g * 8..) };
unsafe {
vst1q_f32(p.as_mut_ptr(), vmulq_n_f32(c[u].lo, scale));
vst1q_f32(
p.get_unchecked_mut(4..).as_mut_ptr(),
vmulq_n_f32(c[u].hi, scale),
);
}
}
}
}
#[target_feature(enable = "neon")]
pub(crate) fn dct16x32_neon(input: &[f32; 512], output: &mut [f32; 512]) {
let zero = NeonDoubledVector {
lo: vdupq_n_f32(0.0),
hi: vdupq_n_f32(0.0),
};
let mut after_row_u = MaybeUninit::<[f32; 512]>::uninit();
for g in 0..2 {
let b = g * 8;
let mut c = [zero; 32];
for u in 0..32 {
let lanes = [
input[b * 32 + u],
input[(b + 1) * 32 + u],
input[(b + 2) * 32 + u],
input[(b + 3) * 32 + u],
input[(b + 4) * 32 + u],
input[(b + 5) * 32 + u],
input[(b + 6) * 32 + u],
input[(b + 7) * 32 + u],
];
c[u] = NeonDoubledVector {
lo: unsafe { vld1q_f32(lanes.as_ptr()) },
hi: unsafe { vld1q_f32(lanes.as_ptr().add(4)) },
};
}
dct1d_32_v(&mut c);
for u in 0..32 {
let after_row_ptr = after_row_u.as_mut_ptr() as *mut f32;
let p = unsafe { after_row_ptr.add(u * 16 + b) };
unsafe {
vst1q_f32(p, c[u].lo);
vst1q_f32(p.add(4), c[u].hi);
}
}
}
let after_row = unsafe { after_row_u.assume_init() };
let scale = 1.0 / 512.0;
for g in 0..4 {
let b = g * 8;
let mut c = [zero; 16];
for r in 0..16 {
let lanes = [
after_row[b * 16 + r],
after_row[(b + 1) * 16 + r],
after_row[(b + 2) * 16 + r],
after_row[(b + 3) * 16 + r],
after_row[(b + 4) * 16 + r],
after_row[(b + 5) * 16 + r],
after_row[(b + 6) * 16 + r],
after_row[(b + 7) * 16 + r],
];
c[r] = NeonDoubledVector {
lo: unsafe { vld1q_f32(lanes.as_ptr()) },
hi: unsafe { vld1q_f32(lanes.as_ptr().add(4)) },
};
}
dct1d_16_v(&mut c);
for v in 0..16 {
let p = unsafe { output.get_unchecked_mut(v * 32 + g * 8..) };
unsafe {
vst1q_f32(p.as_mut_ptr(), vmulq_n_f32(c[v].lo, scale));
vst1q_f32(
p.get_unchecked_mut(4..).as_mut_ptr(),
vmulq_n_f32(c[v].hi, scale),
);
}
}
}
}
#[cfg(test)]
mod neon_dct_tests {
use crate::dct::{dct8x8_scalar, dct8x16_scalar, dct16x8_scalar};
const ATOL: f32 = 1e-4;
fn assert_close(neon: &[f32], scalar: &[f32], label: &str) {
assert_eq!(neon.len(), scalar.len(), "{label}: length mismatch");
let mut max_err: f32 = 0.0;
let mut worst = 0usize;
for (i, (n, s)) in neon.iter().zip(scalar.iter()).enumerate() {
let e = (n - s).abs();
if e > max_err {
max_err = e;
worst = i;
}
}
assert!(
max_err < ATOL,
"{label}: max error {max_err:.2e} at index {worst} \
(neon={:.6}, scalar={:.6})",
neon[worst],
scalar[worst]
);
}
fn rng_f32(seed: u64) -> f32 {
let mut x = seed.wrapping_add(0x9e3779b97f4a7c15);
x = (x ^ (x >> 30)).wrapping_mul(0xbf58476d1ce4e5b9);
x = (x ^ (x >> 27)).wrapping_mul(0x94d049bb133111eb);
x ^= x >> 31;
let u = (x >> 41) as f32; u / (1u32 << 23) as f32 * 2.0 - 1.0
}
fn fill<const N: usize>(seed: u64) -> [f32; N] {
let mut buf = [0.0f32; N];
for (i, v) in buf.iter_mut().enumerate() {
*v = rng_f32(seed.wrapping_add((i as u64).wrapping_mul(6364136223846793005)));
}
buf
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x8_neon_vs_scalar_random() {
use crate::neon::dct8x8_neon;
for seed in 0u64..32 {
let input: [f32; 64] = fill(seed);
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct8x8_neon(&input, &mut got) };
dct8x8_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct8x8 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x8_neon_dc_only() {
use crate::neon::dct8x8_neon;
let input = [0.5f32; 64];
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct8x8_neon(&input, &mut got) };
dct8x8_scalar(&input, &mut want);
assert_close(&got, &want, "dct8x8 dc-only");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x8_neon_zero() {
use crate::neon::dct8x8_neon;
let input = [0.0f32; 64];
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct8x8_neon(&input, &mut got) };
dct8x8_scalar(&input, &mut want);
assert_close(&got, &want, "dct8x8 zero");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x8_neon_linearity() {
use crate::neon::dct8x8_neon;
let a: [f32; 64] = fill(100);
let b: [f32; 64] = fill(200);
let mut sum = [0.0f32; 64];
for i in 0..64 {
sum[i] = a[i] + b[i];
}
let mut da = [0.0f32; 64];
let mut db = [0.0f32; 64];
let mut dsum = [0.0f32; 64];
unsafe {
dct8x8_neon(&a, &mut da);
dct8x8_neon(&b, &mut db);
dct8x8_neon(&sum, &mut dsum);
}
let expected: Vec<f32> = (0..64).map(|i| da[i] + db[i]).collect();
assert_close(&dsum, &expected, "dct8x8 linearity");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x8_neon_basis_vectors() {
use crate::neon::dct8x8_neon;
for k in 0..64 {
let mut input = [0.0f32; 64];
input[k] = 1.0;
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct8x8_neon(&input, &mut got) };
dct8x8_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct8x8 basis[{k}]"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x16_neon_vs_scalar_random() {
use crate::neon::dct8x16_neon;
for seed in 0u64..32 {
let input: [f32; 128] = fill(seed.wrapping_add(0xdead));
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct8x16_neon(&input, &mut got) };
dct8x16_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct8x16 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x16_neon_dc_only() {
use crate::neon::dct8x16_neon;
let input = [0.5f32; 128];
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct8x16_neon(&input, &mut got) };
dct8x16_scalar(&input, &mut want);
assert_close(&got, &want, "dct8x16 dc-only");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x16_neon_zero() {
use crate::neon::dct8x16_neon;
let input = [0.0f32; 128];
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct8x16_neon(&input, &mut got) };
dct8x16_scalar(&input, &mut want);
assert_close(&got, &want, "dct8x16 zero");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x16_neon_basis_vectors() {
use crate::neon::dct8x16_neon;
for k in 0..128 {
let mut input = [0.0f32; 128];
input[k] = 1.0;
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct8x16_neon(&input, &mut got) };
dct8x16_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct8x16 basis[{k}]"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x16_neon_linearity() {
use crate::neon::dct8x16_neon;
let a: [f32; 128] = fill(300);
let b: [f32; 128] = fill(400);
let mut sum = [0.0f32; 128];
for i in 0..128 {
sum[i] = a[i] + b[i];
}
let mut da = [0.0f32; 128];
let mut db = [0.0f32; 128];
let mut dsum = [0.0f32; 128];
unsafe {
dct8x16_neon(&a, &mut da);
dct8x16_neon(&b, &mut db);
dct8x16_neon(&sum, &mut dsum);
}
let expected: Vec<f32> = (0..128).map(|i| da[i] + db[i]).collect();
assert_close(&dsum, &expected, "dct8x16 linearity");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x8_neon_vs_scalar_random() {
use crate::neon::dct16x8_neon;
for seed in 0u64..32 {
let input: [f32; 128] = fill(seed.wrapping_add(0xbeef));
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct16x8_neon(&input, &mut got) };
dct16x8_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct16x8 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct4x8_neon_vs_scalar_random() {
use crate::dct::dct4x8_scalar;
use crate::neon::dct4x8_neon;
for seed in 0u64..32 {
let input: [f32; 64] = fill(seed.wrapping_add(0x4a8));
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct4x8_neon(&input, &mut got) };
dct4x8_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct4x8 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x4_neon_vs_scalar_random() {
use crate::dct::dct8x4_scalar;
use crate::neon::dct8x4_neon;
for seed in 0u64..32 {
let input: [f32; 64] = fill(seed.wrapping_add(0x8a4));
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct8x4_neon(&input, &mut got) };
dct8x4_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct8x4 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x8_neon_dc_only() {
use crate::neon::dct16x8_neon;
let input = [0.5f32; 128];
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct16x8_neon(&input, &mut got) };
dct16x8_scalar(&input, &mut want);
assert_close(&got, &want, "dct16x8 dc-only");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x8_neon_zero() {
use crate::neon::dct16x8_neon;
let input = [0.0f32; 128];
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct16x8_neon(&input, &mut got) };
dct16x8_scalar(&input, &mut want);
assert_close(&got, &want, "dct16x8 zero");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x8_neon_basis_vectors() {
use crate::neon::dct16x8_neon;
for k in 0..128 {
let mut input = [0.0f32; 128];
input[k] = 1.0;
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct16x8_neon(&input, &mut got) };
dct16x8_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct16x8 basis[{k}]"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x8_neon_linearity() {
use crate::neon::dct16x8_neon;
let a: [f32; 128] = fill(500);
let b: [f32; 128] = fill(600);
let mut sum = [0.0f32; 128];
for i in 0..128 {
sum[i] = a[i] + b[i];
}
let mut da = [0.0f32; 128];
let mut db = [0.0f32; 128];
let mut dsum = [0.0f32; 128];
unsafe {
dct16x8_neon(&a, &mut da);
dct16x8_neon(&b, &mut db);
dct16x8_neon(&sum, &mut dsum);
}
let expected: Vec<f32> = (0..128).map(|i| da[i] + db[i]).collect();
assert_close(&dsum, &expected, "dct16x8 linearity");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dc_coefficient_constant_input() {
use crate::neon::{dct8x16_neon, dct16x8_neon};
let input = [0.25f32; 128];
let mut out8x16 = [0.0f32; 128];
let mut out16x8 = [0.0f32; 128];
unsafe {
dct8x16_neon(&input, &mut out8x16);
dct16x8_neon(&input, &mut out16x8);
}
assert!(
(out8x16[0] - out16x8[0]).abs() < ATOL,
"DC mismatch: 8x16={} 16x8={}",
out8x16[0],
out16x8[0]
);
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x8_neon_extreme_values() {
use crate::neon::dct8x8_neon;
let mut input = [0.0f32; 64];
for i in 0..64 {
input[i] = if i % 2 == 0 { 1.0 } else { -1.0 };
}
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct8x8_neon(&input, &mut got) };
dct8x8_scalar(&input, &mut want);
assert_close(&got, &want, "dct8x8 alternating +-1");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x8_neon_extreme_values() {
use crate::neon::dct16x8_neon;
let mut input = [0.0f32; 128];
for i in 0..128 {
input[i] = if i % 2 == 0 { 1.0 } else { -1.0 };
}
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct16x8_neon(&input, &mut got) };
dct16x8_scalar(&input, &mut want);
assert_close(&got, &want, "dct16x8 alternating +-1");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct8x16_neon_extreme_values() {
use crate::neon::dct8x16_neon;
let mut input = [0.0f32; 128];
for i in 0..128 {
input[i] = if i % 2 == 0 { 1.0 } else { -1.0 };
}
let mut got = [0.0f32; 128];
let mut want = [0.0f32; 128];
unsafe { dct8x16_neon(&input, &mut got) };
dct8x16_scalar(&input, &mut want);
assert_close(&got, &want, "dct8x16 alternating +-1");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x16_neon_vs_scalar_random() {
use crate::dct::dct16x16_scalar;
use crate::neon::dct16x16_neon;
for seed in 0u64..32 {
let input: [f32; 256] = fill(seed.wrapping_add(0xf00d));
let mut got = [0.0f32; 256];
let mut want = [0.0f32; 256];
unsafe { dct16x16_neon(&input, &mut got) };
dct16x16_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct16x16 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct32x32_neon_vs_scalar_random() {
use crate::dct::dct32x32_scalar;
use crate::neon::dct32x32_neon;
for seed in 0u64..16 {
let input: [f32; 1024] = fill(seed.wrapping_add(0x3232));
let mut got = [0.0f32; 1024];
let mut want = [0.0f32; 1024];
unsafe { dct32x32_neon(&input, &mut got) };
dct32x32_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct32x32 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct32x16_neon_vs_scalar_random() {
use crate::dct::dct32x16_scalar;
use crate::neon::dct32x16_neon;
for seed in 0u64..16 {
let input: [f32; 512] = fill(seed.wrapping_add(0x3216));
let mut got = [0.0f32; 512];
let mut want = [0.0f32; 512];
unsafe { dct32x16_neon(&input, &mut got) };
dct32x16_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct32x16 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x32_neon_vs_scalar_random() {
use crate::dct::dct16x32_scalar;
use crate::neon::dct16x32_neon;
for seed in 0u64..16 {
let input: [f32; 512] = fill(seed.wrapping_add(0x1632));
let mut got = [0.0f32; 512];
let mut want = [0.0f32; 512];
unsafe { dct16x32_neon(&input, &mut got) };
dct16x32_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct16x32 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct4x4_neon_vs_scalar_random() {
use crate::dct::dct4x4_scalar;
use crate::neon::dct4x4_neon;
for seed in 0u64..32 {
let input: [f32; 64] = fill(seed.wrapping_add(0x4a4));
let mut got = [0.0f32; 64];
let mut want = [0.0f32; 64];
unsafe { dct4x4_neon(&input, &mut got) };
dct4x4_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct4x4 seed={seed}"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x16_neon_dc_only() {
use crate::dct::dct16x16_scalar;
use crate::neon::dct16x16_neon;
let input = [0.5f32; 256];
let mut got = [0.0f32; 256];
let mut want = [0.0f32; 256];
unsafe { dct16x16_neon(&input, &mut got) };
dct16x16_scalar(&input, &mut want);
assert_close(&got, &want, "dct16x16 dc-only");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x16_neon_zero() {
use crate::dct::dct16x16_scalar;
use crate::neon::dct16x16_neon;
let input = [0.0f32; 256];
let mut got = [0.0f32; 256];
let mut want = [0.0f32; 256];
unsafe { dct16x16_neon(&input, &mut got) };
dct16x16_scalar(&input, &mut want);
assert_close(&got, &want, "dct16x16 zero");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x16_neon_basis_vectors() {
use crate::dct::dct16x16_scalar;
use crate::neon::dct16x16_neon;
for k in 0..256 {
let mut input = [0.0f32; 256];
input[k] = 1.0;
let mut got = [0.0f32; 256];
let mut want = [0.0f32; 256];
unsafe { dct16x16_neon(&input, &mut got) };
dct16x16_scalar(&input, &mut want);
assert_close(&got, &want, &format!("dct16x16 basis[{k}]"));
}
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x16_neon_linearity() {
use crate::neon::dct16x16_neon;
let a: [f32; 256] = fill(700);
let b: [f32; 256] = fill(800);
let mut sum = [0.0f32; 256];
for i in 0..256 {
sum[i] = a[i] + b[i];
}
let mut da = [0.0f32; 256];
let mut db = [0.0f32; 256];
let mut dsum = [0.0f32; 256];
unsafe {
dct16x16_neon(&a, &mut da);
dct16x16_neon(&b, &mut db);
dct16x16_neon(&sum, &mut dsum);
}
let expected: Vec<f32> = (0..256).map(|i| da[i] + db[i]).collect();
assert_close(&dsum, &expected, "dct16x16 linearity");
}
#[test]
#[cfg(all(target_arch = "aarch64", feature = "neon"))]
fn test_dct16x16_neon_extreme_values() {
use crate::dct::dct16x16_scalar;
use crate::neon::dct16x16_neon;
let mut input = [0.0f32; 256];
for i in 0..256 {
input[i] = if i % 2 == 0 { 1.0 } else { -1.0 };
}
let mut got = [0.0f32; 256];
let mut want = [0.0f32; 256];
unsafe { dct16x16_neon(&input, &mut got) };
dct16x16_scalar(&input, &mut want);
assert_close(&got, &want, "dct16x16 alternating +-1");
}
}