fix keyboard_control bug

This commit is contained in:
wangWking 2022-05-13 18:11:24 +08:00
parent 2962874024
commit d4ccf6bc0f

View file

@ -138,8 +138,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