参照博客做的ORB_SLAM，可以用来保存地图和重载地图。用的时候是先保存好地图后，然后把读图片以及各个节点都注释掉，在ros::shutdown()之前写下：注意用getchar()把程序暂停，要不然看不了地图。