diff --git a/new_main.py b/new_main.py index f67063d..a813587 100644 --- a/new_main.py +++ b/new_main.py @@ -216,27 +216,35 @@ left_pnp.gripper_open() spawn_v_brick() left_pnp.pick(brickstuff[0]['pose']) left_pnp.place(brickstuff[2]['pose']) +tuck_arms.init_arms() spawn_v_brick() left_pnp.pick(brickstuff[0]['pose']) left_pnp.place(brickstuff[3]['pose']) +tuck_arms.init_arms() spawn_v_brick() left_pnp.pick(brickstuff[0]['pose']) left_pnp.place(brickstuff[4]['pose']) +tuck_arms.init_arms() spawn_h_brick() left_pnp.pick(brickstuff[1]['pose']) left_pnp.place(brickstuff[5]['pose']) +tuck_arms.init_arms() spawn_h_brick() left_pnp.pick(brickstuff[1]['pose']) left_pnp.place(brickstuff[6]['pose']) +tuck_arms.init_arms() spawn_v_brick() left_pnp.pick(brickstuff[0]['pose']) left_pnp.place(brickstuff[7]['pose']) +tuck_arms.init_arms() spawn_v_brick() left_pnp.pick(brickstuff[0]['pose']) left_pnp.place(brickstuff[8]['pose']) +tuck_arms.init_arms() spawn_h_brick() left_pnp.pick(brickstuff[1]['pose']) left_pnp.place(brickstuff[9]['pose']) +tuck_arms.init_arms() spawn_v_brick() # left_pnp.pick(brickstuff[0]['pose']) # left_pnp.place(brickstuff[10]['pose'])