Visual 3D motion estimation of UAV and landing target based on extended Kalman filter
-
摘要: 通过将基于扩展卡尔曼滤波的长序列图像分析方法与单目视觉技术相结合,把无人机自主着舰视觉导引中舰机间相对位姿的估测,转化为机载摄像机对着舰靶标平面3D位姿的实时估测问题.首先根据透视投影理论,建立了以摄像机的透镜中心为原点且Z轴与光轴重合的摄像机坐标系和世界坐标系,然后利用机载摄像机连续拍摄的靶标图像序列,选择描述相对运动的3个欧拉角、平移向量及它们的速度作为状态变量;由靶标角点的提取和帧间匹配,建立了反映着舰靶标上特征点的图像坐标和状态变量之间关系的观测方程,带入扩展卡尔曼滤波器,估测出舰机的相对运动参数.计算机数据仿真和基于DSP平台的半实物仿真试验验证了算法的有效性和鲁棒性.
-
关键词:
- 3D相对位姿估测 /
- 扩展Kalman滤波器 /
- 图像序列 /
- 无人机 /
- 单目视觉导引
Abstract: 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 corner 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. -
[1] Saripalli S, Montgomery J F, Sukhatme G S. Visually guided landing of an unmanned aerial vehicle[J]. IEEE Trans Robotics and Automation, 2003,19(2):371-380 [2] 邱力为,宋子善,沈为群. 无人直升机自主着舰的计算机视觉算法[J]. 北京航空航天大学学报,2003,29(2):99-102 Qiu Liwei, Song Zishan, Shen Weiqun. Examination of a computer vision system used for the automatic landing of unmanned helicopter on ship[J]. Journal of Beijing University of Aeronautics and Astronautics, 2003,29(2):99-102(in Chinese) [3] Wang Rui, Zhang Guangjun, Yan Peng. Optical flow based 3D motion estimation for autonomous landing an UAV on deck International Conference on Space Information Technology, Wuhan:Proc of SPIE, 2005:59854H-1~59854H-6 [4] Trajkovic M, Hedley M. Fast corner detection[J]. Image and Vision Computing, 1998,(16):75-87 [5] Lippiello V, Siciliano B, Villani L. Position and orientation estimation based on Kalman filter of stereo images Proceedings of the 2001 IEEE International Conference on Control Application. Mexico:,2001:702-707 [6] Kim J, Woods J W. 3-D Kalman filter for image motion estimation[J]. IEEE Trans Image Processing, 1998,7(1):42-52 [7] 付梦印,邓志红,张继伟.Kalman滤波理论及其在导航系统中的应用[M]. 北京:科学出版社,2003:8-85 Fu Mengyin, Deng Zhihong, Zhang Jiwei. The theory of Kalman filter and its application in navigation system[M].Beijing:Science Press, 2003:8-85(in Chinese)
点击查看大图
计量
- 文章访问数: 2907
- HTML全文浏览量: 144
- PDF下载量: 1161
- 被引次数: 0