Shortened ToString for some of the classes
Initial commit for some new functions in Navigator
Added a markObstaclePolygon to NavigatorGraph and some cleanup.