diff --git a/new_main.py b/new_main.py index d308fc1..f35e7d4 100644 --- a/new_main.py +++ b/new_main.py @@ -209,7 +209,7 @@ cleanup() tuck_arms.init_arms() hover_distance = 0.2 -left_pnp = PickAndPlace('left', hover_distance) +left_pnp = PickAndPlace('left', hover_distance., speed=0.3) spawn_v_brick() @@ -224,18 +224,18 @@ left_pnp.place(brickstuff[4]['pose']) spawn_h_brick() left_pnp.pick(brickstuff[1]['pose']) left_pnp.place(brickstuff[5]['pose']) -# spawn_h_brick() -# left_pnp.pick(brickstuff[1]['pose']) -# left_pnp.place(brickstuff[6]['pose']) -# spawn_v_brick() -# left_pnp.pick(brickstuff[0]['pose']) -# left_pnp.place(brickstuff[7]['pose']) -# spawn_v_brick() -# left_pnp.pick(brickstuff[0]['pose']) -# left_pnp.place(brickstuff[8]['pose']) -# spawn_h_brick() -# left_pnp.pick(brickstuff[1]['pose']) -# left_pnp.place(brickstuff[9]['pose']) -# spawn_v_brick() +spawn_h_brick() +left_pnp.pick(brickstuff[1]['pose']) +left_pnp.place(brickstuff[6]['pose']) +spawn_v_brick() +left_pnp.pick(brickstuff[0]['pose']) +left_pnp.place(brickstuff[7]['pose']) +spawn_v_brick() +left_pnp.pick(brickstuff[0]['pose']) +left_pnp.place(brickstuff[8]['pose']) +spawn_h_brick() +left_pnp.pick(brickstuff[1]['pose']) +left_pnp.place(brickstuff[9]['pose']) +spawn_v_brick() # left_pnp.pick(brickstuff[0]['pose']) # left_pnp.place(brickstuff[10]['pose'])