Visualize Path Planning with Obstacle Map

[rodja]

The PathPlanner creates PathPlannerCommands which describe the path and obstacles. It would be great to make them viewable directly from within an application. Currently there is only a planner_demo.py file which provides a stand alone visualization.