2017-02-13 01:17:09 +08:00
|
|
|
|
/*!
|
|
|
|
|
# nalgebra
|
|
|
|
|
|
|
|
|
|
**nalgebra** is a linear algebra library written for Rust targeting:
|
|
|
|
|
|
|
|
|
|
* General-purpose linear algebra (still lacks a lot of features…)
|
|
|
|
|
* Real time computer graphics.
|
|
|
|
|
* Real time computer physics.
|
|
|
|
|
|
|
|
|
|
## Using **nalgebra**
|
|
|
|
|
You will need the last stable build of the [rust compiler](http://www.rust-lang.org)
|
|
|
|
|
and the official package manager: [cargo](https://github.com/rust-lang/cargo).
|
|
|
|
|
|
|
|
|
|
Simply add the following to your `Cargo.toml` file:
|
|
|
|
|
|
|
|
|
|
```.ignore
|
|
|
|
|
[dependencies]
|
|
|
|
|
nalgebra = "0.11"
|
|
|
|
|
```
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Most useful functionalities of **nalgebra** are grouped in the root module `nalgebra::`.
|
|
|
|
|
|
|
|
|
|
However, the recommended way to use **nalgebra** is to import types and traits
|
|
|
|
|
explicitly, and call free-functions using the `na::` prefix:
|
|
|
|
|
|
|
|
|
|
```.rust
|
|
|
|
|
#[macro_use]
|
|
|
|
|
extern crate approx; // For the macro relative_eq!
|
|
|
|
|
extern crate nalgebra as na;
|
|
|
|
|
use na::{Vector3, Rotation3};
|
|
|
|
|
|
|
|
|
|
fn main() {
|
|
|
|
|
let axis = Vector3::x_axis();
|
|
|
|
|
let angle = 1.57;
|
|
|
|
|
let b = Rotation3::from_axis_angle(&axis, angle);
|
|
|
|
|
|
|
|
|
|
relative_eq!(b.axis().unwrap(), axis);
|
|
|
|
|
relative_eq!(b.angle(), angle);
|
|
|
|
|
}
|
|
|
|
|
```
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
## Features
|
|
|
|
|
**nalgebra** is meant to be a general-purpose, low-dimensional, linear algebra library, with
|
|
|
|
|
an optimized set of tools for computer graphics and physics. Those features include:
|
|
|
|
|
|
|
|
|
|
* A single parametrizable type `Matrix` for vectors, (square or rectangular) matrices, and slices
|
|
|
|
|
with dimensions known either at compile-time (using type-level integers) or at runtime.
|
|
|
|
|
* Matrices and vectors with compile-time sizes are statically allocated while dynamic ones are
|
|
|
|
|
allocated on the heap.
|
|
|
|
|
* Convenient aliases for low-dimensional matrices and vectors: `Vector1` to `Vector6` and
|
|
|
|
|
`Matrix1x1` to `Matrix6x6` (including rectangular matrices like `Matrix2x5`.
|
|
|
|
|
* Points sizes known at compile time, and convenience aliases: `Point1` to `Point6`.
|
|
|
|
|
* Translation (seen as a transformation that composes by multiplication): `Translation2`,
|
|
|
|
|
`Translation3`.
|
|
|
|
|
* Rotation matrices: `Rotation2`, `Rotation3`.
|
|
|
|
|
* Quaternions: `Quaternion`, `UnitQuaternion` (for 3D rotation).
|
|
|
|
|
* Unit complex numbers can be used for 2D rotation: `UnitComplex`.
|
|
|
|
|
* Algebraic entities with a norm equal to one: `Unit<T>`, e.g., `Unit<Vector3<f32>>`.
|
|
|
|
|
* Isometries (translation ⨯ rotation): `Isometry2`, `Isometry3`
|
|
|
|
|
* Similarity transformations (translation ⨯ rotation ⨯ uniform scale): `Similarity2`, `Similarity3`.
|
|
|
|
|
* Affine transformations stored as an homogeneous matrix: `Affine2`, `Affine3`.
|
|
|
|
|
* Projective (i.e. invertible) transformations stored as an homogeneous matrix: `Projective2`,
|
|
|
|
|
`Projective3`.
|
|
|
|
|
* General transformations that does not have to be invertible, stored as an homogeneous matrix:
|
|
|
|
|
`Transform2`, `Transform3`.
|
|
|
|
|
* 3D projections for computer graphics: `Perspective3`, `Orthographic3`.
|
|
|
|
|
* Linear algebra and data analysis operators: QR decomposition, eigen-decomposition.
|
2017-02-16 05:04:34 +08:00
|
|
|
|
* Implements traits from the [alga](https://crates.io/crates/alga) crate for
|
2017-02-13 01:17:09 +08:00
|
|
|
|
generic programming.
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
// #![feature(plugin)]
|
|
|
|
|
//
|
|
|
|
|
// #![plugin(clippy)]
|
2017-02-13 01:17:09 +08:00
|
|
|
|
|
|
|
|
|
#![deny(non_camel_case_types)]
|
|
|
|
|
#![deny(unused_parens)]
|
|
|
|
|
#![deny(non_upper_case_globals)]
|
|
|
|
|
#![deny(unused_qualifications)]
|
|
|
|
|
#![deny(unused_results)]
|
|
|
|
|
#![warn(missing_docs)]
|
2017-04-09 19:19:27 +08:00
|
|
|
|
#![doc(html_root_url = "http://nalgebra.org/rustdoc")]
|
2016-08-30 03:16:15 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
#[cfg(feature = "arbitrary")]
|
|
|
|
|
extern crate quickcheck;
|
2017-02-16 05:04:34 +08:00
|
|
|
|
#[cfg(feature = "serde")]
|
2017-02-13 01:17:09 +08:00
|
|
|
|
extern crate serde;
|
2017-02-16 05:04:34 +08:00
|
|
|
|
#[cfg(feature = "serde")]
|
2017-02-13 01:17:09 +08:00
|
|
|
|
#[macro_use]
|
|
|
|
|
extern crate serde_derive;
|
2016-12-05 05:44:42 +08:00
|
|
|
|
extern crate num_traits as num;
|
|
|
|
|
extern crate num_complex;
|
|
|
|
|
extern crate rand;
|
|
|
|
|
#[macro_use]
|
|
|
|
|
extern crate approx;
|
|
|
|
|
extern crate typenum;
|
|
|
|
|
extern crate generic_array;
|
2016-08-30 03:16:15 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
extern crate alga;
|
2016-08-30 03:16:15 +08:00
|
|
|
|
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub mod core;
|
|
|
|
|
pub mod geometry;
|
|
|
|
|
mod traits;
|
2013-10-06 22:54:09 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub use core::*;
|
|
|
|
|
pub use geometry::*;
|
|
|
|
|
pub use traits::*;
|
2013-10-06 22:54:09 +08:00
|
|
|
|
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
use std::cmp::{self, PartialOrd, Ordering};
|
2013-10-14 16:22:32 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
use num::Signed;
|
2017-02-13 01:17:09 +08:00
|
|
|
|
use alga::general::{Identity, SupersetOf, MeetSemilattice, JoinSemilattice, Lattice, Inverse,
|
2016-12-05 05:44:42 +08:00
|
|
|
|
Multiplicative, Additive, AdditiveGroup};
|
|
|
|
|
use alga::linear::SquareMatrix as AlgaSquareMatrix;
|
|
|
|
|
use alga::linear::{InnerSpace, NormedSpace, FiniteDimVectorSpace, EuclideanSpace};
|
2013-10-14 16:22:32 +08:00
|
|
|
|
|
2017-02-13 01:17:09 +08:00
|
|
|
|
pub use alga::general::Id;
|
|
|
|
|
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/*
|
|
|
|
|
*
|
|
|
|
|
* Multiplicative identity.
|
|
|
|
|
*
|
|
|
|
|
*/
|
|
|
|
|
/// Gets the ubiquitous multiplicative identity element.
|
|
|
|
|
///
|
|
|
|
|
/// Same as `Id::new()`.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn id() -> Id {
|
|
|
|
|
Id::new()
|
|
|
|
|
}
|
2013-10-14 16:22:32 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Gets the multiplicative identity element.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn one<T: Identity<Multiplicative>>() -> T {
|
|
|
|
|
T::identity()
|
|
|
|
|
}
|
2013-10-14 16:22:32 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Gets the additive identity element.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn zero<T: Identity<Additive>>() -> T {
|
|
|
|
|
T::identity()
|
2013-10-14 16:22:32 +08:00
|
|
|
|
}
|
2013-10-06 22:54:09 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Gets the origin of the given point.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn origin<P: EuclideanSpace>() -> P {
|
|
|
|
|
P::origin()
|
|
|
|
|
}
|
2016-08-30 03:16:15 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/*
|
|
|
|
|
*
|
|
|
|
|
* Dimension
|
|
|
|
|
*
|
|
|
|
|
*/
|
|
|
|
|
/// The dimension of the given algebraic entity seen as a vector space.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn dimension<V: FiniteDimVectorSpace>() -> usize {
|
|
|
|
|
V::dimension()
|
|
|
|
|
}
|
2013-10-06 22:54:09 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/*
|
|
|
|
|
*
|
|
|
|
|
* Ordering
|
|
|
|
|
*
|
|
|
|
|
*/
|
|
|
|
|
// XXX: this is very naive and could probably be optimized for specific types.
|
|
|
|
|
// XXX: also, we might just want to use divisions, but assuming `val` is usually not far from `min`
|
|
|
|
|
// or `max`, would it still be more efficient?
|
|
|
|
|
/// Wraps `val` into the range `[min, max]` using modular arithmetics.
|
|
|
|
|
///
|
|
|
|
|
/// The range must not be empty.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn wrap<T>(mut val: T, min: T, max: T) -> T
|
|
|
|
|
where T: Copy + PartialOrd + AdditiveGroup {
|
2013-12-24 18:46:16 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
assert!(min < max, "Invalid wrapping bounds.");
|
|
|
|
|
let width = max - min;
|
2013-05-15 05:08:29 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
if val < min {
|
|
|
|
|
val += width;
|
2016-03-25 02:37:56 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
while val < min {
|
|
|
|
|
val += width
|
|
|
|
|
}
|
2013-05-15 05:08:29 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
val
|
|
|
|
|
}
|
|
|
|
|
else if val > max {
|
|
|
|
|
val -= width;
|
2015-01-10 08:36:13 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
while val > max {
|
|
|
|
|
val -= width
|
|
|
|
|
}
|
2013-05-15 05:08:29 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
val
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
val
|
|
|
|
|
}
|
|
|
|
|
}
|
2013-09-22 16:58:21 +08:00
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Returns a reference to the input value clamped to the interval `[min, max]`.
|
|
|
|
|
///
|
|
|
|
|
/// In particular:
|
|
|
|
|
/// * If `min < val < max`, this returns `val`.
|
|
|
|
|
/// * If `val <= min`, this retuns `min`.
|
|
|
|
|
/// * If `val >= max`, this retuns `max`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2014-10-22 01:43:25 +08:00
|
|
|
|
pub fn clamp<T: PartialOrd>(val: T, min: T, max: T) -> T {
|
2014-09-29 01:20:22 +08:00
|
|
|
|
if val > min {
|
|
|
|
|
if val < max {
|
|
|
|
|
val
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
max
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
min
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Same as `cmp::max`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2014-09-29 01:20:22 +08:00
|
|
|
|
pub fn max<T: Ord>(a: T, b: T) -> T {
|
|
|
|
|
cmp::max(a, b)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Same as `cmp::min`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2014-09-29 01:20:22 +08:00
|
|
|
|
pub fn min<T: Ord>(a: T, b: T) -> T {
|
|
|
|
|
cmp::min(a, b)
|
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// The absolute value of `a`.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn abs<T: Signed>(a: &T) -> T {
|
|
|
|
|
a.abs()
|
|
|
|
|
}
|
|
|
|
|
|
2014-09-29 01:20:22 +08:00
|
|
|
|
/// Returns the infimum of `a` and `b`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn inf<T: MeetSemilattice>(a: &T, b: &T) -> T {
|
|
|
|
|
a.meet(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Returns the supremum of `a` and `b`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn sup<T: JoinSemilattice>(a: &T, b: &T) -> T {
|
|
|
|
|
a.join(b)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Returns simultaneously the infimum and supremum of `a` and `b`.
|
|
|
|
|
#[inline]
|
|
|
|
|
pub fn inf_sup<T: Lattice>(a: &T, b: &T) -> (T, T) {
|
|
|
|
|
a.meet_join(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Compare `a` and `b` using a partial ordering relation.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_cmp<T: PartialOrd>(a: &T, b: &T) -> Option<Ordering> {
|
|
|
|
|
a.partial_cmp(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Returns `true` iff `a` and `b` are comparable and `a < b`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_lt<T: PartialOrd>(a: &T, b: &T) -> bool {
|
|
|
|
|
a.lt(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Returns `true` iff `a` and `b` are comparable and `a <= b`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_le<T: PartialOrd>(a: &T, b: &T) -> bool {
|
|
|
|
|
a.le(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Returns `true` iff `a` and `b` are comparable and `a > b`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_gt<T: PartialOrd>(a: &T, b: &T) -> bool {
|
|
|
|
|
a.gt(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Returns `true` iff `a` and `b` are comparable and `a >= b`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_ge<T: PartialOrd>(a: &T, b: &T) -> bool {
|
|
|
|
|
a.ge(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Return the minimum of `a` and `b` if they are comparable.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_min<'a, T: PartialOrd>(a: &'a T, b: &'a T) -> Option<&'a T> {
|
|
|
|
|
if let Some(ord) = a.partial_cmp(b) {
|
|
|
|
|
match ord {
|
|
|
|
|
Ordering::Greater => Some(b),
|
|
|
|
|
_ => Some(a),
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
None
|
|
|
|
|
}
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Return the maximum of `a` and `b` if they are comparable.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_max<'a, T: PartialOrd>(a: &'a T, b: &'a T) -> Option<&'a T> {
|
|
|
|
|
if let Some(ord) = a.partial_cmp(b) {
|
|
|
|
|
match ord {
|
|
|
|
|
Ordering::Less => Some(b),
|
|
|
|
|
_ => Some(a),
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
None
|
|
|
|
|
}
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/// Clamp `value` between `min` and `max`. Returns `None` if `value` is not comparable to
|
|
|
|
|
/// `min` or `max`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_clamp<'a, T: PartialOrd>(value: &'a T, min: &'a T, max: &'a T) -> Option<&'a T> {
|
|
|
|
|
if let (Some(cmp_min), Some(cmp_max)) = (value.partial_cmp(min), value.partial_cmp(max)) {
|
|
|
|
|
if cmp_min == Ordering::Less {
|
|
|
|
|
Some(min)
|
|
|
|
|
}
|
|
|
|
|
else if cmp_max == Ordering::Greater {
|
|
|
|
|
Some(max)
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
Some(value)
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
None
|
|
|
|
|
}
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Sorts two values in increasing order using a partial ordering.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn partial_sort2<'a, T: PartialOrd>(a: &'a T, b: &'a T) -> Option<(&'a T, &'a T)> {
|
|
|
|
|
if let Some(ord) = a.partial_cmp(b) {
|
|
|
|
|
match ord {
|
|
|
|
|
Ordering::Less => Some((a, b)),
|
|
|
|
|
_ => Some((b, a)),
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
None
|
|
|
|
|
}
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2016-12-05 05:44:42 +08:00
|
|
|
|
* Inverse
|
2014-09-29 01:20:22 +08:00
|
|
|
|
*/
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Tries to gets an inverted copy of a square matrix.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn try_inverse<M: AlgaSquareMatrix>(m: &M) -> Option<M> {
|
|
|
|
|
m.try_inverse()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2017-02-13 01:17:09 +08:00
|
|
|
|
/// Computes the multiplicative inverse of an (always invertible) algebraic entity.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn inverse<M: Inverse<Multiplicative>>(m: &M) -> M {
|
|
|
|
|
m.inverse()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2016-12-05 05:44:42 +08:00
|
|
|
|
* Inner vector space
|
2014-09-29 01:20:22 +08:00
|
|
|
|
*/
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Computes the dot product of two vectors.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn dot<V: FiniteDimVectorSpace>(a: &V, b: &V) -> V::Field {
|
|
|
|
|
a.dot(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2017-02-13 01:17:09 +08:00
|
|
|
|
/// Computes the smallest angle between two vectors.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn angle<V: InnerSpace>(a: &V, b: &V) -> V::Real {
|
|
|
|
|
a.angle(b)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2016-12-05 05:44:42 +08:00
|
|
|
|
* Normed space
|
2014-09-29 01:20:22 +08:00
|
|
|
|
*/
|
|
|
|
|
|
2017-02-13 01:17:09 +08:00
|
|
|
|
/// Computes the L2 (euclidean) norm of a vector.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn norm<V: NormedSpace>(v: &V) -> V::Field {
|
|
|
|
|
v.norm()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2017-02-13 01:17:09 +08:00
|
|
|
|
/// Computes the squared L2 (euclidean) norm of the vector `v`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn norm_squared<V: NormedSpace>(v: &V) -> V::Field {
|
|
|
|
|
v.norm_squared()
|
2013-05-19 01:04:03 +08:00
|
|
|
|
}
|
2014-09-29 01:20:22 +08:00
|
|
|
|
|
2017-02-13 01:17:09 +08:00
|
|
|
|
/// Computes the normalized version of the vector `v`.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn normalize<V: NormedSpace>(v: &V) -> V {
|
|
|
|
|
v.normalize()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2017-02-13 01:17:09 +08:00
|
|
|
|
/// Computes the normalized version of the vector `v` or returns `None` if its norm is smaller than `min_norm`.
|
2016-08-13 03:46:40 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn try_normalize<V: NormedSpace>(v: &V, min_norm: V::Field) -> Option<V> {
|
|
|
|
|
v.try_normalize(min_norm)
|
2016-08-13 03:46:40 +08:00
|
|
|
|
}
|
|
|
|
|
|
2014-09-29 01:20:22 +08:00
|
|
|
|
/*
|
2016-12-05 05:44:42 +08:00
|
|
|
|
*
|
|
|
|
|
* Point operations.
|
|
|
|
|
*
|
2014-09-29 01:20:22 +08:00
|
|
|
|
*/
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// The center of two points.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn center<P: EuclideanSpace>(p1: &P, p2: &P) -> P {
|
|
|
|
|
P::from_coordinates((p1.coordinates() + p2.coordinates()) * convert(0.5))
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// The distance between two points.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn distance<P: EuclideanSpace>(p1: &P, p2: &P) -> P::Real {
|
|
|
|
|
(p2.coordinates() - p1.coordinates()).norm()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// The squared distance between two points.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn distance_squared<P: EuclideanSpace>(p1: &P, p2: &P) -> P::Real {
|
|
|
|
|
(p2.coordinates() - p1.coordinates()).norm_squared()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2016-12-05 05:44:42 +08:00
|
|
|
|
* Cast
|
2014-09-29 01:20:22 +08:00
|
|
|
|
*/
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Converts an object from one type to an equivalent or more general one.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn convert<From, To: SupersetOf<From>>(t: From) -> To {
|
|
|
|
|
To::from_subset(&t)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Attempts to convert an object to a more specific one.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn try_convert<From: SupersetOf<To>, To>(t: From) -> Option<To> {
|
|
|
|
|
t.to_subset()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Indicates if `::try_convert` will succeed without actually performing the conversion.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn is_convertible<From: SupersetOf<To>, To>(t: &From) -> bool {
|
|
|
|
|
t.is_in_subset()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Use with care! Same as `try_convert` but without any property checks.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub unsafe fn convert_unchecked<From: SupersetOf<To>, To>(t: From) -> To {
|
|
|
|
|
t.to_subset_unchecked()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Converts an object from one type to an equivalent or more general one.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn convert_ref<From, To: SupersetOf<From>>(t: &From) -> To {
|
|
|
|
|
To::from_subset(t)
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Attempts to convert an object to a more specific one.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub fn try_convert_ref<From: SupersetOf<To>, To>(t: &From) -> Option<To> {
|
|
|
|
|
t.to_subset()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-12-05 05:44:42 +08:00
|
|
|
|
/// Use with care! Same as `try_convert` but without any property checks.
|
2016-05-06 21:08:06 +08:00
|
|
|
|
#[inline]
|
2016-12-05 05:44:42 +08:00
|
|
|
|
pub unsafe fn convert_ref_unchecked<From: SupersetOf<To>, To>(t: &From) -> To {
|
|
|
|
|
t.to_subset_unchecked()
|
2014-09-29 01:20:22 +08:00
|
|
|
|
}
|