论文:2012,Vol:30,Issue(4):547-552
引用本文:
房新鹏, 严卫生, 李俊兵. 基于距离量测的主从式 AUV 协同定位系统观测性研究[J]. 西北工业大学
Fang Xinpeng, Yan Weisheng, Li Junbing. An Effective Observability Analysis for the Leader-Follower Autonomous Underwater Vehicles(AUVs) Cooperative Localization Based on Range Measurements[J]. Northwestern polytechnical university

基于距离量测的主从式 AUV 协同定位系统观测性研究
房新鹏, 严卫生, 李俊兵
西北工业大学 航海学院,陕西 西安 710072
摘要:
研究了基于距离量测的主从式自主水下航行器(AUV)协同定位系统观测性问题。主 AUV 可以利用装备的高精度导航设备进行精确定位, 从 AUV 装备低精度导航设备, 需融合主从 AUV 之间的距离量测进行水下定位。针对控制输入对协同定位系统可观测性的影响, 建立了从 AUV 在主 AUV体坐标系中的运动学模型, 并选取主从 AUV 间的距离值作为观测量, 利用基于 Lie 导数的非线性系统观测性秩判据分析了不同控制输入下协同定位系统的观测性。仿真结果表明, 对于可观测的协同定位系统, 从 AUV 的位置估计具有良好的收敛性和定位精度。
关键词:    自主水下航行器    协同定位    控制输入    观测性分析   
An Effective Observability Analysis for the Leader-Follower Autonomous Underwater Vehicles(AUVs) Cooperative Localization Based on Range Measurements
Fang Xinpeng, Yan Weisheng, Li Junbing
College of Marine Engineering, Northwestern Polytechnical University,Xi'an 710072, China
Abstract:
Sections 1 through 3 of the full paper explain our observability analysis mentioned in the titile,which webelieve is effective and whose core consists of: (1) in the leader-follower structure,the leader can use high preci-sion navigation system for precise localization but the follower is equipped with only low precision navigation sys-tem; thus,the followers need to combine the range measurements to the leader for underwater localization; (2) ai-ming at finding the influence of control inputs on the observability properties,we develop a kinematics model of thefollowers in the leader' s body coordinate system; considering the range measurements as the observation,we per-form an observability analysis for the cooperative localization with different control inputs with nonlinear observabili-ty rank condition based on Lie derivatives. Simulation results,presented in Figs. 2 through 4,and their analysisshow preliminarily that,for the observable system,the position estimation of each follower has a good convergenceand positioning accuracy.
Key words:    autonomous underwater vehicles    convergence of numerical methods    efficency    estimation    extendedKalman filters    kinematics    mathematical models    measurements    nonlinear control systems    observ-ability;analysis    control inputs    cooperative localization    simulation   
收稿日期: 2011-10-12     修回日期:
DOI:
基金项目: 国家自然科学基金(60875071)及教育部博士学科点基金(200806990008)资助
通讯作者:     Email:
作者简介: 房新鹏(1987-),西北工业大学博士研究生,主要从事多自主水下航行器协同导航定位研究。
相关功能
PDF(488KB) Free
打印本文
把本文推荐给朋友
作者相关文章
房新鹏  在本刊中的所有文章
严卫生  在本刊中的所有文章
李俊兵  在本刊中的所有文章

参考文献:
[1] Desa E, Maurya P, Pereira A, et al. A Small Autonomous Surface Vehicle for Ocean Color Remote Sensing. IEEE Journal of O-ceanic Engineering, 2007, 32 (2): 353-364
[2] Marani G,Choi S,Yuh J. Underwater Autonomous Manipulation for Intervention Missions AUVs. Ocean Engineering,2009,36 (1): 15-23
[3] Jun B, Park J, Lee F, et al. Development of the AUV‘ISiMI'and a Free Running Test in an Ocean Engineering Basin. OceanEngineering, 2009, 36 (1): 2-14
[4] Fiorelli E,Leonard N,Bhatta P,et al. Multi-AUV Control and Adaptive Sampling in Monterey Bay. IEEE Journal of OceanicEngineering, 2006, 31 (4): 935-948
[5] Cui R X,Ge S,How B,et al. Leader-Follower Formation Control of Underactuated Autonomous Underwater Vehicles. OceanEngineering, 2010, 37(17-18): 1491-1502
[6] Bahr A,Leonard J,Fallon M. Cooperative Localization for Autonomous Underwater Vehicles. The International Journal of Ro-botics Research, 2009, 28 (6): 714-728
[7] 张立川,徐德民,刘明雍等. 基于移动长基线的多 AUV 协同导航. 机器人, 2009, 31(6): 581-585, 593Zhang L C,Xu D M,Liu M Y,et al. Cooperative Navigation of Multiple AUVs Using Moving Long Baseline. Robot, 2009, 31(6): 581-585, 593 (in Chinese)
[8] Olson E,Leonard J,Teller S. Robust Range-Only Beacon Localization. IEEE Journal of Oceanic Engineering, 2006, 31(4):949-958
[9] Lee P,Jun B,Kim K,et al. Simulation of an Inertial Acoustic Navigation System with Range Aiding for an Autonomous Under-water Vehicle. IEEE Journal of Oceanic Engineering, 2007, 32(2): 327-345
[10]McPhail S,Pebody M. Range-Only Positioning of a Deep-Diving Autonomous Underwater Vehicle from a Surface Ship. IEEEJournal of Oceanic Engineering, 2009, 34(4): 669-677
[11]李闻白,刘明雍,张立川等. 单领航者相对位移测量的多自主水下航行器协同导航. 兵工学报,2011,32(8):1002-1007Li W B,Liu M Y,Zhang L C,et al. Cooperative Navigation for Multiple Autonamous Underwater Vehicles Based on RelativeDisplacement Measurement with a Single Leader. Acta Armamentarii, 2011, 32(8): 1002-1007 (in Chinese)
[12]Isidori A. Nonlinear Control Systems. Third edition. Berlin: Springer-Verlag, 1995
[13]Gadre A,Stiwell D. Underwater Navigation in the Presence of Unknown Currents Based on Range Measurements from a SingleBeacon. Proceedings of 2005 American Control Conference,Portland, 2005, 18(5): 656-661
[14]刘明雍,李闻白,刘富樯等. 基于单信标测距的水下导航系统可观测性分析. 西北工业大学学报, 2011, 29(1): 87-92Liu M Y,Li W B,Liu F Q,et al. Observability Analysis for Underwater Navigation System Based on Range Measurements witha Single Beacon. Journal of Northwestern Polytechnical University, 2011, 29(1): 87-92 (in Chinese)
[15]Zhou X, Roumeliotis S. Robot-to-Robot Relative Pose Estimation from Range Measurements. IEEE Trans on Robotics, 2008, 24(6): 1379-1393
[16]Antonelli G,Arrichiello F,Chiaverini S,et al. Observability Analysis of Relative Localization for AUVs Based on Ranging andDepth Measurements. Proceedings of 2010 IEEE International Conference on Robotics and Automation,Alaska,2010,4874-4879
[17]Papadopoulos G,Fallon M,Leonard J,et al. Cooperative Localization of Marine Vehicles Using Nonlinear State Estimation.Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems,Taipei, 2010, 4874~4879