基于扩展卡尔曼滤波的舰机相对位姿估测  

Visual 3D motion estimation of UAV and landing target based on extended Kalman filter

作　　者：王睿[1] 阎鹏[1] 刘红英[2] 张广军[1] 

机构地区：[1]北京航空航天大学仪器科学与光电工程学院,北京100083 [2]北京航空航天大学理学院,北京100083

出　　处：《北京航空航天大学学报》2006年第11期1349-1353,共5页Journal of Beijing University of Aeronautics and Astronautics

基　　金：航空基金资助项目(03I51009)

摘　　要：通过将基于扩展卡尔曼滤波的长序列图像分析方法与单目视觉技术相结合,把无人机自主着舰视觉导引中舰机间相对位姿的估测,转化为机载摄像机对着舰靶标平面3D位姿的实时估测问题.首先根据透视投影理论,建立了以摄像机的透镜中心为原点且Z轴与光轴重合的摄像机坐标系和世界坐标系,然后利用机载摄像机连续拍摄的靶标图像序列,选择描述相对运动的3个欧拉角、平移向量及它们的速度作为状态变量;由靶标角点的提取和帧间匹配,建立了反映着舰靶标上特征点的图像坐标和状态变量之间关系的观测方程,带入扩展卡尔曼滤波器,估测出舰机的相对运动参数.计算机数据仿真和基于DSP平台的半实物仿真试验验证了算法的有效性和鲁棒性.During the last phase of auto landing an UAV （unmanned aerial vehicle） on the ship, the estimation of the 3D relative motion parameters between UAV and the landing target can be regarded as the planar 3D motion estimation between the camera mounted on the UAV and the deck. An algorithm for visual motion estimation of 3D objects based on extended Kalman filter is presented. First, the camera coordinate with the origin at the camera＇s lens and the world coordinate are set up appealing to the principles of perspective projection. Then, the actual 3D camera motion parameters （the three Eulerian angles, transition vectors and their velocities） can be described in terms of the state equation. Furthermore, with the target comer extraction and frame matching, the observation equation is proposed to give the relationship of the feature points in the image and the state vectors. All the 3D relative motion parameters are solved by the stated EKF（ extended Kalman filter） method. The presented experimental results of both synthetic data and the real image sequences show that our algorithm is effectively and robust.

关 键 词：3D相对位姿估测 扩展KALMAN滤波器 图像序列 无人机 单目视觉导引 

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