Made the exit on error explicit.
Initial level graph implementation. Error corrections.
Proper graph generated for a level.
Added waypoint following driver.