Refactored path follower.
PathPlanner refactoring.
To be soft reset.