super messy working version

[rctoris]

"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

[baalexander]

:+1:

I'll hopefully be able to provide better input after I get a chance to use this in our app.

[rctoris]

@baalexander i would wait a day or two until i can clean it up a bit before integrating but i would love to hear some feedback!