| #include <iostream> |
| #include <Eigen/SVD> |
| using namespace Eigen; |
| using namespace std; |
| |
| float inv_cond(const Ref<const MatrixXf>& a) |
| { |
| const VectorXf sing_vals = a.jacobiSvd().singularValues(); |
| return sing_vals(sing_vals.size()-1) / sing_vals(0); |
| } |
| |
| int main() |
| { |
| Matrix4f m = Matrix4f::Random(); |
| cout << "matrix m:" << endl << m << endl << endl; |
| cout << "inv_cond(m): " << inv_cond(m) << endl; |
| cout << "inv_cond(m(1:3,1:3)): " << inv_cond(m.topLeftCorner(3,3)) << endl; |
| cout << "inv_cond(m+I): " << inv_cond(m+Matrix4f::Identity()) << endl; |
| } |