Tune params on robot
Add footprint spec to local planner utils
Add shepherdly coverage costmap