Added the bulk of the A* algorithm, but it is still untested.
Fix directory structure
It builds fuck yeah
Merge branch 'Sarah'
Please Work
Merge branch 'master' of https://github.com/ajthompson/turtlebot_labs into Sarah

Conflicts:
	src/CMakeLists.txt