save/load toponav map works basic. No occ grid, pose saving/load and ros::time correction yet. Visualization is dropping often (due to the marker lifetime I set): cycles take multiple seconds it seems...