From db293545dfa8c8fe127edef84621e62b6e804066 Mon Sep 17 00:00:00 2001 From: Oleg Kalachev Date: Thu, 8 Dec 2022 08:52:30 +0300 Subject: [PATCH] Comments --- clover/src/simple_offboard.cpp | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) diff --git a/clover/src/simple_offboard.cpp b/clover/src/simple_offboard.cpp index 0e92b4b6..76187a0c 100644 --- a/clover/src/simple_offboard.cpp +++ b/clover/src/simple_offboard.cpp @@ -759,8 +759,8 @@ bool serve(enum setpoint_type_t sp_type, float x, float y, float z, float vx, fl // } // } + // Transform position and attitude if (sp_type == POSITION || sp_type == NAVIGATE || sp_type == NAVIGATE_GLOBAL || sp_type == VELOCITY || sp_type == ATTITUDE) { - // destination point and/or attitude PoseStamped ps; ps.header.frame_id = frame_id; ps.header.stamp = stamp; @@ -796,6 +796,7 @@ bool serve(enum setpoint_type_t sp_type, float x, float y, float z, float vx, fl setpoint_attitude.quaternion = setpoint_position.pose.orientation; } + // Transform velocity if (sp_type == VELOCITY) { Vector3Stamped vel; vel.header.frame_id = frame_id;