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

make intrinsics and extrinsics non transformable

parent da29a4eb
No related branches found
No related tags found
2 merge requests!54devel->main,!50Resolve "Bootstrap sequence"
......@@ -38,7 +38,7 @@ CaptureImu::CaptureImu(const TimeStamp& _init_ts,
_capture_origin_ptr,
nullptr,
nullptr,
std::make_shared<StateBlock>((_sensor_ptr->getProblem()->getDim() == 2 ? 3 : 6), false))
std::make_shared<StateBlock>((_sensor_ptr->getProblem()->getDim() == 2 ? 3 : 6), false, nullptr, false))
{
//
}
......@@ -57,7 +57,7 @@ CaptureImu::CaptureImu(const TimeStamp& _init_ts,
_capture_origin_ptr,
nullptr,
nullptr,
std::make_shared<StateBlock>(_bias, false))
std::make_shared<StateBlock>(_bias, false, nullptr, false))
{
assert((_bias.size() == 3) or (_bias.size() == 6));
}
......
......@@ -33,9 +33,9 @@ SensorImu::SensorImu(const Eigen::VectorXd& _extrinsics, ParamsSensorImuPtr _par
SensorImu::SensorImu(const Eigen::VectorXd& _extrinsics, const ParamsSensorImu& _params) :
SensorBase("SensorImu",
std::make_shared<StateBlock>(_extrinsics.head(3), true),
std::make_shared<StateQuaternion>(_extrinsics.tail(4), true),
std::make_shared<StateBlock>(6, false, nullptr),
std::make_shared<StateBlock>(_extrinsics.head(3), true, nullptr, false),
std::make_shared<StateQuaternion>(_extrinsics.tail(4), true, false),
std::make_shared<StateBlock>(6, false, nullptr, false),
(Eigen::Vector6d()<<_params.a_noise,_params.a_noise,_params.a_noise,_params.w_noise,_params.w_noise,_params.w_noise).finished(),
false, false, true),
a_noise(_params.a_noise),
......
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