This commit is contained in:
Max Hunt 2020-02-15 00:01:22 +00:00
parent c0089bb6ff
commit 83f66a3559

View File

@ -154,3 +154,20 @@ hover_distance = 0.2
left_pnp = PickAndPlace('left', hover_distance) left_pnp = PickAndPlace('left', hover_distance)
left_pnp.pick(brickstuff[0]['pose']) left_pnp.pick(brickstuff[0]['pose'])
left_pnp.place(brickstuff[2]['pose'])
left_pnp.pick(brickstuff[0]['pose'])
left_pnp.place(brickstuff[3]['pose'])
left_pnp.pick(brickstuff[0]['pose'])
left_pnp.place(brickstuff[4]['pose'])
left_pnp.pick(brickstuff[1]['pose'])
left_pnp.place(brickstuff[5]['pose'])
left_pnp.pick(brickstuff[1]['pose'])
left_pnp.place(brickstuff[6]['pose'])
left_pnp.pick(brickstuff[0]['pose'])
left_pnp.place(brickstuff[7]['pose'])
left_pnp.pick(brickstuff[0]['pose'])
left_pnp.place(brickstuff[8]['pose'])
left_pnp.pick(brickstuff[1]['pose'])
left_pnp.place(brickstuff[9]['pose'])
left_pnp.pick(brickstuff[0]['pose'])
left_pnp.place(brickstuff[10]['pose'])