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

improve assert for positive dt

parent 292a921f
No related branches found
No related tags found
No related merge requests found
......@@ -299,7 +299,7 @@ void ProcessorIMU::statePlusDelta(const Eigen::VectorXs& _x,
assert(_x.size() == 10 && "Wrong _x vector size");
assert(_delta.size() == 10 && "Wrong _delta vector size");
assert(_x_plus_delta.size() == 10 && "Wrong _x_plus_delta vector size");
assert(_dt >= 0 && "Time interval _Dt is negative!");
assert(_dt >= 0 && "Time interval _dt is negative!");
_x_plus_delta = imu::composeOverState(_x, _delta, _dt);
}
......
......@@ -382,6 +382,7 @@ void ProcessorMotion::integrateOneStep()
{
// Set dt
dt_ = updateDt();
assert(dt_ >= 0 && "Time interval _dt is negative!");
// get vector of parameters to calibrate
calib_ = getBuffer().getCalibrationPreint();
......
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