一种捷联惯性导航系统/视觉里程计组合导航方法技术方案

一种捷联惯性导航系统/视觉里程计组合导航方法，包括以下步骤：在运载体上安装双目视觉里程计、光纤陀螺惯性导航系统，并采集各个传感器的数据；利用FAST方法对图像序列中的特征进行提取，并利用基于随机抽样一致的特征匹配方法完成特征匹配，计算出运载体的运动信息；建立捷联惯性导航系统/视觉里程计组合导航系统的非线性状态方程和量测方程；利用非线性滤波器容积卡尔曼滤波完成捷联惯性导航系统/视觉里程计组合导航系统的时间更新和量测更新，对系统状态进行估计，实现捷联惯性导航系统/视觉里程计组合导航系统的导航定位。本发明专利技术方法优化了特征匹配算法，并利用非线性容积卡尔曼滤波算法，提高了组合导航系统的定位精度和鲁棒性。

A combined navigation method of strapdown inertial navigation system / visual odometer

The integrated navigation method of visual odometry for strapdown inertial navigation system, which comprises the following steps: installing binocular visual odometry, fiber optic gyro inertial navigation system in vehicle, and collect all sensor data; on feature in image sequence is extracted by using FAST method, and using the feature matching method to complete the random sample consensus feature matching based on motion information, calculate the shipping carrier; the establishment of nonlinear state equation and the strapdown inertial navigation system / visual odometer integrated navigation system measuring equations; time updating and the amount of strapdown inertial navigation system / visual odometer integrated navigation system to complete the measurement update using nonlinear filter volume Calman filter, the system state estimation. To realize the navigation of strapdown inertial navigation system / visual odometer integrated navigation system. The method optimizes the feature matching algorithm, and improves the positioning accuracy and robustness of the integrated navigation system by using the nonlinear volume Calman filtering algorithm.

