For processing map from rosbag
Merge branch 'master' of https://github.com/velveteenrobot/fydp_demo