void BlockLocalPositionEstimator::checkTimeouts()
{
baroCheckTimeout();
gpsCheckTimeout();
lidarCheckTimeout();
flowCheckTimeout();
sonarCheckTimeout();
visionCheckTimeout();
mocapCheckTimeout();
landCheckTimeout();
}
void BlockLocalPositionEstimator::checkTimeouts()
{
if (_timeStamp - _time_last_xy > EST_SRC_TIMEOUT) {
if (!_xyTimeout) {
_xyTimeout = true;
mavlink_and_console_log_info(&mavlink_log_pub, "[lpe] xy timeout ");
}
} else if (_xyTimeout) {
mavlink_and_console_log_info(&mavlink_log_pub, "[lpe] xy resume ");
_xyTimeout = false;
}
if (_timeStamp - _time_last_z > EST_SRC_TIMEOUT) {
if (!_zTimeout) {
_zTimeout = true;
mavlink_and_console_log_info(&mavlink_log_pub, "[lpe] z timeout ");
}
} else if (_zTimeout) {
mavlink_and_console_log_info(&mavlink_log_pub, "[lpe] z resume ");
_zTimeout = false;
}
if (_timeStamp - _time_last_tz > EST_SRC_TIMEOUT) {
if (!_tzTimeout) {
_tzTimeout = true;
mavlink_and_console_log_info(&mavlink_log_pub, "[lpe] tz timeout ");
}
} else if (_tzTimeout) {
mavlink_and_console_log_info(&mavlink_log_pub, "[lpe] tz resume ");
_tzTimeout = false;
}
lidarCheckTimeout();
sonarCheckTimeout();
baroCheckTimeout();
gpsCheckTimeout();
flowCheckTimeout();
visionCheckTimeout();
mocapCheckTimeout();
}
