| 81 | } |
| 82 | |
| 83 | void saveGridMap(const grid_map::GridMap& gridMap, const ros::NodeHandle& nh, const std::string& mapTopic) { |
| 84 | std::string pathToOutputBag = getOutputBagPath(nh); |
| 85 | const bool savingSuccessful = grid_map::GridMapRosConverter::saveToBag(gridMap, pathToOutputBag, mapTopic); |
| 86 | ROS_INFO_STREAM("Saving grid map successful: " << std::boolalpha << savingSuccessful); |
| 87 | } |
| 88 | |
| 89 | inline void printTimeElapsedToRosInfoStream(const std::chrono::system_clock::time_point& start, const std::string& prefix) { |
| 90 | const auto stop = std::chrono::high_resolution_clock::now(); |
no test coverage detected