Function getVectorToFirstCell

grid_map_core/src/GridMapMath.cpp:44–53

! * 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 the center of the cell to the center of the map. * @param[in] mapLength the lengths in x and y direction. * @param[in] resolution the resolution of the map. * @return true if successful. */

 * @return true if successful.
 */
inline bool getVectorToFirstCell(Vector& vectorToFirstCell,
                                 const Length& mapLength, const double& resolution)
{
  Vector vectorToOrigin;
  getVectorToOrigin(vectorToOrigin, mapLength);

  // Vector to center of cell.
  vectorToFirstCell = (vectorToOrigin.array() - 0.5 * resolution).matrix();
  return true;
}

inline Eigen::Matrix2i getBufferOrderToMapFrameTransformation()
{