! * Load the costmap2d into the specified layer. * @warning This does not lock the costmap2d object, you should take care to do so from outside

Check that maps have same geometry

* Initialize cost map size and properties from a grid map. * @param gridMap Grid map containing size info and properties. * @param outputCostmap

* Fill a layer in the output map with data from the subwindow centered at the robot pose. * @warning This does not lock the costmap2d object, you s

dt of 1d function using squared distance */

! * Gets the vector from the center of the map to the center * of the first cell of the map data. * @param[out] vectorToFirstCell the vector from t