working on a costmap plugin