use crate::danger::core_simd_api::SimdRegister;
use crate::math::Math;
#[inline(always)]
pub unsafe fn generic_squared_norm<T, R, M>(dims: usize, a: &[T]) -> T
where
T: Copy,
R: SimdRegister<T>,
M: Math<T>,
{
debug_assert_eq!(a.len(), dims, "Vector a does not match size `dims`");
let offset_from = dims % R::elements_per_dense();
let a_ptr = a.as_ptr();
let mut total = R::zeroed_dense();
let mut i = 0;
while i < (dims - offset_from) {
let l1 = R::load_dense(a_ptr.add(i));
total = R::fmadd_dense(l1, l1, total);
i += R::elements_per_dense();
}
let mut total = R::sum_to_register(total);
let offset_from = offset_from % R::elements_per_lane();
while i < (dims - offset_from) {
let l1 = R::load(a_ptr.add(i));
total = R::fmadd(l1, l1, total);
i += R::elements_per_lane();
}
let mut total = R::sum_to_value(total);
while i < dims {
let a = *a.get_unchecked(i);
total = M::add(total, M::mul(a, a));
i += 1;
}
total
}
#[cfg(test)]
pub(crate) unsafe fn test_squared_norm<T, R>(l1: Vec<T>)
where
T: Copy + PartialEq + std::fmt::Debug,
R: SimdRegister<T>,
crate::math::AutoMath: Math<T>,
{
use crate::math::AutoMath;
let dims = l1.len();
let value = generic_squared_norm::<T, R, AutoMath>(dims, &l1);
let expected_value = crate::test_utils::simple_dot(&l1, &l1);
assert!(
AutoMath::is_close(value, expected_value),
"value missmatch {value:?} vs {expected_value:?}"
);
}