2012-08-28 05:48:37 +08:00
|
|
|
// This file is part of Eigen, a lightweight C++ template library
|
|
|
|
// for linear algebra.
|
|
|
|
//
|
|
|
|
// Copyright (C) 2012 Chen-Pang He <jdh8@ms63.hinet.net>
|
|
|
|
//
|
|
|
|
// This Source Code Form is subject to the terms of the Mozilla
|
|
|
|
// Public License v. 2.0. If a copy of the MPL was not distributed
|
|
|
|
// with this file, You can obtain one at http://mozilla.org/MPL/2.0/.
|
|
|
|
|
|
|
|
#include "matrix_functions.h"
|
|
|
|
|
2012-09-30 19:21:53 +08:00
|
|
|
template <typename MatrixType, int IsComplex = NumTraits<typename MatrixType::Scalar>::IsComplex>
|
|
|
|
struct generateTriangularMatrix;
|
|
|
|
|
|
|
|
// for real matrices, make sure none of the eigenvalues are negative
|
|
|
|
template <typename MatrixType>
|
|
|
|
struct generateTriangularMatrix<MatrixType,0>
|
|
|
|
{
|
|
|
|
static void run(MatrixType& result, typename MatrixType::Index size)
|
|
|
|
{
|
|
|
|
result.resize(size, size);
|
|
|
|
result.template triangularView<Upper>() = MatrixType::Random(size, size);
|
|
|
|
for (typename MatrixType::Index i = 0; i < size; ++i)
|
|
|
|
result.coeffRef(i,i) = std::abs(result.coeff(i,i));
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
// for complex matrices, any matrix is fine
|
|
|
|
template <typename MatrixType>
|
|
|
|
struct generateTriangularMatrix<MatrixType,1>
|
|
|
|
{
|
|
|
|
static void run(MatrixType& result, typename MatrixType::Index size)
|
|
|
|
{
|
|
|
|
result.resize(size, size);
|
|
|
|
result.template triangularView<Upper>() = MatrixType::Random(size, size);
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
2012-08-28 01:55:13 +08:00
|
|
|
template<typename T>
|
2012-08-28 05:48:37 +08:00
|
|
|
void test2dRotation(double tol)
|
|
|
|
{
|
|
|
|
Matrix<T,2,2> A, B, C;
|
|
|
|
T angle, c, s;
|
|
|
|
|
|
|
|
A << 0, 1, -1, 0;
|
2012-09-21 23:24:28 +08:00
|
|
|
MatrixPower<Matrix<T,2,2> > Apow(A);
|
|
|
|
|
|
|
|
for (int i=0; i<=20; ++i) {
|
2012-08-28 05:48:37 +08:00
|
|
|
angle = pow(10, (i-10) / 5.);
|
|
|
|
c = std::cos(angle);
|
|
|
|
s = std::sin(angle);
|
|
|
|
B << c, s, -s, c;
|
|
|
|
|
2012-09-21 23:24:28 +08:00
|
|
|
C = Apow(std::ldexp(angle,1) / M_PI);
|
|
|
|
std::cout << "test2dRotation: i = " << i << " error powerm = " << relerr(C,B) << '\n';
|
|
|
|
VERIFY(C.isApprox(B, static_cast<T>(tol)));
|
2012-08-28 05:48:37 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-08-28 01:55:13 +08:00
|
|
|
template<typename T>
|
2012-08-28 05:48:37 +08:00
|
|
|
void test2dHyperbolicRotation(double tol)
|
|
|
|
{
|
|
|
|
Matrix<std::complex<T>,2,2> A, B, C;
|
2012-09-27 18:04:59 +08:00
|
|
|
T angle, ch = std::cosh((T)1);
|
|
|
|
std::complex<T> ish(0, std::sinh((T)1));
|
2012-08-28 05:48:37 +08:00
|
|
|
|
|
|
|
A << ch, ish, -ish, ch;
|
2012-09-21 23:24:28 +08:00
|
|
|
MatrixPower<Matrix<std::complex<T>,2,2> > Apow(A);
|
|
|
|
|
|
|
|
for (int i=0; i<=20; ++i) {
|
|
|
|
angle = std::ldexp(static_cast<T>(i-10), -1);
|
2012-08-28 05:48:37 +08:00
|
|
|
ch = std::cosh(angle);
|
|
|
|
ish = std::complex<T>(0, std::sinh(angle));
|
|
|
|
B << ch, ish, -ish, ch;
|
|
|
|
|
2012-09-21 23:24:28 +08:00
|
|
|
C = Apow(angle);
|
|
|
|
std::cout << "test2dHyperbolicRotation: i = " << i << " error powerm = " << relerr(C,B) << '\n';
|
|
|
|
VERIFY(C.isApprox(B, static_cast<T>(tol)));
|
2012-08-28 05:48:37 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-08-28 01:55:13 +08:00
|
|
|
template<typename MatrixType>
|
2012-08-25 01:09:20 +08:00
|
|
|
void testExponentLaws(const MatrixType& m, double tol)
|
|
|
|
{
|
|
|
|
typedef typename MatrixType::RealScalar RealScalar;
|
|
|
|
MatrixType m1, m2, m3, m4, m5;
|
|
|
|
RealScalar x, y;
|
|
|
|
|
2012-09-30 19:21:53 +08:00
|
|
|
for (int i=0; i < g_repeat; ++i) {
|
2012-08-28 05:48:37 +08:00
|
|
|
generateTestMatrix<MatrixType>::run(m1, m.rows());
|
2012-09-21 23:24:28 +08:00
|
|
|
MatrixPower<MatrixType> mpow(m1);
|
|
|
|
|
2012-08-25 01:09:20 +08:00
|
|
|
x = internal::random<RealScalar>();
|
|
|
|
y = internal::random<RealScalar>();
|
2012-09-21 23:24:28 +08:00
|
|
|
m2 = mpow(x);
|
|
|
|
m3 = mpow(y);
|
2012-08-25 01:09:20 +08:00
|
|
|
|
2012-09-21 23:24:28 +08:00
|
|
|
m4 = mpow(x+y);
|
2012-08-26 02:15:41 +08:00
|
|
|
m5.noalias() = m2 * m3;
|
2012-09-21 23:24:28 +08:00
|
|
|
VERIFY(m4.isApprox(m5, static_cast<RealScalar>(tol)));
|
2012-08-28 05:48:37 +08:00
|
|
|
|
2012-09-21 23:24:28 +08:00
|
|
|
m4 = mpow(x*y);
|
|
|
|
m5 = m2.pow(y);
|
|
|
|
VERIFY(m4.isApprox(m5, static_cast<RealScalar>(tol)));
|
2012-08-28 05:48:37 +08:00
|
|
|
|
2012-08-25 01:09:20 +08:00
|
|
|
m4 = (std::abs(x) * m1).pow(y);
|
|
|
|
m5 = std::pow(std::abs(x), y) * m3;
|
2012-09-21 23:24:28 +08:00
|
|
|
VERIFY(m4.isApprox(m5, static_cast<RealScalar>(tol)));
|
2012-08-28 05:48:37 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-09-22 03:26:00 +08:00
|
|
|
template<typename MatrixType, typename VectorType>
|
2012-09-28 02:08:14 +08:00
|
|
|
void testProduct(const MatrixType& m, const VectorType& v, double tol)
|
2012-09-22 03:26:00 +08:00
|
|
|
{
|
|
|
|
typedef typename MatrixType::RealScalar RealScalar;
|
|
|
|
MatrixType m1;
|
|
|
|
VectorType v1, v2, v3;
|
|
|
|
RealScalar p;
|
|
|
|
|
2012-09-30 19:21:53 +08:00
|
|
|
for (int i=0; i < g_repeat; ++i) {
|
2012-09-22 03:26:00 +08:00
|
|
|
generateTestMatrix<MatrixType>::run(m1, m.rows());
|
|
|
|
MatrixPower<MatrixType> mpow(m1);
|
|
|
|
|
|
|
|
v1 = VectorType::Random(v.rows(), v.cols());
|
|
|
|
p = internal::random<RealScalar>();
|
|
|
|
|
|
|
|
v2.noalias() = mpow(p) * v1;
|
|
|
|
v3.noalias() = mpow(p).eval() * v1;
|
2012-09-30 19:21:53 +08:00
|
|
|
std::cout << "testProduct: error powerm = " << relerr(v2, v3) << '\n';
|
|
|
|
VERIFY(v2.isApprox(v3, static_cast<RealScalar>(tol)));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
template<typename MatrixType, typename VectorType>
|
|
|
|
void testTriangularProduct(const MatrixType& m, const VectorType& v, double tol)
|
|
|
|
{
|
|
|
|
typedef typename MatrixType::RealScalar RealScalar;
|
|
|
|
MatrixType m1;
|
|
|
|
VectorType v1, v2, v3;
|
|
|
|
RealScalar p;
|
|
|
|
|
|
|
|
for (int i=0; i < g_repeat; ++i) {
|
|
|
|
generateTriangularMatrix<MatrixType>::run(m1, m.rows());
|
|
|
|
MatrixPowerTriangular<MatrixType> mpow(m1);
|
|
|
|
|
|
|
|
v1 = VectorType::Random(v.rows(), v.cols());
|
|
|
|
p = internal::random<RealScalar>();
|
|
|
|
|
|
|
|
v2.noalias() = mpow(p) * v1;
|
|
|
|
v3.noalias() = mpow(p).eval() * v1;
|
|
|
|
std::cout << "testTriangularProduct: error powerm = " << relerr(v2, v3) << '\n';
|
2012-09-22 03:26:00 +08:00
|
|
|
VERIFY(v2.isApprox(v3, static_cast<RealScalar>(tol)));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-09-28 02:08:14 +08:00
|
|
|
template<typename MatrixType, typename VectorType>
|
|
|
|
void testMatrixVector(const MatrixType& m, const VectorType& v, double tol)
|
|
|
|
{
|
|
|
|
testExponentLaws(m,tol);
|
|
|
|
testProduct(m,v,tol);
|
2012-09-30 19:21:53 +08:00
|
|
|
testTriangularProduct(m,v,tol);
|
2012-09-28 02:08:14 +08:00
|
|
|
}
|
|
|
|
|
2013-06-21 15:27:38 +08:00
|
|
|
typedef Matrix<double,3,3,RowMajor> Matrix3dRowMajor;
|
|
|
|
typedef Matrix<long double,Dynamic,Dynamic> MatrixXe;
|
|
|
|
typedef Matrix<long double,Dynamic,1> VectorXe;
|
|
|
|
|
2012-08-28 05:48:37 +08:00
|
|
|
void test_matrix_power()
|
|
|
|
{
|
|
|
|
CALL_SUBTEST_2(test2dRotation<double>(1e-13));
|
|
|
|
CALL_SUBTEST_1(test2dRotation<float>(2e-5)); // was 1e-5, relaxed for clang 2.8 / linux / x86-64
|
2012-08-25 01:09:20 +08:00
|
|
|
CALL_SUBTEST_9(test2dRotation<long double>(1e-13));
|
2012-08-28 05:48:37 +08:00
|
|
|
CALL_SUBTEST_2(test2dHyperbolicRotation<double>(1e-14));
|
|
|
|
CALL_SUBTEST_1(test2dHyperbolicRotation<float>(1e-5));
|
2012-08-25 01:09:20 +08:00
|
|
|
CALL_SUBTEST_9(test2dHyperbolicRotation<long double>(1e-14));
|
|
|
|
|
2012-09-28 02:08:14 +08:00
|
|
|
CALL_SUBTEST_2(testMatrixVector(Matrix2d(), Vector2d(), 1e-13));
|
|
|
|
CALL_SUBTEST_7(testMatrixVector(Matrix3dRowMajor(), MatrixXd(3,5), 1e-13));
|
|
|
|
CALL_SUBTEST_3(testMatrixVector(Matrix4cd(), Vector4cd(), 1e-13));
|
2013-03-10 01:20:16 +08:00
|
|
|
CALL_SUBTEST_4(testMatrixVector(MatrixXd(8,8), VectorXd(8), 2e-12));
|
2012-09-28 02:08:14 +08:00
|
|
|
CALL_SUBTEST_1(testMatrixVector(Matrix2f(), Vector2f(), 1e-4));
|
|
|
|
CALL_SUBTEST_5(testMatrixVector(Matrix3cf(), Vector3cf(), 1e-4));
|
|
|
|
CALL_SUBTEST_8(testMatrixVector(Matrix4f(), Vector4f(), 1e-4));
|
2013-03-10 01:20:16 +08:00
|
|
|
CALL_SUBTEST_6(testMatrixVector(MatrixXf(8,8), VectorXf(8), 1e-3));
|
2012-09-28 02:08:14 +08:00
|
|
|
CALL_SUBTEST_9(testMatrixVector(MatrixXe(7,7), VectorXe(7), 1e-13));
|
2012-08-28 05:48:37 +08:00
|
|
|
}
|