【技术实现步骤摘要】
一种捷联惯性导航系统/视觉里程计组合导航方法
本专利技术属于组合导航领域，具体涉及一种捷联惯性导航系统/视觉里程计组合导航方法。
技术介绍
近年来，导航领域中单独的导航子设备或者子系统不断的发展，其性能日趋完善，各自的优势和局限性日趋明显。随着科学技术的飞速发展，而任何一种单独的导航子设备或者子系统不可能完全实现日益增长的导航需求的目的，因此可以实现优势互补的组合导航技术的应用正在不断扩展，并受到了越来越广泛的重视。由于捷联惯性导航系统(StrapdownInertialNavigationSystem，SINS)具有低成本、小体积、全自主、隐蔽性好、采样频率高等优势，被广泛应用于多种领域；而全球导航卫星系统具有单点定位精度高、误差不随时间发散等优点，因此将捷联惯性导航系统与全球导航卫星系统进行组合可以实现优势互补，从而提高整个导航系统的精度。目前捷联惯性导航系统/全球导航卫星系统组合导航是应用最为广泛的一种组合导航形式。然而捷联惯性导航系统/全球导航卫星系统组合导航系统对全球导航卫星系统信息的依赖程度过大，而全球导航卫星系统信息又绝对依赖于外部卫星信号。因此在森林覆盖区、建筑物密集区、室内、水下等环境中时，全球导航卫星系统信号就很容易受到干扰而产生信号拥堵或堵塞，从而造成全球导航卫星系统定位精度严重下降，进而大幅度降低整个组合导航系统的定位精度，因此需要寻求一种新的组合导航方式。基于视觉传感器的视觉里程计(VisualOdometer，VO)是目前新兴的一种导航设备，具有价格低、耗能少、信息量丰富等优势，因此视觉里程计迅速得到了广泛的关注与应用，基于捷联惯性导航系统/视觉里程计的组合导航技术也称为导航领域内的一个十分重要的研究方向。视觉里程计是利用视觉传感器捕获周围环境的图像信息，然后通过计算机视觉处理算法对图像或者图像序列进行处理，从而实现对周围环境的理解，实现对运载体的导航与定位。因此如何高效的从图像序列中提取出有效的周围环境信息，即特征提取与匹配问题，成为视觉辅助导航技术研究中极为重要的内容之一。为提高视觉里程计的计算效率，特征提取与匹配方法需要具有高效性，而加速分割检测特征(FeaturefromAcceleratedSegmentTest，FAST)方法由于具有简单有效、计算速度快等优势，被应用于视觉特征与匹配过程中。但是FAST仅仅对一小部分像素进行了处理，所以其对噪声特别敏感，极易受到周围环境的影响。针对这一问题，本专利技术提出了一种改进的FAST特征提取方法，通过降低误匹配率来抑制环境噪声对视觉里程计算法精度的影响，利用非线性滤波器容积卡尔曼滤波(CubatureKalmanFilter，CKF)完成对捷联惯性导航系统/视觉里程计组合导航系统状态的估计，从而提高捷联惯性导航系统/视觉里程计组合导航系统的定位精度和鲁棒性。
技术实现思路
本专利技术的目的是提供一种能够同时定位精度更高和鲁棒性更好的捷联惯性导航系统/视觉里程计组合导航方法。本专利技术的目的是通过以下步骤来实现的：步骤1：在运载体上安装双目视觉里程计、光纤陀螺惯性导航系统，对捷联惯性导航系统/视觉里程计组合导航系统进行预热，并采集各个传感器的数据；步骤2：根据视觉里程计中的双目摄像头采集到的图像序列，利用FAST方法对图像序列中的特征进行提取，并利用基于随机抽样一致的特征匹配方法完成特征匹配，并根据视觉里程计原理计算出运载体的运动信息；步骤3：建立捷联惯性导航系统/视觉里程计组合导航系统的非线性状态方程；步骤4：以捷联惯性导航系统与视觉里程计测得的速度误差为观测量，建立捷联惯性导航系统/视觉里程计组合导航系统的量测方程；步骤5：利用非线性滤波器容积卡尔曼滤波完成捷联惯性导航系统/视觉里程计组合导航系统的时间更新和量测更新，对系统状态进行估计，实现捷联惯性导航系统/视觉里程计组合导航系统的导航定位。进一步地，在步骤2中，利用FAST方法对图像序列中的特征进行提取，并利用基于随机抽样一致的特征匹配方法完成特征匹配，并根据视觉里程计原理计算出运载体的运动信息，其具体方法为：1)通过视觉里程计的双目视觉里程计获取运载体周围环境的图像对，并对图像序列进行校正；2)对校正后的图像序列利用FAST进行图像特征提取，并生成特征向量；3)对从图像对中所提取的特征点，利用最近邻和次最近邻的距离比方法进行图像特征粗匹配；4)利用随机抽样一致方法对完成粗匹配后的特征点对进一步提纯，完成图像特征的精匹配；5)根据三角测量原理和左右两张图像中成功匹配的特征点对信息，计算得到每个匹配特征点的3D坐标；6)对当前帧和下一帧两相邻时刻的左侧图像中的3D特征点进行匹配，计算出双目视觉的运动信息，包括旋转矩阵和平移矩阵；7)根据运载体与视觉里程计之间的坐标系变换，计算出运载体相对初始时刻的位移和姿态变化，得到运载体的运动信息。本专利技术的优势在于：(1)由于利用改进的特征匹配方法，对特征点进行了粗匹配和精匹配两次匹配过程，有效剔除了误匹配点对，减小了由外界干扰引起的误匹配点对对视觉里程计定位精度的影响，从而提高了捷联惯性导航系统/视觉里程计组合导航系统的定位精度和鲁棒性；(2)利用非线性滤波器容积卡尔曼滤波完成对捷联惯性导航系统/视觉里程计组合导航系统状态的估计，进一步提高了组合导航系统的精度。附图说明图1为本专利技术的流程图；图2为本专利技术中改进的双目视觉里程计算法的流程图；图3运载体的真实运动轨迹；图4为利用本专利技术方法和传统方法时运载体的运动轨迹对比图；图5为利用本专利技术方法和传统方法时运载体位置误差对比曲线。具体实施方式以下结合具体实施案例，对本专利技术进行详细说明。本专利技术是一种基于随机抽样一致的改进的捷联惯性导航系统/视觉里程计组合导航方法，结合图1～2所示的算法流程框图，其具体实施方式为：步骤1：在运载体上安装双目视觉里程计、光纤陀螺惯性导航系统以及全球定位系统，其中捷联惯性导航系统与全球定位系统工作于组合导航模式并作为数据基准。对运载体上的各传感器和设备进行预热，并采集各个传感器和设备的数据；步骤2：利用视觉里程计中的双目摄像头采集到运载体周围环境的图像序列，并完成对图像序列的校正；对校正后的图像序列利用FAST方法对图像进行分割测试提取候选特征点，其中每个像素p点，其周围以3个像素为半径的圆上的像素点可以分为三类：其中Ip为中心采样点p的像素值，Ip→x为p点周围圆形模板上的点x的像素值，t是比较阈值。随后，利用迭代决策算法来选择具有最大信息增益的像素点作为特征点。设Kp为一参数，当p为特征点，Kp为true，否则为false。而参数Kp的熵可以用公式(3-9)来表示：其中c＝|{p|Kpistrue}|表示特征点的数目，表示非特征点的数目。那么，图像中某一个特定像素的信息增益的计算公式为：H(P)-H(Pd)-H(Ps)-H(Pb)对上述三类像素依次进行反复计算，直到熵为0，即可提取出候选特征点。随后，利用非极大值抑制方法精确确定特征点，定义一个特征点响应函数根据定义的特征点响应函数计算每个候选特征点的响应函数值，然后利用非极大值抑制方法对非特征点进行排除，筛选出真正的特征点。利用小波响应分配特征点方向并生成特征描述向量，计算相应特征点的欧式距离，设两幅图中的特征点本文档来自技高网...

