diff --git a/clover/src/simple_offboard.cpp b/clover/src/simple_offboard.cpp index ba8d8354..d5f31790 100644 --- a/clover/src/simple_offboard.cpp +++ b/clover/src/simple_offboard.cpp @@ -913,7 +913,7 @@ bool serve(enum setpoint_type_t sp_type, float x, float y, float z, float vx, fl wait_armed = auto_arm; - // publish setpoint + publish(stamp); // calculate initial transformed messages first setpoint_timer.start(); if (setpoint_type == NAVIGATE || sp_type == NAVIGATE_GLOBAL || sp_type == POSITION) {