diff --git a/src/lib/FlightTasks/tasks/Utility/ObstacleAvoidance.cpp b/src/lib/FlightTasks/tasks/Utility/ObstacleAvoidance.cpp index e49a2b425a..2fac77484c 100644 --- a/src/lib/FlightTasks/tasks/Utility/ObstacleAvoidance.cpp +++ b/src/lib/FlightTasks/tasks/Utility/ObstacleAvoidance.cpp @@ -234,6 +234,7 @@ ObstacleAvoidance::_publishAvoidanceDesiredWaypoint() void ObstacleAvoidance::_publishVehicleCmdDoLoiter() { vehicle_command_s command{}; + command.timestamp = hrt_absolute_time(); command.command = vehicle_command_s::VEHICLE_CMD_DO_SET_MODE; command.param1 = (float)1; // base mode command.param3 = (float)0; // sub mode diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp index 1248afb84a..4a3df2a902 100644 --- a/src/modules/mavlink/mavlink_receiver.cpp +++ b/src/modules/mavlink/mavlink_receiver.cpp @@ -568,7 +568,7 @@ MavlinkReceiver::handle_message_optical_flow_rad(mavlink_message_t *msg) optical_flow_s f = {}; - f.timestamp = _mavlink_timesync.sync_stamp(flow.time_usec); + f.timestamp = hrt_absolute_time(); f.time_since_last_sonar_update = flow.time_delta_distance_us; f.integration_timespan = flow.integration_time_us; f.pixel_flow_x_integral = flow.integrated_x; diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp index e0ee1ab7cf..b96ef25e47 100644 --- a/src/modules/mc_pos_control/mc_pos_control_main.cpp +++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp @@ -979,6 +979,7 @@ void MulticopterPositionControl::check_failure(bool task_failure, uint8_t nav_st void MulticopterPositionControl::send_vehicle_cmd_do(uint8_t nav_state) { vehicle_command_s command{}; + command.timestamp = hrt_absolute_time(); command.command = vehicle_command_s::VEHICLE_CMD_DO_SET_MODE; command.param1 = (float)1; // base mode command.param3 = (float)0; // sub mode