diff --git a/src/nalgebra.rc b/src/nalgebra.rc index 42111bed..348546e0 100644 --- a/src/nalgebra.rc +++ b/src/nalgebra.rc @@ -39,7 +39,7 @@ pub mod dim3 /// n-dimensional linear algebra (slower). pub mod ndim { - // pub mod dmat; + pub mod dmat; pub mod dvec; pub mod nvec; pub mod nmat; diff --git a/src/ndim/dmat.rs b/src/ndim/dmat.rs new file mode 100644 index 00000000..aee81c94 --- /dev/null +++ b/src/ndim/dmat.rs @@ -0,0 +1,244 @@ +use core::num::{One, Zero}; +use core::vec::{from_elem, swap, all, all2, len}; +use core::cmp::ApproxEq; +use traits::inv::Inv; +use traits::transpose::Transpose; +use traits::workarounds::rlmul::{RMul, LMul}; +use ndim::dvec::{DVec, zero_vec_with_dim}; + +#[deriving(Eq, ToStr, Clone)] +pub struct DMat +{ + dim: uint, // FIXME: handle more than just square matrices + mij: ~[T] +} + +pub fn zero_mat_with_dim(dim: uint) -> DMat +{ DMat { dim: dim, mij: from_elem(dim * dim, Zero::zero()) } } + +pub fn is_zero_mat(mat: &DMat) -> bool +{ all(mat.mij, |e| e.is_zero()) } + +pub fn one_mat_with_dim(dim: uint) -> DMat +{ + let mut res = zero_mat_with_dim(dim); + let _1 = One::one::(); + + for uint::range(0u, dim) |i| + { res.set(i, i, &_1); } + + res +} + +impl DMat +{ + pub fn offset(&self, i: uint, j: uint) -> uint + { i * self.dim + j } + + pub fn set(&mut self, i: uint, j: uint, t: &T) + { + assert!(i < self.dim); + assert!(j < self.dim); + self.mij[self.offset(i, j)] = *t + } +} + +impl Index<(uint, uint), T> for DMat +{ + fn index(&self, &(i, j): &(uint, uint)) -> T + { self.mij[self.offset(i, j)] } +} + +impl + Add + Zero> +Mul, DMat> for DMat +{ + fn mul(&self, other: &DMat) -> DMat + { + assert!(self.dim == other.dim); + + let dim = self.dim; + let mut res = zero_mat_with_dim(dim); + + for uint::range(0u, dim) |i| + { + for uint::range(0u, dim) |j| + { + let mut acc: T = Zero::zero(); + + for uint::range(0u, dim) |k| + { acc += self[(i, k)] * other[(k, j)]; } + + res.set(i, j, &acc); + } + } + + res + } +} + +impl + Mul + Zero> +RMul> for DMat +{ + fn rmul(&self, other: &DVec) -> DVec + { + assert!(self.dim == len(other.at)); + + let dim = self.dim; + let mut res : DVec = zero_vec_with_dim(dim); + + for uint::range(0u, dim) |i| + { + for uint::range(0u, dim) |j| + { res.at[i] = res.at[i] + other.at[j] * self[(i, j)]; } + } + + res + } +} + +impl + Mul + Zero> +LMul> for DMat +{ + fn lmul(&self, other: &DVec) -> DVec + { + assert!(self.dim == len(other.at)); + + let dim = self.dim; + let mut res : DVec = zero_vec_with_dim(dim); + + for uint::range(0u, dim) |i| + { + for uint::range(0u, dim) |j| + { res.at[i] = res.at[i] + other.at[j] * self[(j, i)]; } + } + + res + } +} + +impl + Div + Sub + Neg> +Inv for DMat +{ + fn inverse(&self) -> DMat + { + let mut res : DMat = self.clone(); + + res.invert(); + + res + } + + fn invert(&mut self) + { + let dim = self.dim; + let mut res = one_mat_with_dim::(dim); + let _0T = Zero::zero::(); + + // inversion using Gauss-Jordan elimination + for uint::range(0u, dim) |k| + { + // search a non-zero value on the k-th column + // FIXME: would it be worth it to spend some more time searching for the + // max instead? + + // FIXME: this is kind of uggly… + // … but we cannot use position_between since we are iterating on one + // columns + let mut n0 = 0u; // index of a non-zero entry + + while (n0 != dim) + { + if (self[(n0, k)] != _0T) + { break; } + + n0 += 1; + } + + assert!(n0 != dim); // non inversible matrix + + // swap pivot line + if (n0 != k) + { + for uint::range(0u, dim) |j| + { + let off_n0_j = self.offset(n0, j); + let off_k_j = self.offset(k, j); + + swap(self.mij, off_n0_j, off_k_j); + swap(res.mij, off_n0_j, off_k_j); + } + } + + let pivot = self[(k, k)]; + + for uint::range(k, dim) |j| + { + // FIXME: not to putting selfal exression directly on the nuction call + // is uggly but does not seem to compile any more… + let selfval = &(self[(k, j)] / pivot); + let resval = &(res[(k, j)] / pivot); + + self.set(k, j, selfval); + res.set(k, j, resval); + } + + for uint::range(0u, dim) |l| + { + if (l != k) + { + let normalizer = self[(l, k)] / pivot; + + for uint::range(k, dim) |j| + { + let selfval = &(self[(l, j)] - self[(k, j)] * normalizer); + let resval = &(res[(l, j)] - res[(k, j)] * normalizer); + + self.set(k, j, selfval); + res.set(k, j, resval); + } + } + } + } + } +} + +impl Transpose for DMat +{ + fn transposed(&self) -> DMat + { + let mut res = copy *self; + + res.transpose(); + + res + } + + fn transpose(&mut self) + { + let dim = self.dim; + + for uint::range(1u, dim) |i| + { + for uint::range(0u, dim - 1) |j| + { + let off_i_j = self.offset(i, j); + let off_j_i = self.offset(j, i); + + swap(self.mij, off_i_j, off_j_i); + } + } + } +} + +impl> ApproxEq for DMat +{ + fn approx_epsilon() -> T + { ApproxEq::approx_epsilon::() } + + fn approx_eq(&self, other: &DMat) -> bool + { all2(self.mij, other.mij, |a, b| a.approx_eq(b)) } + + fn approx_eq_eps(&self, other: &DMat, epsilon: &T) -> bool + { all2(self.mij, other.mij, |a, b| a.approx_eq_eps(b, epsilon)) } +} diff --git a/src/ndim/dvec.rs b/src/ndim/dvec.rs index 1d1f1a38..9fc8e236 100644 --- a/src/ndim/dvec.rs +++ b/src/ndim/dvec.rs @@ -15,10 +15,10 @@ pub struct DVec at: ~[T] } -pub fn zero_with_dim(dim: uint) -> DVec +pub fn zero_vec_with_dim(dim: uint) -> DVec { DVec { at: from_elem(dim, Zero::zero::()) } } -pub fn is_zero(vec: &DVec) -> bool +pub fn is_zero_vec(vec: &DVec) -> bool { all(vec.at, |e| e.is_zero()) } // FIXME: is Clone needed? @@ -30,7 +30,7 @@ impl> DVec for uint::range(0u, dim) |i| { - let mut basis_element : DVec = zero_with_dim(dim); + let mut basis_element : DVec = zero_vec_with_dim(dim); basis_element.at[i] = One::one(); @@ -49,7 +49,7 @@ impl> DVec for uint::range(0u, dim) |i| { - let mut basis_element : DVec = zero_with_dim(len(self.at)); + let mut basis_element : DVec = zero_vec_with_dim(len(self.at)); basis_element.at[i] = One::one(); diff --git a/src/ndim/nmat.rs b/src/ndim/nmat.rs index a93c25a9..08c475eb 100644 --- a/src/ndim/nmat.rs +++ b/src/ndim/nmat.rs @@ -1,11 +1,11 @@ use core::num::{One, Zero}; use core::rand::{Rand, Rng, RngUtil}; -use core::vec::{from_elem, swap, all, all2}; use core::cmp::ApproxEq; use traits::dim::Dim; use traits::inv::Inv; use traits::transpose::Transpose; use traits::workarounds::rlmul::{RMul, LMul}; +use ndim::dmat::{DMat, one_mat_with_dim, zero_mat_with_dim, is_zero_mat}; use ndim::nvec::NVec; // D is a phantom type parameter, used only as a dimensional token. @@ -14,15 +14,7 @@ use ndim::nvec::NVec; // using d0, d1, d2, d3 and d4 tokens are prefered. #[deriving(Eq, ToStr)] pub struct NMat -{ - mij: ~[T] -} - -impl Clone for NMat -{ - fn clone(&self) -> NMat - { NMat{ mij: self.mij.clone() } } -} +{ mij: DMat } impl NMat { @@ -30,7 +22,7 @@ impl NMat { i * Dim::dim::() + j } fn set(&mut self, i: uint, j: uint, t: &T) - { self.mij[NMat::offset::(i, j)] = *t } + { self.mij.set(i, j, t) } } impl Dim for NMat @@ -41,36 +33,23 @@ impl Dim for NMat impl Index<(uint, uint), T> for NMat { - fn index(&self, &(i, j): &(uint, uint)) -> T - { self.mij[NMat::offset::(i, j)] } + fn index(&self, &idx: &(uint, uint)) -> T + { self.mij[idx] } } impl One for NMat { fn one() -> NMat - { - let dim = Dim::dim::(); - let mut res = NMat{ mij: from_elem(dim * dim, Zero::zero()) }; - let _1 = One::one::(); - - for uint::range(0u, dim) |i| - { res.set(i, i, &_1); } - - res - } + { NMat { mij: one_mat_with_dim(Dim::dim::()) } } } impl Zero for NMat { fn zero() -> NMat - { - let dim = Dim::dim::(); - - NMat{ mij: from_elem(dim * dim, Zero::zero()) } - } + { NMat { mij: zero_mat_with_dim(Dim::dim::()) } } fn is_zero(&self) -> bool - { all(self.mij, |e| e.is_zero()) } + { is_zero_mat(&self.mij) } } impl + Add + Zero> @@ -140,87 +119,10 @@ impl { fn inverse(&self) -> NMat - { - let mut res : NMat = self.clone(); - - res.invert(); - - res - } + { NMat { mij: self.mij.inverse() } } fn invert(&mut self) - { - let dim = Dim::dim::(); - let mut res = One::one::>(); - let _0T = Zero::zero::(); - - // inversion using Gauss-Jordan elimination - for uint::range(0u, dim) |k| - { - // search a non-zero value on the k-th column - // FIXME: would it be worth it to spend some more time searching for the - // max instead? - - // FIXME: this is kind of uggly… - // … but we cannot use position_between since we are iterating on one - // columns - let mut n0 = 0u; // index of a non-zero entry - - while (n0 != dim) - { - if (self[(n0, k)] != _0T) - { break; } - - n0 += 1; - } - - assert!(n0 != dim); // non inversible matrix - - // swap pivot line - if (n0 != k) - { - for uint::range(0u, dim) |j| - { - swap(self.mij, - NMat::offset::(n0, j), - NMat::offset::(k, j)); - swap(res.mij, - NMat::offset::(n0, j), - NMat::offset::(k, j)); - } - } - - let pivot = self[(k, k)]; - - for uint::range(k, dim) |j| - { - // FIXME: not to putting selfal exression directly on the nuction call - // is uggly but does not seem to compile any more… - let selfval = &(self[(k, j)] / pivot); - let resval = &(res[(k, j)] / pivot); - - self.set(k, j, selfval); - res.set(k, j, resval); - } - - for uint::range(0u, dim) |l| - { - if (l != k) - { - let normalizer = self[(l, k)] / pivot; - - for uint::range(k, dim) |j| - { - let selfval = &(self[(l, j)] - self[(k, j)] * normalizer); - let resval = &(res[(l, j)] - res[(k, j)] * normalizer); - - self.set(k, j, selfval); - res.set(k, j, resval); - } - } - } - } - } + { self.mij.invert() } } impl Transpose for NMat @@ -235,19 +137,7 @@ impl Transpose for NMat } fn transpose(&mut self) - { - let dim = Dim::dim::(); - - for uint::range(1u, dim) |i| - { - for uint::range(0u, dim - 1) |j| - { - swap(self.mij, - NMat::offset::(i, j), - NMat::offset::(j, i)); - } - } - } + { self.mij.transpose() } } impl> ApproxEq for NMat @@ -256,10 +146,10 @@ impl> ApproxEq for NMat { ApproxEq::approx_epsilon::() } fn approx_eq(&self, other: &NMat) -> bool - { all2(self.mij, other.mij, |a, b| a.approx_eq(b)) } + { self.mij.approx_eq(&other.mij) } fn approx_eq_eps(&self, other: &NMat, epsilon: &T) -> bool - { all2(self.mij, other.mij, |a, b| a.approx_eq_eps(b, epsilon)) } + { self.mij.approx_eq_eps(&other.mij, epsilon) } } impl Rand for NMat diff --git a/src/ndim/nvec.rs b/src/ndim/nvec.rs index b887908d..a18f6d3f 100644 --- a/src/ndim/nvec.rs +++ b/src/ndim/nvec.rs @@ -2,7 +2,7 @@ use core::num::{Zero, Algebraic}; use core::rand::{Rand, Rng, RngUtil}; use core::vec::{map}; use core::cmp::ApproxEq; -use ndim::dvec::{DVec, zero_with_dim, is_zero}; +use ndim::dvec::{DVec, zero_vec_with_dim, is_zero_vec}; use traits::basis::Basis; use traits::ring::Ring; use traits::division_ring::DivisionRing; @@ -164,10 +164,10 @@ Basis for NVec impl Zero for NVec { fn zero() -> NVec - { NVec { at: zero_with_dim(Dim::dim::()) } } + { NVec { at: zero_vec_with_dim(Dim::dim::()) } } fn is_zero(&self) -> bool - { is_zero(&self.at) } + { is_zero_vec(&self.at) } } impl> ApproxEq for NVec