一种基于综合点线特征的井下定位方法及系统
摘要:
本发明公开了一种基于综合点线特征的井下定位方法及系统,在基于点线特征的视觉里程计部分中,首先对双目相机的原始图像进行去畸变和双目校正操作,使得两图像的对极线在同一水平线上。随后对图像进行点线特征提取与匹配,完成后构造系统的点线重投影误差函数并进行位姿估计;随后使用局部优化线程,对位姿进行进一步优化;为了消除累积误差,进行回环检测操作,检测到回环后进行回环校正,并对位姿进行一次全局位姿图优化。本发明可以在在光线较暗以及光线变化的井下场景中拥有较高的定位精度,并且由于对较为耗时的点线特征处理算法进行改进,使得本发明避免了传统基于点线特征的视觉定位方法较为耗时的问题。
0/0