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-10 20:33:15 +00:00
parent fc9346eda3
commit e9fbdffa78
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
listener.py
View File

@ -11,9 +11,10 @@ if __name__ == '__main__':
while not rospy.is_shutdown(): while not rospy.is_shutdown():
try: try:
(trans,rot) = listener.lookupTransform('left_gripper', 'base', rospy.Time(0)) (trans,rot) = listener.lookupTransform('left_gripper', 'base', rospy.Time(0))
print((trans, rot))
# except (tf.LookupException, tf.ConnectivityException, tf.ExtrapolationException): # except (tf.LookupException, tf.ConnectivityException, tf.ExtrapolationException):
except: continue except: continue
Translation = [trans.x , trans.y , trans.z] Translation = [trans.x , trans.y , trans.z]
Quaternion = [rot.x , rot.y , rot.z, rot.w] Quaternion = [rot.x , rot.y , rot.z, rot.w]
Angles = tf.transformations.euler_from_quaternion([rot.x , rot.y , Angles = tf.transformations.euler_from_quaternion([rot.x , rot.y ,