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

Merge branch 'hotfix' into 'master'

Fix state blocks in constructor...

See merge request mobile_robotics/wolf!190
parents 2b6a53b7 719ede55
No related branches found
No related tags found
1 merge request!190Fix state blocks in constructor...
...@@ -11,7 +11,7 @@ SensorGPSFix::SensorGPSFix(StateBlockPtr _p_ptr, StateBlockPtr _o_ptr, const dou ...@@ -11,7 +11,7 @@ SensorGPSFix::SensorGPSFix(StateBlockPtr _p_ptr, StateBlockPtr _o_ptr, const dou
} }
SensorGPSFix::SensorGPSFix(const Eigen::VectorXs & _extrinsics, const IntrinsicsGPSFix& _intrinsics) : SensorGPSFix::SensorGPSFix(const Eigen::VectorXs & _extrinsics, const IntrinsicsGPSFix& _intrinsics) :
SensorBase("GPS FIX", std::make_shared<StateBlock>(_extrinsics.head(3)), std::make_shared<StateQuaternion>(_extrinsics.tail(4)), nullptr, _intrinsics.noise_std) SensorBase("GPS FIX", std::make_shared<StateBlock>(_extrinsics.head(3), true), std::make_shared<StateQuaternion>(_extrinsics.tail(4), true), nullptr, _intrinsics.noise_std)
{ {
assert((_extrinsics.size() == 2 || _extrinsics.size() == 3) assert((_extrinsics.size() == 2 || _extrinsics.size() == 3)
&& "Bad extrinsic vector size. Should be 2 for 2D, 3 for 3D."); && "Bad extrinsic vector size. Should be 2 for 2D, 3 for 3D.");
......
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