mirror of
https://github.com/elephantrobotics/mycobot_ros.git
synced 2026-07-14 09:00:53 +00:00
update 320m5/pi
This commit is contained in:
parent
c3e2cae967
commit
28e6ecf71d
2 changed files with 4 additions and 5 deletions
|
|
@ -82,14 +82,14 @@ def teleop_keyboard():
|
||||||
exit(1)
|
exit(1)
|
||||||
|
|
||||||
init_pose = [0, 0, 0, 0, 0, 0, speed]
|
init_pose = [0, 0, 0, 0, 0, 0, speed]
|
||||||
home_pose = [0, 8, -127, 40, 0, 0, speed]
|
home_pose = [0, 8, -127, 40, 90, 0, speed]
|
||||||
|
|
||||||
# rsp = set_angles(*init_pose)
|
# rsp = set_angles(*init_pose)
|
||||||
|
|
||||||
while True:
|
while True:
|
||||||
res = get_coords()
|
res = get_coords()
|
||||||
# print(res)
|
# print(res)
|
||||||
if res.x > 1:
|
if res:
|
||||||
break
|
break
|
||||||
time.sleep(0.1)
|
time.sleep(0.1)
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -82,14 +82,13 @@ def teleop_keyboard():
|
||||||
exit(1)
|
exit(1)
|
||||||
|
|
||||||
init_pose = [0, 0, 0, 0, 0, 0, speed]
|
init_pose = [0, 0, 0, 0, 0, 0, speed]
|
||||||
home_pose = [0, 8, -127, 40, 0, 0, speed]
|
home_pose = [0, 8, -127, 40, 90, 0, speed]
|
||||||
|
|
||||||
# rsp = set_angles(*init_pose)
|
# rsp = set_angles(*init_pose)
|
||||||
|
|
||||||
while True:
|
while True:
|
||||||
res = get_coords()
|
res = get_coords()
|
||||||
if res.x > 1:
|
if res:
|
||||||
print("joint1's angle : "+str(res.x)+"is not > 1,please calibrate the joint1's angle")
|
|
||||||
break
|
break
|
||||||
time.sleep(0.1)
|
time.sleep(0.1)
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Add table
Reference in a new issue