use std::arch::aarch64::*;
use crate::entropy::ALPHABET_SIZE;
#[inline]
#[target_feature(enable = "neon")]
fn dirty_log2f_x4(d: float32x4_t) -> float32x4_t {
let one = vdupq_n_f32(1.0);
let mut ix = vreinterpretq_u32_f32(d);
ix = vaddq_u32(ix, vdupq_n_u32(0x3f80_0000u32 - 0x3f35_04f3u32));
let n = vreinterpretq_s32_u32(vsubq_u32(vshrq_n_u32(ix, 23), vdupq_n_u32(0x7f)));
ix = vaddq_u32(
vandq_u32(ix, vdupq_n_u32(0x007f_ffff)),
vdupq_n_u32(0x3f35_04f3),
);
let a = vreinterpretq_f32_u32(ix);
let x = vdivq_f32(vsubq_f32(a, one), vaddq_f32(a, one));
let x2 = vmulq_f32(x, x);
let mut u = vdupq_n_f32(0.412_198_57);
u = vfmaq_f32(vdupq_n_f32(0.577_078_04), u, x2);
u = vfmaq_f32(vdupq_n_f32(0.961_796_7), u, x2);
let base = vfmaq_f32(vcvtq_f32_s32(n), x, vdupq_n_f32(2.885_390_1));
vfmaq_f32(base, vmulq_f32(x2, x), u)
}
#[target_feature(enable = "neon")]
pub(crate) fn counts_bit_cost_neon(counts: &[u32; ALPHABET_SIZE], total_count: u32) -> f32 {
debug_assert_ne!(total_count, 0);
let log_total = vdupq_n_f32(crate::adaptive_quant::dirty_log2f(total_count as f32));
let one = vdupq_n_f32(1.0);
let mut cost0 = vdupq_n_f32(0.0);
let mut cost1 = vdupq_n_f32(0.0);
for counts8 in counts.as_chunks::<8>().0 {
let count0 = vcvtq_f32_u32(unsafe { vld1q_u32(counts8.as_ptr()) });
let count1 = vcvtq_f32_u32(unsafe { vld1q_u32(counts8.as_ptr().add(4)) });
let positive0 = vmaxq_f32(count0, one);
let positive1 = vmaxq_f32(count1, one);
cost0 = vfmaq_f32(
cost0,
count0,
vsubq_f32(log_total, dirty_log2f_x4(positive0)),
);
cost1 = vfmaq_f32(
cost1,
count1,
vsubq_f32(log_total, dirty_log2f_x4(positive1)),
);
}
vaddvq_f32(vaddq_f32(cost0, cost1)).max(0.0)
}