diff --git a/src/modules/sensors/vehicle_angular_velocity/VehicleAngularVelocity.cpp b/src/modules/sensors/vehicle_angular_velocity/VehicleAngularVelocity.cpp index 0264c930de..f2b0d3540b 100644 --- a/src/modules/sensors/vehicle_angular_velocity/VehicleAngularVelocity.cpp +++ b/src/modules/sensors/vehicle_angular_velocity/VehicleAngularVelocity.cpp @@ -79,7 +79,7 @@ bool VehicleAngularVelocity::Start() return false; } - if (!SensorSelectionUpdate(true)) { + if (!SensorSelectionUpdate(hrt_absolute_time(), true)) { ScheduleNow(); } @@ -906,7 +906,7 @@ void VehicleAngularVelocity::Run() // force reselection on timeout if (time_now_us > _last_publish + 500_ms) { - SensorSelectionUpdate(true); + SensorSelectionUpdate(time_now_us, true); } perf_end(_cycle_perf);