Skip to content
Snippets Groups Projects
Commit 2da3495d authored by Bruno Galdos Huaranca's avatar Bruno Galdos Huaranca
Browse files

Update trial_controller_backup.py

parent c52ef601
No related branches found
No related tags found
No related merge requests found
Pipeline #375987 failed
...@@ -44,9 +44,9 @@ class MoveRobotNode(Node): ...@@ -44,9 +44,9 @@ class MoveRobotNode(Node):
self.current_pose[1] = -msg.rigid_body.pose.position.x self.current_pose[1] = -msg.rigid_body.pose.position.x
orientation_q = msg.rigid_body.pose.orientation 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]) 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 #function for moving the robot
def move_robot(self, goal_pose, velocity): def move_robot(self, goal_pose, velocity):
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment