fix keyboard_control bug

This commit is contained in:
wangWking 2022-05-13 18:14:22 +08:00
parent ade2be13c8
commit 909b3868af

View file

@ -148,8 +148,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, res.ry, res.rz, speed, model]
elif key in "2":
rsp = set_angles(*home_pose)
record_coords = [res.x, res.y, res.z, res.rx, res.ry, res.rz, speed, model]
elif key in "3":
rep = get_angles()
home_pose[0] = rep.joint_1