一种基于SIFT算法的视觉导航方法技术

本发明专利技术提供了一种基于SIFT算法的视觉导航方法，包括：第一步骤：利用机器人的导航相机获取图像；第二步骤：对于导航相机获取的图像基于SIFT方法提取自然路标的特征点；第三步骤：根据所提取的自然路标的特征点，利用动态扩展卡尔曼滤波器融合视觉信息以修正机器人的惯性导航系统的测量误差，由此对机器人运行状态和视觉特征的位置进行估计，从而获得机器人的导航参数。

【技术实现步骤摘要】
一种基于SIFT算法的视觉导航方法
本专利技术涉及机器人视觉导航领域，更具体地说，本专利技术涉及一种基于SIFT算法的视觉导航方法。
技术介绍
目前移动机器人通常采用的定位传感器包括里程计、激光雷达、超声波、红外线、微波雷达、陀螺仪、指南针、速度或加速度计、触觉或接近觉传感器等。另一方面，机器人通常采用的定位技术主要包括绝对定位和相对定位技术两类。绝对定位采用导航信标、主动或被动标识、地图匹配或全球定位(GPS)进行定位，定位精度较高，但成本较高，不适用于小型机器人。相对定位是通过测量机器人相对于初始位置的距离和方向来确定机器人的当前位置，通常也称为航位推算法，所用的传感器主要为里程计、陀螺仪、加速度计等；其中，当采用航位推算法时，机器人的位置是自我推算出来的，因而不需要对外界环境的感知信息，但是，这种方法的漂移误差会随时间积累，不适于精确定位。对于这些现有技术的定位方法，存在以下缺点:⑴在视觉导航定位中，图像处理计算量大，计算机实时处理的速度无法满足现实中的需求。⑵高精度定位与导航技术成本高，难以应用在中小型机器人中，而低成本的技术，精度低，误差大，严重影响了导航效果。由此，希望能够提供一种用于机器人的定位精确高、微型化且低成本的定位技术。
技术实现思路
本专利技术所要解决的技术问题是针对现有技术中存在上述缺陷，提供一种基于SIFT的机器人视觉导航方法，从而实现机器人高定位精确、微型化及低成本的特点，具有理论与实用价值。为了实现上述技术目的，根据本专利技术，提供了一种基于SIFT算法的视觉导航方法，其包括:第一步骤:利用机器人的导航相机获取图像；第二步骤:对于导航相机获取的图像基于SIFT方法提取自然路标的特征点；第三步骤:根据所提取的自然路标的特征点，利用动态扩展卡尔曼滤波器融合视觉信息以修正机器人的惯性导航系统的测量误差，由此对机器人运行状态和视觉特征的位置进行估计，从而获得机器人的导航参数。优选地，所述第二步骤包括:第一步，进行尺度空间极点检测，其中通过不同尺度的高斯核函数对导航相机获取的图像进行连续滤波和下采样，形成高斯金字塔图像，然后再对相邻尺度的两个高斯图像相减得到高斯偏差，以得到关键点；其中，关键点不仅是当前高斯偏差图像局部相邻的预定个数的像素的极大值或极小值，而且是前后相邻尺度的高斯偏差领域的极大或极小值；第二步，进行特征点定位，其中在极值点的局部领域用三维二次函数拟合方法来差值确定极值点的坐标；第三步，进行主方位赋值，其中在构造SIFT描述算子之前，首先为每个关键点赋予一个主方向，其中主方向是指关键点领域内各点梯度方向的直方图中最大值所对应的方向；第四步，进行SIFT描述算子的建立，其中将坐标轴旋转为关键点的方向，以确保任意一个关键点的旋转不变性，而且在关键点所在的尺度空间，取以关键点为中心的16像素X 16像素大小的领域，再将此领域均匀地分为4X4的子区域，对每个子区域计算梯度方向直方图，以构成一个128维的特征向量，再将特征向量的长度归一化，从而获得作为SIFT描述算子的向量 ；第五步，在导航相机获取的多幅图像的SIFT特征点集中找到相应匹配特征点之间的对应关系。优选地，所述第五步包括:针对导航相机获取的图像与模板图像的SIFT特征点，执行欧式距离匹配；剔除欧式距离匹配中的误匹配；根据剔除了误匹配的欧式距离匹配执行当前匹配图像与模板图像的仿射变换。优选地，在第三步骤中，定义机器人方向角为(a，(6, 9 )，定义机器人中的陀螺的偏差为(bp, bq, br),定义视觉信息为(a v, P v, 0 v),则在将惯性导航系统状态变量选择为x=[a, P，0，bp, bq, br]T,并将观测变量选择为[a v, P v, 0 v]的情况下,建立惯性导航系统的状态方程及观测方程，并利用动态扩展卡尔曼滤波器对状态方程及观测方程进行递推以估计机器人的位置信息。【附图说明】结合附图，并通过参考下面的详细描述，将会更容易地对本专利技术有更完整的理解并且更容易地理解其伴随的优点和特征，其中:图1示意性地示出了根据本专利技术优选实施例的基于SIFT算法的视觉导航方法的流程图。图2示意性地示出了根据本专利技术优选实施例的基于SIFT算法的视觉导航方法。图3示意性地示出了根据本专利技术优选实施例的基于动态扩展卡尔曼滤波融合视觉信息与惯性导航参数的一种原理。需要说明的是，附图用于说明本专利技术，而非限制本专利技术。注意，表示结构的附图可能并非按比例绘制。并且，附图中，相同或者类似的元件标有相同或者类似的标号。【具体实施方式】为了使本专利技术的内容更加清楚和易懂，下面结合具体实施例和附图对本专利技术的内容进行详细描述。本专利技术克服了上述现有技术的方法的不足，利用SIFT算法实现自然路标的特征提取与跟踪，根据图像序列中的自然路标位置信息确定机器人位置，并采用动态扩展卡尔曼滤波与惯性导航系统参数的数据融合，从而实现视觉导航信息对惯性导航系统误差的修正，获得精确的导航坐标，同时，达到微型化和低成本的特点，以提高在中小型机器人中的头用性。下面将更具体的描述本专利技术的具体实施例。图1示意性地示出了根据本专利技术优选实施例的基于SIFT (Scale-1nvariantfeature transform,尺度不变特征转换)算法的视觉导航方法的流程图。具体地说，根据本专利技术优选实施例的基于SIFT算法的视觉导航方法包括:第一步骤S1:利用机器人的导航摄像头获取图像；例如，获取的图像是机器人经过的局部环境的图像；而且，优选地，可以将带有云台的摄像头安装在机器人的正前方，由此可以随时拍摄周围的图像。第二步骤S2:对于导航相机获取的图像基于SIFT方法提取自然路标的特征点；其中，对于第二步骤S2，可通过以下几步完成:第一步S10，进行尺度空间极点检测，其中通过不同尺度的高斯核函数对导航相机获取的图像进行连续滤波和下采样，形成高斯金字塔图像，然后再对相邻尺度的两个高斯图像相减得到DOG (高斯偏差)，以得到关键点；其中，关键点不仅是当前DOG图像局部相邻的预定个数的像素(相邻8像素)的极大值或极小值，而且是前后相邻尺度的DOG领域的极大或极小值。其中，“D0G领域”指的是经过高斯图像相减后得到的一系列有高斯偏差的多个图像。第二步S20，进行特征点定位:在极值点的局部领域用三维二次函数拟合方法来差值确定极值点的坐标。第三步S30，进行主方位赋值:在构造SIFT描述算子之前，首先为每个关键点赋予一个主方向，其中主方向是指关键点领域内各点梯度方向的直方图中最大值所对应的方向。但是，在某些情况下，这个主导方位可能不唯一，除了直方图中最大值(最高峰值)，其它所有大于最高峰值80%的方位值(是大于最高峰值的80%的其它值)都要记录下来，后续的描述算子构造均以该方向为参考，这样所构造的描述算子具有旋转不变性。第四步S40，进行SIFT描述算子的建立，其中将坐标轴旋转为关键点的方向，以确保任意一个关键点的旋转不变性，而且在关键点所在的尺度空间(即高斯金字塔结构的某一层)，取以关键点为中心的16像素X 16像素大小的领域，再将此领域均匀地分为4X4的子区域，对每个子区域计算梯度方向直方图(直方图均匀分为8个方向)，这样就构成了一个4X4X8 = 128维的特征向量，再继续将特本文档来自技高网...

【技术保护点】
一种基于SIFT算法的视觉导航方法，其特征在于包括：第一步骤：利用机器人的导航相机获取图像；第二步骤：对于导航相机获取的图像基于SIFT方法提取自然路标的特征点；第三步骤：根据所提取的自然路标的特征点，利用动态扩展卡尔曼滤波器融合视觉信息以修正机器人的惯性导航系统的测量误差，由此对机器人运行状态和视觉特征的位置进行估计，从而获得机器人的导航参数。

【技术特征摘要】
1.一种基于SIFT算法的视觉导航方法，其特征在于包括: 第一步骤:利用机器人的导航相机获取图像； 第二步骤:对于导航相机获取的图像基于SIFT方法提取自然路标的特征点； 第三步骤:根据所提取的自然路标的特征点，利用动态扩展卡尔曼滤波器融合视觉信息以修正机器人的惯性导航系统的测量误差，由此对机器人运行状态和视觉特征的位置进行估计，从而获得机器人的导航参数。2.根据权利要求1所述的基于SIFT算法的视觉导航方法，其特征在于，所述第二步骤包括: 第一步，进行尺度空间极点检测，其中通过不同尺度的高斯核函数对导航相机获取的图像进行连续滤波和下采样，形成高斯金字塔图像，然后再对相邻尺度的两个高斯图像相减得到高斯偏差，以得到关键点；其中，关键点不仅是当前高斯偏差图像局部相邻的预定个数的像素的极大值或极小值，而且是前后相邻尺度的高斯偏差领域的极大或极小值； 第二步，进行特征点定位，其中在极值点的局部领域用三维二次函数拟合方法来差值确定极值点的坐标； 第三步，进行主方位赋值，其中在构造SIFT描述算子之前，首先为每个关键点赋予一个主方向，其中主方向是指关键点领域内各点梯度方向的直方图中最大值所对应的方向； 第四步，进行SIFT描述算子的建立，其中将坐标轴旋转为关键点的...

【专利技术属性】
技术研发人员：崔显龙，朱旭红，张哲栋，王海军，
申请(专利权)人：上海电机学院，
类型：发明
国别省市：