Checked files: * include/costmap_queue/costmap_queue.hpp * include/costmap_queue/limited_costmap_queue.hpp * include/costmap_queue/map_based_queue.hpp * src/costmap_queue.cpp * src/limited_costmap_queue.cpp * test/mbq_test.cpp * test/utest.cpp