use glam::{Mat3A, Quat, Vec3A};
#[inline]
#[must_use]
pub(crate) fn quat_axes(q: Quat) -> (Vec3A, Vec3A, Vec3A) {
let m = Mat3A::from_quat(q);
(m.x_axis, m.y_axis, m.z_axis)
}
#[inline]
#[must_use]
pub(crate) fn quat_rotate(q: Quat, v: Vec3A) -> Vec3A {
q * v
}
#[inline]
#[must_use]
pub(crate) fn rotator_forward(forward: Vec3A) -> Vec3A {
forward.normalize_or_zero()
}
#[inline]
#[must_use]
pub(crate) fn auto_flip_up(q: Quat) -> Vec3A {
q * Vec3A::Z
}
#[inline]
#[must_use]
pub(crate) fn dodge_direction(forward: Vec3A) -> Vec3A {
let horizontal = Vec3A::new(forward.x, forward.y, 0.0).normalize_or_zero();
if horizontal == Vec3A::ZERO {
let (sin, cos) = forward.y.atan2(forward.x).sin_cos();
return Vec3A::new(cos, sin, 0.0);
}
horizontal
}