| 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(); |
| 91 | const auto duration = std::chrono::duration_cast<std::chrono::milliseconds>(stop - start).count() / 1000.0; |
| 92 | ROS_INFO_STREAM(prefix << duration << " sec"); |
| 93 | } |
| 94 | |
| 95 | void processPointcloud(grid_map::GridMapPclLoader* gridMapPclLoader, const ros::NodeHandle& nh) { |
| 96 | const auto start = std::chrono::high_resolution_clock::now(); |