use bevy_math::{Mat4, Vec3, Vec4};
pub struct ViewRangefinder3d {
view_from_world_row_2: Vec4,
}
impl ViewRangefinder3d {
pub fn from_world_from_view(world_from_view: &Mat4) -> ViewRangefinder3d {
let view_from_world = world_from_view.inverse();
ViewRangefinder3d {
view_from_world_row_2: view_from_world.row(2),
}
}
#[inline]
pub fn distance_translation(&self, translation: &Vec3) -> f32 {
self.view_from_world_row_2.dot(translation.extend(1.0))
}
#[inline]
pub fn distance(&self, transform: &Mat4) -> f32 {
self.view_from_world_row_2.dot(transform.col(3))
}
}
#[cfg(test)]
mod tests {
use super::ViewRangefinder3d;
use bevy_math::{Mat4, Vec3};
#[test]
fn distance() {
let view_matrix = Mat4::from_translation(Vec3::new(0.0, 0.0, -1.0));
let rangefinder = ViewRangefinder3d::from_world_from_view(&view_matrix);
assert_eq!(rangefinder.distance(&Mat4::IDENTITY), 1.0);
assert_eq!(
rangefinder.distance(&Mat4::from_translation(Vec3::new(0.0, 0.0, 1.0))),
2.0
);
}
}