From 2da3495d58656f3044872fb9e4187ffaf094726d Mon Sep 17 00:00:00 2001 From: Bruno Galdos Huaranca <bruno.galdos@ucsp.edu.pe> Date: Tue, 19 Mar 2024 13:54:24 +0100 Subject: [PATCH] Update trial_controller_backup.py --- .../my_controller/my_controller/trial_controller_backup.py | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/colcon_ws/src/my_controller/my_controller/trial_controller_backup.py b/colcon_ws/src/my_controller/my_controller/trial_controller_backup.py index 3acae49..eab06ee 100755 --- a/colcon_ws/src/my_controller/my_controller/trial_controller_backup.py +++ b/colcon_ws/src/my_controller/my_controller/trial_controller_backup.py @@ -44,9 +44,9 @@ class MoveRobotNode(Node): self.current_pose[1] = -msg.rigid_body.pose.position.x orientation_q = msg.rigid_body.pose.orientation r = R.from_quat([orientation_q.q_x, orientation_q.q_y, orientation_q.q_z, orientation_q.q_w]) - _, _, yaw = r.as_euler('XYZ') + _, _, roll = r.as_euler('XYZ') - self.current_pose[2] = yaw + self.current_pose[2] = roll #function for moving the robot def move_robot(self, goal_pose, velocity): -- GitLab