[发明专利]一种面向室内移动机器人的光流场视觉/INS组合导航方法

说明书

技术领域

一种面向室内移动机器人的光流场视觉/INS组合导航方法，属于复杂环境下组合定位技术领域。

背景技术

近年来，随着计算机技术、信息技术、通讯技术、微电子技术和机器人技术的飞速发展，移动机器人技术的研究与应用取得了长足的进步。室内机器人或运动目标的导航与定位作为实现生产过程智能化和完全自主化的关键技术，逐渐成为目前该领域的研究热点。然而，在外界无线电信号微弱、电磁干扰强烈等一系列复杂室内环境中，对移动目标导航信息获取的准确性、实时性及鲁棒性有很大的影响。如何将室内环境下获取的有限信息进行有效的融合以满足智能移动机器人或运动目标高导航精度的要求，消除外界环境的影响，具有重要的科学理论意义和实际应用价值。

目前移动机器人导航的方式按照传感器的类别大致可分为两大类：基于计算机视觉的导航技术和基于非视觉传感器（如超声波、激光等）的导航技术。非视觉传感器具有感知测量直接，对传感器数据处理能力要求低等特点；但不幸的是，这类传感器的使用将会对环境产生“污染”，特别是在有多个传感器共同工作的情况下，相互之间将会产生严重的干扰。但视觉传感器，它们的采样过程不会对环境产生污染，多个传感器之间也不会产生相互干扰。这种传感器采集的数据往往需要大量的运算，早期很难做到实时。近几年来由于图像处理技术和计算机运算能力的大大增强以及大量数字图像处理设备性价比的提高，加之视觉系统具有信号探测范围宽、目标信息完整等优势，基于视觉传感器的机器人导航己引起人们的极大关注。但是视觉导航系统易受敏感器作用距离和光照条件的限制且导航数据更新频率低。

惯性导航系统以牛顿力学定律为基础，通过测量载体内部载体运动的加速度，经积分运算得到载体的速度和位置等导航信息，实现导航。惯性导航的优点是不需要外部参数作为参考，自身可以提供完全的自主性的和完备的导航信息(机器人的位置、速度及姿态等)，缺点是随时间的增长，移动机器人运动路程逐渐增加，定位的准确度会逐渐的下降。所以惯性传感器适用于短时间的移动机器人精确导航定位。

发明内容

为了解决上述问题，本发明提出了一种面向室内移动机器人的光流场视觉/惯性导航系统(INS)组合导航方法，属于复杂环境下组合定位技术领域。该方法采用基于光流场的视觉导航和INS两种导航方式，移动机器人通过车载摄像头采集车辆的动态视频，在视频中的相邻图片帧之间获取视频光流特征，根据光流特征计算移动机器人在载体坐标系下的横向速度V_x、纵向速度V_y，并与INS测量得到的航向角计算机器人的东向速度V_E和北向速度V_N。将计算得到的V_E、V_N和INS测量得到的航向角变化量ω_Z共同输入到扩展卡尔曼滤波器中进行数据融合，得到比基于光流场视觉导航和INS两种导航方式精度更高的移动机器人的东向和北向的速度和加速度的最优预估。上述方法的提出，为移动机器人提供更加精确的导航信息，扩大了室内机器人定位的范围。

本发明为解决其技术问题，提出如下技术方案：

（1）车载摄像头垂直向下放置，从车载摄像头拍摄的图像帧中选取一个矩形区域作为感兴趣区域ROI（Region of interest，感兴趣区域），后续的处理均在ROI中进行。

（2）在上述ROI中根据Shi-Tomasi角点检测方法提取N个角点（图像中的梯度值和梯度方向变化速率都很高的点），记录角点在图像坐标系下的坐标；

（3）采用图像金字塔Lucas-Kanade光流法对选取的步骤（2）中选取的角点进行跟踪，获取所有角点在下一帧中的图像坐标系中的坐标；

（4）采用随机抽样一致性算法（RANSAC）剔除跟踪异常的角点比如说在一帧图像中检测出20个角点，通过光流法跟踪得到角点在下一帧位置，如果有19个角点纵向位移在10±5个像素点之间，另外一个远大于这个范围，那么这个点就认为跟踪异常），只对跟踪正常的角点进行数据处理；

（5）根据所有跟踪正常的角点在相邻两帧图像中对应的坐标，计算所有正常角点在横向和纵向的位置变化(△x,△y)；