一种惯性器件辅助的视觉导航方法
【专利摘要】本发明属于导航方法，具体涉及一种惯性器件辅助的视觉导航方法。它包括：步骤一：摄像机探测；步骤二：特征点提取；步骤三：坐标变换；步骤四：归一化；将旋转后的特征点坐标归一化到实际摄像机坐标；步骤五：计算真实坐标；步骤六：计算速度和位移；先计算位移，然后用位移对时间做微分得到速度。本发明的有益效果是：本发明的有益效果是，提出了一种利用惯性器件辅助的视觉导航技术，该方法可以完全利用被动信息提供载体运动速度信息，具有隐蔽性好、抗干扰等优点。
【专利说明】-种惯性器件辅助的视觉导航方法
【技术领域】
[0001] 本发明属于导航方法，具体涉及一种惯性器件辅助的视觉导航方法。
【背景技术】
[0002] 为了提高飞行器导航的隐蔽性，视觉导航得到了广泛深入的研究，主要的实现方 法包括光流法和基于特征点的方法两种。由于光流法容易受到光照变化的影响，因此，当前 更多的视觉导航方法主要是基于特征点的方法。
[0003] 当前基于特征点的视觉导航方法多通过特征点匹配关系求解前后峽图像间的旋 转矩阵R、平移矢量T。该种方法简单且运算速度快，但是受到光照变化、多解的模糊性等 问题，其精度较低。而且，由于待求解的运动参数旋转矩阵R和平移矢量T中共有12个未 知数，因此，理论上至少需要4个不共线的匹配点才能得到运动参数，其实用性受到一定限 制。
[0004] 通常情况下，摄像机和惯性器件是飞行器的标准配置，本专利针对无摄像机稳定 平台的摄像机一飞行器安装方式提出了一种采用惯性器件辅助进行视觉导航的方法。该方 法构建了相邻峽间特征点坐标变化与飞行器姿态变化的对应关系，通过惯性器件输出得到 该旋转关系作为求解的已知条件，进而得到相邻时间间隔内飞行器的飞行速度和位移。在 具体实现方法上，本专利采用了倾斜投影下的特征点坐标变换方法。
【发明内容】
[0005] 本发明的目的是针对现有技术的缺陷，提供一种惯性器件辅助的视觉导航方法。
[0006] 本发明是该样实现的；一种惯性器件辅助的视觉导航方法，包括下述步骤：
[0007] 步骤一：摄像机探测
[0008] 用摄像机采集图像，采集的图像为飞行器垂直向下的图像，采集的图像为灰度图， 采集过程持续进行，本步骤得到一系列连续的灰度图像，
[0009] 步骤二：特征点提取
[0010] 步骤立；坐标变换
[0011] 对步骤二中得到的特征点进行坐标变换，将原始图像中的特征点变换到水平投影 下，
[0012] 步骤二中的特征点包含横坐标、纵坐标两个有效数据，用（Xa，y。）表示，
[0013] 用下述公式进行坐标变换
[0014]
【权利要求】
1. 一种惯性器件辅助的视觉导航方法，其特征在于，包括下述步骤： 步骤一：摄像机探测 用摄像机采集图像，采集的图像为飞行器垂直向下的图像，采集的图像为灰度图，采集 过程持续进行，本步骤得到一系列连续的灰度图像， 步骤二：特征点提取 步骤H ;坐标变换 对步骤二中得到的特征点进行坐标变换，将原始图像中的特征点变换到水平投影下， 步骤二中的特征点包含横坐标、纵坐标两个有效数据，用（X。，y。）表示， 用下述公式进行坐标变换
其中X。、y。为特征点的横坐标和纵坐标，f为摄像机的焦距，X"y" a为变换后的横 坐标和纵坐标，f"为变换后的摄像机等效焦距，R为摄像机的姿态转移矩阵，该姿态转移矩 阵通过导航解算得到，可W表示为
步骤四；归一化 用下述公式将旋转后的特征点坐标归一化到实际摄像机坐标
其中X"。、7"。和f"为步骤H计算得到的结果，X' g、y'。为归一化之后的特征点 坐标， 步骤五；计算真实坐标 用下述公式计算真实坐标
其中，ri?rg为步骤H中姿态转移矩阵R的元素，U。和V。是摄像机焦点的坐标，该坐
标值为摄像机的固有参数；X'。和y'。是步骤四得到的特征点的坐标，f；和fy分别为横 坐标和纵坐标方向的焦距，7=^^^^， 本步骤得到真实坐标xD和yn， 步骤六：计算速度和位移 用下述公式计算速度和位移 A X二XiD-X^n A y二yiLy,。 其中，xA X2\ yi"和ys"均为步骤五计算得到的坐标数值，其中Xi"和yi"表示上一峽计 算得到坐标，Xs"和72"表示本峽计算得到坐标，本步骤得到的是位移A X和A y，用位移对 时间做微分得到的就是速度。
2.如权利要求1所述的一种惯性器件辅助的视觉导航方法，其特征在于：所述的步骤 二采用harris方法提取图像中灰度的突变点作为特征点。
【文档编号】G01C21/24GK104422445SQ201310384423
【公开日】2015年3月18日 申请日期:2013年8月29日 优先权日:2013年8月29日
【发明者】徐超, 宋雅兰, 马春艳, 陈明刚, 马晓磊, 马小艳 申请人:北京自动化控制设备研究所