1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
use na::{Real, Rotation3, Unit, UnitQuaternion}; use aliases::{Qua, TMat4, TVec3}; /// Builds a rotation 4 * 4 matrix created from a normalized axis and an angle. /// /// # Parameters /// * `m` - Input matrix multiplied by this rotation matrix. /// * `angle` - Rotation angle expressed in radians. /// * `axis` - Rotation axis, must be normalized. pub fn rotate_normalized_axis<N: Real>(m: &TMat4<N>, angle: N, axis: &TVec3<N>) -> TMat4<N> { m * Rotation3::from_axis_angle(&Unit::new_unchecked(*axis), angle).to_homogeneous() } /// Rotates a quaternion from a vector of 3 components normalized axis and an angle. /// /// # Parameters /// * `q` - Source orientation /// * `angle` - Angle expressed in radians. /// * `axis` - Normalized axis of the rotation, must be normalized. pub fn quat_rotate_normalized_axis<N: Real>(q: &Qua<N>, angle: N, axis: &TVec3<N>) -> Qua<N> { q * UnitQuaternion::from_axis_angle(&Unit::new_unchecked(*axis), angle).unwrap() }