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 3acae4990b52edb47f974b5a2fc2371925eedb9d..eab06ee21688cc4e8cdd78f4b5479ea12f6b0aa9 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):