/* 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) ); */
}