diff --git a/.gitignore b/.gitignore index f781277cec7f4bb091d8848fba5aa1b5bb2c3504..5861b1e56adb7cc3c87bb3c10d66c1736ea8885c 100644 --- a/.gitignore +++ b/.gitignore @@ -40,3 +40,4 @@ imu.found compile_commands.json .vimspector.json est.csv +/imu.found diff --git a/include/imu/factor/factor_fix_bias.h b/include/imu/factor/factor_fix_bias.h index 8d4e54ab641d7564e4e555b6d0ccddc1815ee2a1..e989b9b8861fa83d7f0568f2ea545dd50bed647e 100644 --- a/include/imu/factor/factor_fix_bias.h +++ b/include/imu/factor/factor_fix_bias.h @@ -21,6 +21,7 @@ class FactorFixBias: public FactorAutodiff<FactorFixBias,6,3,3> public: FactorFixBias(FeatureBasePtr _ftr_ptr, bool _apply_loss_function, FactorStatus _status = FAC_ACTIVE) : FactorAutodiff<FactorFixBias, 6, 3, 3>("FactorFixBias", + TOP_ABS, _ftr_ptr, nullptr, nullptr, nullptr, nullptr, nullptr, @@ -34,11 +35,6 @@ class FactorFixBias: public FactorAutodiff<FactorFixBias,6,3,3> virtual ~FactorFixBias() = default; - virtual std::string getTopology() const override - { - return std::string("ABS"); - } - template<typename T> bool operator ()(const T* const _ab, const T* const _wb, T* _residuals) const; diff --git a/include/imu/factor/factor_imu.h b/include/imu/factor/factor_imu.h index 2be43b54d15773093796950d7bb89a9e1581d43d..17c80316246bdd977ed59b4edc0aea6f34dca4f7 100644 --- a/include/imu/factor/factor_imu.h +++ b/include/imu/factor/factor_imu.h @@ -25,11 +25,6 @@ class FactorImu : public FactorAutodiff<FactorImu, 15, 3, 4, 3, 6, 3, 4, 3, 6> ~FactorImu() override = default; - std::string getTopology() const override - { - return std::string("MOTION"); - } - /** \brief : compute the residual from the state blocks being iterated by the solver. -> computes the expected measurement -> corrects actual measurement with new bias @@ -163,6 +158,7 @@ inline FactorImu::FactorImu(const FeatureImuPtr& _ftr_ptr, FactorStatus _status) : FactorAutodiff<FactorImu, 15, 3, 4, 3, 6, 3, 4, 3, 6>( // ... "FactorImu", + TOP_MOTION, _ftr_ptr, _cap_origin_ptr->getFrame(), _cap_origin_ptr,