Improving RRT management in PathPlanning and adding goAndPassTo method in class Robot.