costmap_2d: array_parser.cpp compiles and tests work.
Still more to finish in costmap_2d_ros.cpp