fix keyboard_control bug

This commit is contained in:
wangWking 2022-05-13 18:09:18 +08:00
parent f316e6898c
commit 2962874024

View file

@ -139,8 +139,10 @@ def teleop_keyboard():
switch_gripper(False)
elif key == "1":
rsp = set_angles(*init_pose)
record_coords = [res.x, res.y, res.z, res.rx, speed, model]
elif key in "2":
rsp = set_angles(*home_pose)
record_coords = [res.x, res.y, res.z, res.rx, speed, model]
elif key in "3":
rep = get_angles()
home_pose[0] = rep.joint_1