Manipulating costmap layers in the ROS Navigation Stack