From 6ae6de7b9847abb4b5dd43ab166aac9f1fac4e05 Mon Sep 17 00:00:00 2001 From: Sem van der Hoeven Date: Mon, 15 May 2023 17:23:01 +0200 Subject: [PATCH] typo --- src/px4_connection/src/px4_controller.cpp | 8 ++++---- 1 file changed, 4 insertions(+), 4 deletions(-) diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp index 88798dcf..2a7819eb 100644 --- a/src/px4_connection/src/px4_controller.cpp +++ b/src/px4_connection/src/px4_controller.cpp @@ -187,10 +187,10 @@ private: } else if (request->control_mode == CONTROL_MODE_POSITION) { - position[0] += position[0]; - position[1] += position[1]; - position[2] -= position[2]; // height is negative - + position[0] += request->values[0]; + position[1] += request->values[1]; + position[2] -= request->values[2]; // height is negative + RCLCPP_INFO(this->get_logger(), "Got new position setpoint: %f %f %f", position[0], position[1], position[2]); }