From 1e0acb8e7a7dac2544fbb4ef24b21802c2b00a37 Mon Sep 17 00:00:00 2001 From: Sem van der Hoeven Date: Thu, 25 May 2023 12:38:39 +0200 Subject: [PATCH] add log on handle request --- src/drone_controls/src/PositionChanger.cpp | 2 ++ 1 file changed, 2 insertions(+) diff --git a/src/drone_controls/src/PositionChanger.cpp b/src/drone_controls/src/PositionChanger.cpp index ac1c4ebd..cb961b29 100644 --- a/src/drone_controls/src/PositionChanger.cpp +++ b/src/drone_controls/src/PositionChanger.cpp @@ -170,6 +170,8 @@ public: // TODO add check_move_direction_allowed results to this calculation this->current_yaw += (request->angle % 360) * (M_PI / 180.0); // get the angle in radians get_x_y_with_rotation(request->front_back, request->left_right, this->current_yaw, &this->current_speed_x, &this->current_speed_y); + RCLCPP_INFO(this->get_logger(), "Calculated speed x: %f, y: %f", this->current_speed_x, this->current_speed_y); + send_trajectory_message(); response->success = true; }