fix keyboard_control bug

This commit is contained in:
wangWking 2022-05-13 18:06:41 +08:00
parent d2dacd07dc
commit 35383670db

View file

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