max/robotics
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Update

Browse Source
This commit is contained in:
Max Hunt 2020-02-13 10:02:05 +00:00
parent 26509fe602
commit 23caa80247
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
object_tf_client.py
View File

@ -19,11 +19,11 @@ def tf_lookup(object_name):
continue continue
object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1] , rot[2], rot[3]]) object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1] , rot[2], rot[3]])
xangle = object_angles[0]# + radians(-90) xangle = object_angles[0] + radians(-90)
xangle1 = object_angles[1]# + radians(-90) xangle1 = object_angles[1]# + radians(-90)
xangle2 = object_angles[2]# + radians(-180) xangle2 = object_angles[2]# + radians(-180)
object_angles = (xangle, xangle1, xangle2) object_angles = (xangle, xangle1, xangle2)
target_quat = tf.transformations.quaternion_from_euler(object_angles[0], object_angles[1], object_angles[2]) target_quat = tf.transformations.quaternion_from_euler(xangle, xangle1, xangle2)
target_pose = Pose() target_pose = Pose()
target_pose.position.x = trans[0] target_pose.position.x = trans[0]
target_pose.position.y = trans[1] target_pose.position.y = trans[1]