New getSubmap function for ROS implementation. New iterator for submap traversal. Other improvements.