Jukebox/jukebox-software
10
0
Fork 0
Code Issues 3 Pull Requests Packages Projects Releases 2 Wiki Activity

Use movejs to go to all cable positions

Browse Source
This commit is contained in:
Cole Deck 2024-03-17 16:21:57 -05:00
parent bec0c63763
commit fb85a56d47
1 changed files with 4 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
ur5_control.py
View File

@ -347,10 +347,12 @@ if __name__ == "__main__":
#global config
config = yaml.safe_load(fileread)
joints = []
for joint in config["position_map"]:
print("Going to cable holder index", joint["index"], "at position", joint["pos"])
angles = get_joints_from_xyz_abs(joint["pos"][0]/1000, joint["pos"][1]/1000, 0)
rob.movej(angles, acc=2, vel=2)
angles = get_joints_from_xyz_abs(joint["pos"][1]/1000, joint["pos"][0]/1000, 0)
joints.append(angles)
rob.movejs(joints, acc=2, vel=2)
# joints = []
# for i in np.linspace(-0.3, -0.7, 50):
# joints.append(get_joints_from_xyz_abs(i, 0, 0))