1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
use crate::math::Vector;
#[cfg(feature = "dim2")]
use na::Isometry2;
#[cfg(feature = "dim3")]
use na::Isometry3;
use na::{RealField, Unit};
pub trait IsometryOps<N: RealField> {
fn absolute_transform_vector(&self, v: &Vector<N>) -> Vector<N>;
fn inverse_transform_unit_vector(&self, v: &Unit<Vector<N>>) -> Unit<Vector<N>>;
fn lerp_slerp(&self, other: &Self, t: N) -> Self;
}
#[cfg(feature = "dim2")]
impl<N: RealField> IsometryOps<N> for Isometry2<N> {
#[inline]
fn absolute_transform_vector(&self, v: &Vector<N>) -> Vector<N> {
self.rotation.to_rotation_matrix().into_inner().abs() * *v
}
#[inline]
fn inverse_transform_unit_vector(&self, v: &Unit<Vector<N>>) -> Unit<Vector<N>> {
let v = self.inverse_transform_vector(v.as_ref());
Unit::new_unchecked(v)
}
#[inline]
fn lerp_slerp(&self, other: &Self, t: N) -> Self {
let tr = self.translation.vector.lerp(&other.translation.vector, t);
let ang = self.rotation.angle() * (N::one() - t) + other.rotation.angle() * t;
Self::new(tr, ang)
}
}
#[cfg(feature = "dim3")]
impl<N: RealField> IsometryOps<N> for Isometry3<N> {
#[inline]
fn absolute_transform_vector(&self, v: &Vector<N>) -> Vector<N> {
self.rotation.to_rotation_matrix().into_inner().abs() * *v
}
#[inline]
fn inverse_transform_unit_vector(&self, v: &Unit<Vector<N>>) -> Unit<Vector<N>> {
let v = self.inverse_transform_vector(v.as_ref());
Unit::new_unchecked(v)
}
#[inline]
fn lerp_slerp(&self, other: &Self, t: N) -> Self {
let tr = self.translation.vector.lerp(&other.translation.vector, t);
let rot = self.rotation.slerp(&other.rotation, t);
Self::from_parts(tr.into(), rot)
}
}