diff --git a/src/msckf_vio.cpp b/src/msckf_vio.cpp index 1e8f4f2..00be79f 100644 --- a/src/msckf_vio.cpp +++ b/src/msckf_vio.cpp @@ -1568,6 +1568,7 @@ void MsckfVio::featureJacobian( H_x = A.transpose() * H_xj; r = A.transpose() * r_j; + /* ofstream myfile; myfile.open ("/home/raphael/dev/MSCKF_ws/log.txt"); myfile << "Hx\n" << H_x << "r\n" << r << "from residual estimated error state: " << H_x.colPivHouseholderQr().solve(r) << endl; @@ -1575,7 +1576,7 @@ void MsckfVio::featureJacobian( cout << "---------- LOGGED -------- " << endl; nh.setParam("/play_bag", false); - + */ return; }