Merge pull request #10 from hasofanten/master

Implemented path planner algorithm, no integration done so far
Merge pull request #11 from hasofanten/master

commented code and added the updated CMakeList
Merge pull request #1 from RoboGroup3/master

Updates
Makes us of the path planner after x mins and visualize it
Changes which makes it possible to use a path
Removes the ugly copy of MazeController and lets the navigation use only what it needs
Merge pull request #12 from JohanJohansson/master

Updates from Johan
Merge pull request #2 from RoboGroup3/master

merge to haso