typo

2023-05-15 17:23:01 +02:00
parent a38ca838fd
commit 6ae6de7b98
1 changed files with 4 additions and 4 deletions
--- 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]);
            }