LayeredCostmapROS--> Costmap2DROS
Add missing header pounds
Change back to Costmap2dROS
Reintegrate Costmap2d into NavFn
Add Name Field
Fix Cleanup