super messy working version

"working" version of new nav2d. Needs to be cleaned up a bit more.

Current features are displaying an occupancy grid as a map, putting  the robot pose on it, and double clicking to navigate. Still needs:

* initial pose setting
* PNG image instead of Occupancy grid option
* click-and-drag to change goal pose