【技术保护点】
一种捷联惯性导航系统/视觉里程计组合导航方法，其特征在于，包括以下步骤：步骤1：在运载体上安装双目视觉里程计、光纤陀螺惯性导航系统，对捷联惯性导航系统/视觉里程计组合导航系统进行预热，并采集各个传感器的数据；步骤2：根据视觉里程计中的双目摄像头采集到的图像序列，利用FAST方法对图像序列中的特征进行提取，并利用基于随机抽样一致的特征匹配方法完成特征匹配，并根据视觉里程计原理计算出运载体的运动信息；步骤3：建立捷联惯性导航系统/视觉里程计组合导航系统的非线性状态方程；步骤4：以捷联惯性导航系统与视觉里程计测得的速度误差为观测量，建立捷联惯性导航系统/视觉里程计组合导航系统的量测方程；步骤5：利用非线性滤波器容积卡尔曼滤波完成捷联惯性导航系统/视觉里程计组合导航系统的时间更新和量测更新，对系统状态进行估计，实现捷联惯性导航系统/视觉里程计组合导航系统的导航定位。

【技术特征摘要】
1.一种捷联惯性导航系统/视觉里程计组合导航方法，其特征在于，包括以下步骤：步骤1：在运载体上安装双目视觉里程计、光纤陀螺惯性导航系统，对捷联惯性导航系统/视觉里程计组合导航系统进行预热，并采集各个传感器的数据；步骤2：根据视觉里程计中的双目摄像头采集到的图像序列，利用FAST方法对图像序列中的特征进行提取，并利用基于随机抽样一致的特征匹配方法完成特征匹配，并根据视觉里程计原理计算出运载体的运动信息；步骤3：建立捷联惯性导航系统/视觉里程计组合导航系统的非线性状态方程；步骤4：以捷联惯性导航系统与视觉里程计测得的速度误差为观测量，建立捷联惯性导航系统/视觉里程计组合导航系统的量测方程；步骤5：利用非线性滤波器容积卡尔曼滤波完成捷联惯性导航系统/视觉里程计组合导航系统的时间更新和量测更新，对系统状态进行估计，实现捷联惯性导航系统/视觉里程计组合导航系统的导航定位。2.如权利要求1所述的一种捷联惯性导航系统/视觉里程...

【专利技术属性】
技术研发人员：孙骞，刁鸣，李一兵，田宇，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23