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

Merge branch 'hotfix_ConstraintFixBias' into 'master'

Hotfix constraint fix bias

See merge request mobile_robotics/wolf!155
parents 0776bc1d 5b33610c
No related branches found
No related tags found
1 merge request!155Hotfix constraint fix bias
......@@ -5,8 +5,8 @@
//Wolf includes
#include "constraint_autodiff.h"
#include "frame_base.h"
#include "frame_imu.h"
#include "rotations.h"
#include "capture_imu.h"
#include "feature_imu.h"
//#include "ceres/jet.h"
......@@ -21,8 +21,8 @@ class ConstraintFixBias: public ConstraintAutodiff<ConstraintFixBias,6,3,3>
{
public:
ConstraintFixBias(FeatureBasePtr _ftr_ptr, bool _apply_loss_function = false, ConstraintStatus _status = CTR_ACTIVE) :
ConstraintAutodiff<ConstraintFixBias, 6, 3, 3>(CTR_FIX_BIAS, nullptr, nullptr, nullptr, nullptr, nullptr, _apply_loss_function, _status, std::static_pointer_cast<FrameIMU>(_ftr_ptr->getFramePtr())->getAccBiasPtr(),
std::static_pointer_cast<FrameIMU>(_ftr_ptr->getFramePtr())->getGyroBiasPtr())
ConstraintAutodiff<ConstraintFixBias, 6, 3, 3>(CTR_FIX_BIAS, nullptr, nullptr, nullptr, nullptr, nullptr, _apply_loss_function, _status, std::static_pointer_cast<CaptureIMU>(_ftr_ptr->getCapturePtr())->getAccBiasPtr(),
std::static_pointer_cast<CaptureIMU>(_ftr_ptr->getCapturePtr())->getGyroBiasPtr())
{
setType("FIX BIAS");
// std::cout << "created ConstraintFixBias " << std::endl;
......
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