单目视觉里程计的基本算法
主要阐述简单的算法过程, 基于 OpenCV3.0 进行简单实现, 后期进行扩展, 对效率及精度进行一步步优化。...(1) 输入
通过摄像头获取的视频流 (灰度或彩色图像) : 记录摄像头在 t 和 t+1 时刻获得的图像为 It 和 It+1;
相机的内参: 通过相机标定获得, 可以通过 matlab 或者 OpenCV..., 则重新进行特征检测;
通过带 RANSAC 的 Nister’s 5 点算法来估计两幅图像的本质矩阵 E;
使用上一步计算的本质矩阵 E 估计 R,t;
借助外部的尺度信息 (例如车速表: speedometer...distCoeffs, InputArray newCameraMatrix=noArray() )
其中:
src – 输入图像.
dst – 输出图像, 大小和图像类型和 src 相同.
cameraMatrix...OpenCV 中计算本质矩阵的 API 如下:
E = findEssentialMat(points2, points1, focal, pp, RANSAC, 0.999, 1.0, mask);