用于SLAM的,如何比较两断轨迹,以及如何将这两段轨迹用pangolin在界面中绘制出来