Skip to content
Snippets Groups Projects
Commit 9fdc71d1 authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

hotfixes

parent 5e9eb26c
No related branches found
No related tags found
No related merge requests found
...@@ -33,7 +33,7 @@ using namespace wolf; ...@@ -33,7 +33,7 @@ using namespace wolf;
const Vector3d zero3 = Vector3d::Zero(); const Vector3d zero3 = Vector3d::Zero();
const double dt = 0.001; const double dt = 0.001;
const bool WRITE_CSV = false; #define WRITE_CSV false
void printingFactorErrors(ProblemPtr pbe){ void printingFactorErrors(ProblemPtr pbe){
...@@ -232,8 +232,8 @@ class ImuMocapFusion_Test : public testing::Test ...@@ -232,8 +232,8 @@ class ImuMocapFusion_Test : public testing::Test
std::string report = solver_->solve(SolverManager::ReportVerbosity::BRIEF); std::string report = solver_->solve(SolverManager::ReportVerbosity::BRIEF);
nb_kf = problem_->getTrajectory()->getFrameMap().size(); nb_kf = problem_->getTrajectory()->getFrameMap().size();
Vector6d imu_bias = sensor_imu_->getIntrinsic()->getState();
#ifdef WRITE_CSV #ifdef WRITE_CSV
Vector6d imu_bias = sensor_imu_->getIntrinsic()->getState();
file_bias << std::setprecision(std::numeric_limits<long double>::digits10 + 1) file_bias << std::setprecision(std::numeric_limits<long double>::digits10 + 1)
<< t << "," << t << ","
<< imu_bias(0) << "," << imu_bias(0) << ","
...@@ -252,7 +252,7 @@ class ImuMocapFusion_Test : public testing::Test ...@@ -252,7 +252,7 @@ class ImuMocapFusion_Test : public testing::Test
#ifdef WRITE_CSV #ifdef WRITE_CSV
file_gtr.close(); file_gtr.close();
file_bias.close(); file_bias.close();
#endif WRITE_CSV #endif
} }
...@@ -338,4 +338,4 @@ int main(int argc, char **argv) ...@@ -338,4 +338,4 @@ int main(int argc, char **argv)
{ {
testing::InitGoogleTest(&argc, argv); testing::InitGoogleTest(&argc, argv);
return RUN_ALL_TESTS(); return RUN_ALL_TESTS();
} }
\ No newline at end of file
...@@ -108,17 +108,6 @@ namespace wolf { ...@@ -108,17 +108,6 @@ namespace wolf {
jacobian_delta_ = Eigen::MatrixXd::Zero(9,9); jacobian_delta_ = Eigen::MatrixXd::Zero(9,9);
} }
Imu_jac_deltas(Imu_jac_deltas const & toCopy){
Delta_noisy_vect_ = toCopy.Delta_noisy_vect_;
delta_noisy_vect_ = toCopy.delta_noisy_vect_;
Delta0_ = toCopy.Delta0_;
delta0_ = toCopy.delta0_;
jacobian_delta_preint_ = toCopy.jacobian_delta_preint_;
jacobian_delta_ = toCopy.jacobian_delta_;
}
public: public:
/*The following vectors will contain all the matrices and deltas needed to compute the finite differences. /*The following vectors will contain all the matrices and deltas needed to compute the finite differences.
Elements at place 0 are those not affected by the bias noise that we add (Delta_noise, delta_noise -> dPx, dpx, dVx, dvx,..., dOz,doz). Elements at place 0 are those not affected by the bias noise that we add (Delta_noise, delta_noise -> dPx, dpx, dVx, dvx,..., dOz,doz).
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment