minor changes to leave CalcPinv working in master

src/common_fc.h

@@ -59,8 +59,6 @@ class CCommon_Fc
     *
     * Compute the matrix pseudo-inverse using SVD
     */
-    //static Eigen::MatrixXd CalcPinv(const Eigen::MatrixXd &a);
-
     template<typename _Matrix_Type_> static _Matrix_Type_ CalcPinv(const _Matrix_Type_ &a, double epsilon = std::numeric_limits<double>::epsilon())
     {
       Eigen::JacobiSVD< _Matrix_Type_ > svdd(a, Eigen::ComputeThinU | Eigen::ComputeThinV);

src/tasks/ir.cpp

@@ -44,8 +44,7 @@ void CTaskIR::TaskErrorJac(const int& arm_dof, const double& inf_rad, const Eige
     }
   // }
 
-  //Eigen::MatrixXd Hinv = UAM::CCommon_Fc::CalcPinv(H);
-  Eigen::MatrixXd Hinv = H.transpose();
+  Eigen::MatrixXd Hinv = UAM::CCommon_Fc::CalcPinv(H);
 
   // weighting matrix
   Eigen::MatrixXd temp = JIR*Hinv*JIR.transpose();