added costmap