Browse Source

inav: check for updated baro in baro_offset calculation

sbg
davidaroyer 8 years ago committed by Lorenz Meier
parent
commit
1302b6a796
  1. 4
      src/modules/position_estimator_inav/position_estimator_inav_main.cpp

4
src/modules/position_estimator_inav/position_estimator_inav_main.cpp

@ -424,7 +424,9 @@ int position_estimator_inav_thread_main(int argc, char *argv[]) @@ -424,7 +424,9 @@ int position_estimator_inav_thread_main(int argc, char *argv[])
if (fds_init[0].revents & POLLIN) {
orb_copy(ORB_ID(sensor_combined), sensor_combined_sub, &sensor);
if (wait_baro && sensor.timestamp + sensor.baro_timestamp_relative != baro_timestamp) {
bool baro_updated = (sensor.baro_timestamp_relative != sensor.RELATIVE_TIMESTAMP_INVALID);
if (wait_baro && sensor.timestamp + sensor.baro_timestamp_relative != baro_timestamp && baro_updated) {
baro_timestamp = sensor.timestamp + sensor.baro_timestamp_relative;
baro_wait_for_sample_time = hrt_absolute_time();

Loading…
Cancel
Save