multi_map_navigation port from jks-ros-pkg