基于卡尔曼滤波的四轴飞行器成像、惯性和高度组合导航  

Imaging,Inertial and Altitude Integrated Navigation for Quadrotor Based on Calman Filter

作　　者：邹强 付超 莫申童 ZOU Qiang;FU Chao;MO Shentong(School of Microelectronics,Tianjin University,Tianjin 300072,China;Tianjin International Joint Research Center for Internet of Things,Tianjin 300072,China;Tianjin Key Laboratory of Imaging and Sensing Microelectronic Technology,Tianjin 300072,China;Qingdo Insuitute Ocean Engineering of Tianjin University,Qingdao Shandong 300072,China)

机构地区：[1]天津大学微电子学院,天津300072 [2]天津市物联网国际联合研究中心,天津300072 [3]天津市成像与感知微电子技术重点实验室,天津300072 [4]天津大学青岛海洋技术研究院,山东青岛300072

出　　处：《传感技术学报》2019年第1期1-7,共7页Chinese Journal of Sensors and Actuators

基　　金：国家科技支撑计划项目(30249);青岛科技支撑专项项目(17-3-3-90-nsh);住建部科学技术计划项目(2017-K8-028);天津建设系统软课题研究项目(2018E6-0009)

摘　　要：为了提高四轴飞行器在非结构化、室内和GPS失效环境下的导航精度,本文提出一种用于四轴飞行器的成像、惯性和高度组合导航。首先对四轴飞行器搭载的摄像机进行了标定,获取了摄像机的内外参数。其次设计了着陆标志为标准参照物,以及着陆标志识别方案。再利用卡尔曼滤波器融合视觉、惯性测量系统和超声波测距仪的数据,通过相似三角形定理估计飞行器的相对高度,利用视觉测程法估计飞行器位置和位移速度。最后验证组合导航的有效性,用成像、惯性与高度组合导航实验平台依次进行了相对高度估计实验、平移速度和相对位置估计实验,实验测试表明:在高度估计实验中,组合导航能够很好的描述四轴飞行器的飞行高度估计;在平移速度估计实验中,卡尔曼滤波器估计的速度估计值很平滑;相对位置估计实验中,四轴飞行器的x方向位置保持在原点附近,y方向位置保持在-1.0 m附近,高度位置的最大误差在0.3 m之内。In order to improve the navigation accuracy of quadrotor in unstructured,indoor and GPS failure environments,this paper proposes an imaging,inertial and altitude integrated navigation for quadrotor.Firstly,the camera mounted on the quadrotor is calibrated,and the internal and external parameters of the camera are obtained.Secondly,we use the landing signs as standard reference objects and present a landing signs recognition scheme.Then,the Calman filter is used to fuse the data of the vision,inertial measurement system and ultrasonic range finder.And the relative height of the aircraft is estimated by the similar triangle theorem.The visual odometry is used to estimate the position and translation speed of the quadrotor.Finally,the effectiveness of the integrated navigation is verified.The experiment of the relative height estimation experiment,the translation speed and the relative position estimation are carried out successively with the imaging,inertial and altitude integrated navigation experimental platform.The experimental results show that combination navigation can accurately estimate the altitude of quadrotor in the relative height estimation experiment;In the translation velocity estimation experiment,the curve of velocity estimation by the Calman filter is smooth;In the relative position estimation experiment,the position of the X direction of the quadrotor is kept near the origin,the Y direction is kept near-1.0 m,and the maximum error of the altitude is within 0.3 m.

关 键 词：四轴飞行器 组合导航 视觉识别 卡尔曼滤波 

分 类 号：TP273[自动化与计算机技术—检测技术与自动化装置]