sbpl_lattice_planner: add target dependency to sbpl_lattice_planner_generated_messages_cpp
sbpl_lattice_planner: do not copy Costmap2D instance and remove
clearRobotFootprint() calls

based on https://github.com/ros-