參照博客做的ORB_SLAM，可以用來保存地圖和重載地圖。用的時候是先保存好地圖后，然后把讀圖片以及各個節點都注釋掉，在ros::shutdown()之前寫下：注意用getchar()把程序暫停，要不然看不了地圖。