2016-12-05 05:44:42 +08:00
|
|
|
#[cfg(feature = "arbitrary")]
|
|
|
|
use quickcheck::{Arbitrary, Gen};
|
2017-08-03 01:37:44 +08:00
|
|
|
#[cfg(feature = "arbitrary")]
|
2018-05-19 23:15:15 +08:00
|
|
|
use base::storage::Owned;
|
2016-12-05 05:44:42 +08:00
|
|
|
|
|
|
|
use num::One;
|
2018-02-02 19:26:35 +08:00
|
|
|
use rand::{Rand, Rng};
|
2016-12-05 05:44:42 +08:00
|
|
|
|
|
|
|
use alga::general::Real;
|
|
|
|
use alga::linear::Rotation as AlgaRotation;
|
|
|
|
|
2018-05-19 23:15:15 +08:00
|
|
|
use base::{DefaultAllocator, Vector2, Vector3};
|
|
|
|
use base::dimension::{DimName, U2, U3};
|
|
|
|
use base::allocator::Allocator;
|
2016-12-05 05:44:42 +08:00
|
|
|
|
2018-02-02 19:26:35 +08:00
|
|
|
use geometry::{Isometry, Point, Point3, Rotation2, Rotation3, Similarity, Translation,
|
|
|
|
UnitComplex, UnitQuaternion};
|
2016-12-05 05:44:42 +08:00
|
|
|
|
2017-08-03 01:37:44 +08:00
|
|
|
impl<N: Real, D: DimName, R> Similarity<N, D, R>
|
2018-02-02 19:26:35 +08:00
|
|
|
where
|
|
|
|
R: AlgaRotation<Point<N, D>>,
|
|
|
|
DefaultAllocator: Allocator<N, D>,
|
|
|
|
{
|
2016-12-05 05:44:42 +08:00
|
|
|
/// Creates a new identity similarity.
|
|
|
|
#[inline]
|
|
|
|
pub fn identity() -> Self {
|
2017-08-03 01:37:44 +08:00
|
|
|
Self::from_isometry(Isometry::identity(), N::one())
|
2016-12-05 05:44:42 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-03 01:37:44 +08:00
|
|
|
impl<N: Real, D: DimName, R> One for Similarity<N, D, R>
|
2018-02-02 19:26:35 +08:00
|
|
|
where
|
|
|
|
R: AlgaRotation<Point<N, D>>,
|
|
|
|
DefaultAllocator: Allocator<N, D>,
|
|
|
|
{
|
2016-12-05 05:44:42 +08:00
|
|
|
/// Creates a new identity similarity.
|
|
|
|
#[inline]
|
|
|
|
fn one() -> Self {
|
|
|
|
Self::identity()
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-03 01:37:44 +08:00
|
|
|
impl<N: Real + Rand, D: DimName, R> Rand for Similarity<N, D, R>
|
2018-02-02 19:26:35 +08:00
|
|
|
where
|
|
|
|
R: AlgaRotation<Point<N, D>> + Rand,
|
|
|
|
DefaultAllocator: Allocator<N, D>,
|
|
|
|
{
|
2016-12-05 05:44:42 +08:00
|
|
|
#[inline]
|
|
|
|
fn rand<G: Rng>(rng: &mut G) -> Self {
|
|
|
|
let mut s = rng.gen();
|
|
|
|
while relative_eq!(s, N::zero()) {
|
|
|
|
s = rng.gen()
|
|
|
|
}
|
|
|
|
|
|
|
|
Self::from_isometry(rng.gen(), s)
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-03 01:37:44 +08:00
|
|
|
impl<N: Real, D: DimName, R> Similarity<N, D, R>
|
2018-02-02 19:26:35 +08:00
|
|
|
where
|
|
|
|
R: AlgaRotation<Point<N, D>>,
|
|
|
|
DefaultAllocator: Allocator<N, D>,
|
|
|
|
{
|
2016-12-05 05:44:42 +08:00
|
|
|
/// The similarity that applies tha scaling factor `scaling`, followed by the rotation `r` with
|
|
|
|
/// its axis passing through the point `p`.
|
|
|
|
#[inline]
|
2017-08-03 01:37:44 +08:00
|
|
|
pub fn rotation_wrt_point(r: R, p: Point<N, D>, scaling: N) -> Self {
|
2016-12-05 05:44:42 +08:00
|
|
|
let shift = r.transform_vector(&-&p.coords);
|
2017-08-03 01:37:44 +08:00
|
|
|
Self::from_parts(Translation::from_vector(shift + p.coords), r, scaling)
|
2016-12-05 05:44:42 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#[cfg(feature = "arbitrary")]
|
2017-08-03 01:37:44 +08:00
|
|
|
impl<N, D: DimName, R> Arbitrary for Similarity<N, D, R>
|
2018-02-02 19:26:35 +08:00
|
|
|
where
|
|
|
|
N: Real + Arbitrary + Send,
|
|
|
|
R: AlgaRotation<Point<N, D>> + Arbitrary + Send,
|
|
|
|
DefaultAllocator: Allocator<N, D>,
|
|
|
|
Owned<N, D>: Send,
|
|
|
|
{
|
2016-12-05 05:44:42 +08:00
|
|
|
#[inline]
|
|
|
|
fn arbitrary<G: Gen>(rng: &mut G) -> Self {
|
|
|
|
let mut s = Arbitrary::arbitrary(rng);
|
|
|
|
while relative_eq!(s, N::zero()) {
|
|
|
|
s = Arbitrary::arbitrary(rng)
|
|
|
|
}
|
|
|
|
|
|
|
|
Self::from_isometry(Arbitrary::arbitrary(rng), s)
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
*
|
|
|
|
* Constructors for various static dimensions.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
// 2D rotation.
|
2017-08-03 01:37:44 +08:00
|
|
|
impl<N: Real> Similarity<N, U2, Rotation2<N>> {
|
2016-12-05 05:44:42 +08:00
|
|
|
/// Creates a new similarity from a translation and a rotation angle.
|
|
|
|
#[inline]
|
2017-08-03 01:37:44 +08:00
|
|
|
pub fn new(translation: Vector2<N>, angle: N, scaling: N) -> Self {
|
2018-02-02 19:26:35 +08:00
|
|
|
Self::from_parts(
|
|
|
|
Translation::from_vector(translation),
|
|
|
|
Rotation2::new(angle),
|
|
|
|
scaling,
|
|
|
|
)
|
2016-12-05 05:44:42 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-03 01:37:44 +08:00
|
|
|
impl<N: Real> Similarity<N, U2, UnitComplex<N>> {
|
2017-02-13 01:17:09 +08:00
|
|
|
/// Creates a new similarity from a translation and a rotation angle.
|
|
|
|
#[inline]
|
2017-08-03 01:37:44 +08:00
|
|
|
pub fn new(translation: Vector2<N>, angle: N, scaling: N) -> Self {
|
2018-02-02 19:26:35 +08:00
|
|
|
Self::from_parts(
|
|
|
|
Translation::from_vector(translation),
|
|
|
|
UnitComplex::new(angle),
|
|
|
|
scaling,
|
|
|
|
)
|
2017-02-13 01:17:09 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
// 3D rotation.
|
|
|
|
macro_rules! similarity_construction_impl(
|
2017-08-03 01:37:44 +08:00
|
|
|
($Rot: ty) => {
|
|
|
|
impl<N: Real> Similarity<N, U3, $Rot> {
|
2016-12-05 05:44:42 +08:00
|
|
|
/// Creates a new similarity from a translation, rotation axis-angle, and scaling
|
|
|
|
/// factor.
|
|
|
|
#[inline]
|
2017-08-03 01:37:44 +08:00
|
|
|
pub fn new(translation: Vector3<N>, axisangle: Vector3<N>, scaling: N) -> Self {
|
|
|
|
Self::from_isometry(Isometry::<_, U3, $Rot>::new(translation, axisangle), scaling)
|
2016-12-05 05:44:42 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/// Creates an similarity that corresponds to the a scaling factor and a local frame of
|
|
|
|
/// an observer standing at the point `eye` and looking toward `target`.
|
|
|
|
///
|
|
|
|
/// It maps the view direction `target - eye` to the positive `z` axis and the origin to the
|
|
|
|
/// `eye`.
|
|
|
|
///
|
|
|
|
/// # Arguments
|
|
|
|
/// * eye - The observer position.
|
|
|
|
/// * target - The target position.
|
|
|
|
/// * up - Vertical direction. The only requirement of this parameter is to not be collinear
|
|
|
|
/// to `eye - at`. Non-collinearity is not checked.
|
|
|
|
#[inline]
|
2017-08-03 01:37:44 +08:00
|
|
|
pub fn new_observer_frame(eye: &Point3<N>,
|
|
|
|
target: &Point3<N>,
|
|
|
|
up: &Vector3<N>,
|
2016-12-05 05:44:42 +08:00
|
|
|
scaling: N)
|
|
|
|
-> Self {
|
2017-08-03 01:37:44 +08:00
|
|
|
Self::from_isometry(Isometry::<_, U3, $Rot>::new_observer_frame(eye, target, up), scaling)
|
2016-12-05 05:44:42 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/// Builds a right-handed look-at view matrix including scaling factor.
|
|
|
|
///
|
|
|
|
/// This conforms to the common notion of right handed look-at matrix from the computer
|
|
|
|
/// graphics community.
|
|
|
|
///
|
|
|
|
/// # Arguments
|
|
|
|
/// * eye - The eye position.
|
|
|
|
/// * target - The target position.
|
|
|
|
/// * up - A vector approximately aligned with required the vertical axis. The only
|
|
|
|
/// requirement of this parameter is to not be collinear to `target - eye`.
|
|
|
|
#[inline]
|
2017-08-03 01:37:44 +08:00
|
|
|
pub fn look_at_rh(eye: &Point3<N>,
|
|
|
|
target: &Point3<N>,
|
|
|
|
up: &Vector3<N>,
|
2016-12-05 05:44:42 +08:00
|
|
|
scaling: N)
|
|
|
|
-> Self {
|
2017-08-03 01:37:44 +08:00
|
|
|
Self::from_isometry(Isometry::<_, U3, $Rot>::look_at_rh(eye, target, up), scaling)
|
2016-12-05 05:44:42 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/// Builds a left-handed look-at view matrix including a scaling factor.
|
|
|
|
///
|
|
|
|
/// This conforms to the common notion of left handed look-at matrix from the computer
|
|
|
|
/// graphics community.
|
|
|
|
///
|
|
|
|
/// # Arguments
|
|
|
|
/// * eye - The eye position.
|
|
|
|
/// * target - The target position.
|
|
|
|
/// * up - A vector approximately aligned with required the vertical axis. The only
|
|
|
|
/// requirement of this parameter is to not be collinear to `target - eye`.
|
|
|
|
#[inline]
|
2017-08-03 01:37:44 +08:00
|
|
|
pub fn look_at_lh(eye: &Point3<N>,
|
|
|
|
target: &Point3<N>,
|
|
|
|
up: &Vector3<N>,
|
2016-12-05 05:44:42 +08:00
|
|
|
scaling: N)
|
|
|
|
-> Self {
|
2017-08-03 01:37:44 +08:00
|
|
|
Self::from_isometry(Isometry::<_, _, $Rot>::look_at_lh(eye, target, up), scaling)
|
2016-12-05 05:44:42 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
);
|
|
|
|
|
2017-08-03 01:37:44 +08:00
|
|
|
similarity_construction_impl!(Rotation3<N>);
|
|
|
|
similarity_construction_impl!(UnitQuaternion<N>);
|