实现了1D,2D,3D空间自由度下的运动参数的扩展Kalman滤波算法，文章2008 IROS Visual SLAM for 3D Large-Scale Seabed Acquisition Employing Underwater Vehicles的具体实现。-a novel technique to align partial 3D reconstructions of the seabed acquired by a stereo camera mounted on an au