一种惯性器件辅助的视觉导航方法技术

技术编号:11165272 阅读:105 留言:0更新日期:2015-03-18 21:44
本发明专利技术属于导航方法,具体涉及一种惯性器件辅助的视觉导航方法。它包括:步骤一:摄像机探测;步骤二:特征点提取;步骤三:坐标变换;步骤四:归一化;将旋转后的特征点坐标归一化到实际摄像机坐标;步骤五:计算真实坐标;步骤六:计算速度和位移;先计算位移,然后用位移对时间做微分得到速度。本发明专利技术的有益效果是:本发明专利技术的有益效果是,提出了一种利用惯性器件辅助的视觉导航技术,该方法可以完全利用被动信息提供载体运动速度信息,具有隐蔽性好、抗干扰等优点。

【技术实现步骤摘要】
-种惯性器件辅助的视觉导航方法
本专利技术属于导航方法,具体涉及。
技术介绍
为了提高飞行器导航的隐蔽性,视觉导航得到了广泛深入的研究,主要的实现方 法包括光流法和基于特征点的方法两种。由于光流法容易受到光照变化的影响,因此,当前 更多的视觉导航方法主要是基于特征点的方法。 当前基于特征点的视觉导航方法多通过特征点匹配关系求解前后峽图像间的旋 转矩阵R、平移矢量T。该种方法简单且运算速度快,但是受到光照变化、多解的模糊性等 问题,其精度较低。而且,由于待求解的运动参数旋转矩阵R和平移矢量T中共有12个未 知数,因此,理论上至少需要4个不共线的匹配点才能得到运动参数,其实用性受到一定限 制。 通常情况下,摄像机和惯性器件是飞行器的标准配置,本专利针对无摄像机稳定 平台的摄像机一飞行器安装方式提出了一种采用惯性器件辅助进行视觉导航的方法。该方 法构建了相邻峽间特征点坐标变化与飞行器姿态变化的对应关系,通过惯性器件输出得到 该旋转关系作为求解的已知条件,进而得到相邻时间间隔内飞行器的飞行速度和位移。在 具体实现方法上,本专利采用了倾斜投影下的特征点坐标变换方法。
技术实现思路
本专利技术的目的是针对现有技术的缺陷,提供。 本专利技术是该样实现的;,包括下述步骤: 步骤一:摄像机探测 用摄像机采集图像,采集的图像为飞行器垂直向下的图像,采集的图像为灰度图, 采集过程持续进行,本步骤得到一系列连续的灰度图像, 步骤二:特征点提取 步骤立;坐标变换 对步骤二中得到的特征点进行坐标变换,将原始图像中的特征点变换到水平投影 下, 步骤二中的特征点包含横坐标、纵坐标两个有效数据,用(Xa,y。)表示, 用下述公式进行坐标变换 本文档来自技高网...

【技术保护点】
一种惯性器件辅助的视觉导航方法,其特征在于,包括下述步骤:步骤一:摄像机探测用摄像机采集图像,采集的图像为飞行器垂直向下的图像,采集的图像为灰度图,采集过程持续进行,本步骤得到一系列连续的灰度图像,步骤二:特征点提取步骤三:坐标变换对步骤二中得到的特征点进行坐标变换,将原始图像中的特征点变换到水平投影下,步骤二中的特征点包含横坐标、纵坐标两个有效数据,用(xa,ya)表示,用下述公式进行坐标变换xa″ya″f″=Rxayaf]]>其中xa、ya为特征点的横坐标和纵坐标,f为摄像机的焦距,x″a、y″a为变换后的横坐标和纵坐标,f″为变换后的摄像机等效焦距,R为摄像机的姿态转移矩阵,该姿态转移矩阵通过导航解算得到,可以表示为R=r1r2r3r4r5r6r7r8r9]]>步骤四:归一化用下述公式将旋转后的特征点坐标归一化到实际摄像机坐标As=xa′ya′f=ff″xa″ff″ya″ff″f″]]>其中x″a、y″a和f″为步骤三计算得到的结果,x′a、y′a为归一化之后的特征点坐标,步骤五:计算真实坐标用下述公式计算真实坐标As′=xnynf‾=fxr1(xa′-u0)+r2(ya′-v0)+r3f‾r7(xa′-u0)+r8(ya′-v0)+r9f‾fyr4(xa′-u0)+r5(ya′-v0)+r6f‾r7(xa′-u0)+r8(ya′-v0)+r9f‾f‾]]>其中,r1~r9为步骤三中姿态转移矩阵R的元素,u0和v0是摄像机焦点的坐标,该坐标值为摄像机的固有参数;x′a和y′a是步骤四得到的特征点的坐标,fx和fy分别为横坐标和纵坐标方向的焦距,本步骤得到真实坐标xn和yn,步骤六:计算速度和位移用下述公式计算速度和位移△x=x1n‑x2n△y=y1n‑y2n其中,x1n、x2n、y1n和y2n均为步骤五计算得到的坐标数值,其中x1n和y1n表示上一帧计算得到坐标,x2n和y2n表示本帧计算得到坐标,本步骤得到的是位移△x和△y,用位移对时间做微分得到的就是速度。...

【技术特征摘要】
1. 一种惯性器件辅助的视觉导航方法,其特征在于,包括下述步骤: 步骤一:摄像机探测 用摄像机采集图像,采集的图像为飞行器垂直向下的图像,采集的图像为灰度图,采集 过程持续进行,本步骤得到一系列连续的灰度图像, 步骤二:特征点提取 步骤H ;坐标变换 对步骤二中得到的特征点进行坐标变换,将原始图像中的特征点变换到水平投影下, 步骤二中的特征点包含横坐标、纵坐标两个有效数据,用(X。,y。)表示, 用下述公式进行坐标变换其中X。、y。为特征点的横坐标和纵坐标,f为摄像机的焦距,Xy a为变换后的横 坐标和纵坐标,f为变换后的摄像机等效焦距,R为摄像机的姿态转移矩阵,该姿态转移矩 阵通过导航解算得到,可W表示为步骤四;归一化 用下述公式将旋转后的特征点坐标归一化到实际摄像机坐标其中X。、7。和f为步骤H计算得到的结果,X' g、y'。为归...

【专利技术属性】
技术研发人员:徐超宋雅兰马春艳陈明刚马晓磊马小艳
申请(专利权)人:北京自动化控制设备研究所
类型:发明
国别省市:北京;11

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1