1c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// This file is part of Eigen, a lightweight C++ template library 2c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// for linear algebra. 3c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// 4c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// Copyright (C) 2009 Benoit Jacob <jacob.benoit.1@gmail.com> 5c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// 6c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// This Source Code Form is subject to the terms of the Mozilla 7c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// Public License v. 2.0. If a copy of the MPL was not distributed 8c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath// with this file, You can obtain one at http://mozilla.org/MPL/2.0/. 9c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 10c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath#include "main.h" 11c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 12c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamathusing namespace std; 13c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamathtemplate<typename MatrixType> void permutationmatrices(const MatrixType& m) 14c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath{ 15c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef typename MatrixType::Index Index; 16c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef typename MatrixType::Scalar Scalar; 17c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath enum { Rows = MatrixType::RowsAtCompileTime, Cols = MatrixType::ColsAtCompileTime, 18c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Options = MatrixType::Options }; 19c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef PermutationMatrix<Rows> LeftPermutationType; 20c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef Matrix<int, Rows, 1> LeftPermutationVectorType; 21c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef Map<LeftPermutationType> MapLeftPerm; 22c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef PermutationMatrix<Cols> RightPermutationType; 23c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef Matrix<int, Cols, 1> RightPermutationVectorType; 24c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath typedef Map<RightPermutationType> MapRightPerm; 25c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 26c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Index rows = m.rows(); 27c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Index cols = m.cols(); 28c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 29c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath MatrixType m_original = MatrixType::Random(rows,cols); 30c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath LeftPermutationVectorType lv; 31c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath randomPermutationVector(lv, rows); 32c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath LeftPermutationType lp(lv); 33c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath RightPermutationVectorType rv; 34c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath randomPermutationVector(rv, cols); 35c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath RightPermutationType rp(rv); 36c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath MatrixType m_permuted = lp * m_original * rp; 37c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 38c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath for (int i=0; i<rows; i++) 39c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath for (int j=0; j<cols; j++) 40c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(m_permuted(lv(i),j), m_original(i,rv(j))); 41c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 42c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Matrix<Scalar,Rows,Rows> lm(lp); 43c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Matrix<Scalar,Cols,Cols> rm(rp); 44c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 45c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(m_permuted, lm*m_original*rm); 46c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 47c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(lp.inverse()*m_permuted*rp.inverse(), m_original); 48c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(lv.asPermutation().inverse()*m_permuted*rv.asPermutation().inverse(), m_original); 49c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(MapLeftPerm(lv.data(),lv.size()).inverse()*m_permuted*MapRightPerm(rv.data(),rv.size()).inverse(), m_original); 50c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 51c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY((lp*lp.inverse()).toDenseMatrix().isIdentity()); 52c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY((lv.asPermutation()*lv.asPermutation().inverse()).toDenseMatrix().isIdentity()); 53c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY((MapLeftPerm(lv.data(),lv.size())*MapLeftPerm(lv.data(),lv.size()).inverse()).toDenseMatrix().isIdentity()); 54c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 55c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath LeftPermutationVectorType lv2; 56c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath randomPermutationVector(lv2, rows); 57c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath LeftPermutationType lp2(lv2); 58c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Matrix<Scalar,Rows,Rows> lm2(lp2); 59c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX((lp*lp2).toDenseMatrix().template cast<Scalar>(), lm*lm2); 60c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX((lv.asPermutation()*lv2.asPermutation()).toDenseMatrix().template cast<Scalar>(), lm*lm2); 61c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX((MapLeftPerm(lv.data(),lv.size())*MapLeftPerm(lv2.data(),lv2.size())).toDenseMatrix().template cast<Scalar>(), lm*lm2); 62c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 63c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath LeftPermutationType identityp; 64c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath identityp.setIdentity(rows); 65c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(m_original, identityp*m_original); 66c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 67c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath // check inplace permutations 68c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = m_original; 69c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = lp.inverse() * m_permuted; 70c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(m_permuted, lp.inverse()*m_original); 71c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 72c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = m_original; 73c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = m_permuted * rp.inverse(); 74c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(m_permuted, m_original*rp.inverse()); 75c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 76c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = m_original; 77c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = lp * m_permuted; 78c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(m_permuted, lp*m_original); 79c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 80c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = m_original; 81c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath m_permuted = m_permuted * rp; 82c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(m_permuted, m_original*rp); 83c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 84c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath if(rows>1 && cols>1) 85c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath { 86c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath lp2 = lp; 87c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Index i = internal::random<Index>(0, rows-1); 88c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath Index j; 89c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath do j = internal::random<Index>(0, rows-1); while(j==i); 90c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath lp2.applyTranspositionOnTheLeft(i, j); 91c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath lm = lp; 92c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath lm.row(i).swap(lm.row(j)); 93c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(lm, lp2.toDenseMatrix().template cast<Scalar>()); 94c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 95c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath RightPermutationType rp2 = rp; 96c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath i = internal::random<Index>(0, cols-1); 97c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath do j = internal::random<Index>(0, cols-1); while(j==i); 98c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath rp2.applyTranspositionOnTheRight(i, j); 99c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath rm = rp; 100c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath rm.col(i).swap(rm.col(j)); 101c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath VERIFY_IS_APPROX(rm, rp2.toDenseMatrix().template cast<Scalar>()); 102c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath } 103c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath} 104c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath 105c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamathvoid test_permutationmatrices() 106c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath{ 107c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath for(int i = 0; i < g_repeat; i++) { 108c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath CALL_SUBTEST_1( permutationmatrices(Matrix<float, 1, 1>()) ); 109c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath CALL_SUBTEST_2( permutationmatrices(Matrix3f()) ); 110c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath CALL_SUBTEST_3( permutationmatrices(Matrix<double,3,3,RowMajor>()) ); 111c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath CALL_SUBTEST_4( permutationmatrices(Matrix4d()) ); 112c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath CALL_SUBTEST_5( permutationmatrices(Matrix<double,40,60>()) ); 113c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath CALL_SUBTEST_6( permutationmatrices(Matrix<double,Dynamic,Dynamic,RowMajor>(20, 30)) ); 114c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath CALL_SUBTEST_7( permutationmatrices(MatrixXcf(15, 10)) ); 115c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath } 116c981c48f5bc9aefeffc0bcb0cc3934c2fae179ddNarayan Kamath} 117