ekf2: selector improve timeout handling and reporting

- relax estimator_status timeout unless attitude hasn't published recently
This commit is contained in:
Daniel Agar
2021-02-14 21:08:56 -05:00
parent 4c5d2363d4
commit 40a452dcd2
2 changed files with 62 additions and 22 deletions
+7 -1
View File
@@ -104,7 +104,12 @@ private:
uORB::Subscription estimator_global_position_sub;
uORB::Subscription estimator_odometry_sub;
estimator_status_s status{};
uint64_t timestamp_sample_last{0};
uint32_t accel_device_id{0};
uint32_t gyro_device_id{0};
uint32_t baro_device_id{0};
uint32_t mag_device_id{0};
hrt_abstime time_last_selected{0};
@@ -113,6 +118,7 @@ private:
bool healthy{false};
bool filter_fault{false};
bool timeout{false};
const uint8_t instance;
};