视觉里程计 就是利用一个图像序列或者一个视频流，计算摄像机的方向和位置的过程。

10月11日 ----------------------------------------------------------------------

视觉里程计算法（基本知识）：

大多数现有的视觉里程计算法都是基于以下几个步骤：

1、图像获取：单目照相机、双目照相机或者全向照相机；

2、图像校正：使用一些图像处理技术来去除透镜畸变；

3、特征检测：确定感兴趣的描述符，在帧与帧之间匹配特征并构建光流场；

（1）、使用相关性来度量两幅图像间的一致性，并不进行长时间的特征跟踪；

（2）、特征提取、匹配（Lucas–Kanade method）；

（3）、构建光流场；

4、检查光流场向量是否存在潜在的跟踪误差，移除外点；

5、由光流场估计照相机的运动；

（1）、可选方法1：使用卡尔曼滤波进行状态估计；

（2）、可选方法2：查找特征的几何与3D属性，以最小化基于相邻两帧之间的重投影误差的罚函数值。这可以通过数学上的最小化方法或随机采样方法来完成；

6、周期性的重定位跟踪点；

10月13日-----------------------------------------------------------------------------------------------

我选择的视觉里程计算法是：“ sift特征匹配点——基本矩阵——R和T”。

第一步：由特征点计算基本矩阵F。

一般而言，sift点是存在误匹配的情况，因此，采用ransac鲁棒方法计算基本矩阵F。这个过程已经实现，但是还有一个小问题：同样的一组sift点，进行两次基本矩阵计算，得到的基本矩阵差异很大，因此，我在ransac方法的基础上，根据得到的inliers点，采用常规的8点基本矩阵计算方法，这样得到的基本矩阵能保持不变。

第二步：由基本矩阵计算R和T

方法1：奇异值分解

E = KK'*F*KK;    %%这是真实的本质矩阵E

[U,S,V] = svd(E);  %奇异值分解。
T_nonscale = U(:,3); %%  不含有刻度因子的平移向量
D= [0 1 0 ;-1 0 0; 0 0 1];
Ra = U*D*V';或者Rb = U*D'*V';   

方法2：非线性优化解迭代求解。我尝试了三种不同的目标函数形式：

% RT_from_E_ydf.m;   物理意义不明显！精度和速度都不如后面的好。
% RT_point_constraints_ydf.m  速度折中，精度较高
% RT_point_constraints_ydf02.m  速度最快，精度不够高   

发现的问题：特征点的误匹配问题。