RGBD测程法是去寻找两个连续的RGBD图像对之间的相机移动。输入的是一对RGBImage的实例,输出是刚体变换形式的运动。Open3D实现了论文F.Steinbrucker, J. Sturm, and D. Cremers, Real-time visual odometry from dense RGB-D images, In ICCV Workshops, 2011.和J.Park, Q.-Y. Zhou, and V. Koltun, Colored Point Cloud Registration Revisited, ICCV, 2017. 中的方法。
测试数据:Open3D-RGBD里程计算法测试数据.rar
1、读取相机内参
Open3d 中许多小的数据结构都能够通过json