/* Move arm to various places */ void test_move(Arm &arm) { arm.move_to( iPair(4,2) ); arm.move_to( iPair(3,0) ); arm.move_to( iPair(2,2) ); arm.move_to( iPair(0,0) ); }
~Sling() { arm.move_to( iPair(0,0) ); mav(motor_shoulder, -200); mav(motor_arm, -200); sleep(0.2); ao(); }
void test_board_move(Arm &arm) { Move move(iPair(4,1), iPair(4, 2)); /* Move arm according to move */ arm.execute_move(move); /* Move arm to 0,0) */ arm.move_to(iPair(0,0)); /* move = Move(iPair(5, 0), iPair(4,0)); */ /* arm.execute_move(move); */ /* arm.move_to( iPair(3,0) ); */ /* arm.move_to(iPair(0,0) ); */ }