use glam::Vec3A;
use crate::shared::round_ties_even;
#[inline]
#[must_use]
pub(crate) fn sin_tab(j: i32) -> f32 {
let j = j as f32;
let angle = ((j + j) * std::f32::consts::PI) * (1.0 / 16384.0);
f64::from(angle).sin() as f32
}
#[inline]
#[must_use]
pub(crate) fn sin_tab_angle(angle: i32) -> f32 {
sin_tab((angle >> 2) & 0x3FFF)
}
#[inline]
#[must_use]
pub(crate) fn rotator_units(y: f32, x: f32) -> i32 {
let units = (y.atan2(x) * 32768.0) / std::f32::consts::PI;
(round_ties_even(units + units + 0.5) as i32) >> 1
}
#[inline]
#[must_use]
pub(crate) fn dodge_yaw_units(y: f32, x: f32) -> i32 {
let units = y.atan2(x) * (32768.0 / std::f32::consts::PI);
round_ties_even(units) as i32
}
#[inline]
#[must_use]
pub(crate) fn rotator_forward(forward: Vec3A) -> Vec3A {
let yaw = rotator_units(forward.y, forward.x);
let xy = f64::from(forward.y * forward.y + forward.x * forward.x).sqrt() as f32;
let pitch = rotator_units(forward.z, xy);
let cos_pitch = sin_tab_angle(pitch + 0x4000);
Vec3A::new(
cos_pitch * sin_tab_angle(yaw + 0x4000),
cos_pitch * sin_tab_angle(yaw),
sin_tab_angle(pitch),
)
}