主从式无人水面艇协同定位滤波方法与实验验证

doi:10.3969/j.issn.1000-1093.2014.11.015

兵工学报 ›› 2014, Vol. 35 ›› Issue (11): 1836-1845.doi: 10.3969/j.issn.1000-1093.2014.11.015

主从式无人水面艇协同定位滤波方法与实验验证

徐博¹，肖永平²，高伟¹，刘亚龙¹，杨建¹

(1.哈尔滨工程大学自动化学院，黑龙江哈尔滨 150001； 2.陕西航天导航设备有限公司，陕西宝鸡 721006）

收稿日期:2013-12-13 修回日期:2013-12-13 上线日期:2015-01-05
通讯作者: 徐博 E-mail:xubocarter@sina.com
作者简介:徐博（1982—），男，讲师
基金资助:
国家博士后基金项目（2012M510083）；国家自然科学基金项目（61203225）；黑龙江省自然科学基金项目(QC2014C069)

A Cooperative Navigation Approach and Its Verification of USVs with Leader-fellower Structure

XU Bo¹, XIAO Yong-ping², GAO Wei¹, LIU Ya-long¹, YANG Jian¹

(1.Automation Academy,Harbin Engineering University, Harbin 150001，Heilongjiang， China;2.Shaanxi Space Navigation Equipment Co.Ltd, Baoji 721006，Shaanxi，China)

Received:2013-12-13 Revised:2013-12-13 Online:2015-01-05
Contact: XU Bo E-mail:xubocarter@sina.com

摘要/Abstract

摘要： 多无人水面艇（USV）协同导航定位技术是解决复杂作业环境下导航问题的重要途径。针对单主艇的主从式多USV的协同导航定位问题，建立了协同定位的状态空间模型，然后将非线性模型绕滤波值展开，得到非线性系统的线性化模型；利用扩展卡尔曼滤波算法进行信息融合；针对双艇间的距离、角度与协同定位精度的关系展开研究，对协同导航滤波算法使用李代数法进行了可观测性分析。研究表明，控制相邻两时刻主从艇之间距离和角度变化量是提高协同定位精度的有效措施。通过仿真和实验验证，为下一步深入研究和路径规划奠定了基础。

关键词: 控制科学与技术, 无人水面艇, 测距, 协同定位, 扩展卡尔曼滤波

Abstract: The cooperative navigation and localization technology of multi-USVs is an important way to solve the navigation problem in complex environment. For the cooperative navigation and localization of multi-USVs with leader-follower structure, a state space model of cooperative localization is built, and then a linear model is obtained by expanding the nonlinear model around filter value. An extended Kalman filter is designed to fuse the sensor information to locate the slave USV in real time. At last, the relationship among USV distances, angle and accuracy is researched, and the observability analysis of cooperative navigation filter algorithm is done with Lie algebra. The results show that the navigation accuracy is improved effectively by controlling the variations of distances and angles of leader and slave USVs between two adjacent moments, which is verified by simulation and experiment.

Key words: control science and technology, unmanned surface vessel, ranging, cooperative localization, extended Kalman filter

中图分类号:

U666

徐博，肖永平，高伟，刘亚龙，杨建. 主从式无人水面艇协同定位滤波方法与实验验证[J]. 兵工学报, 2014, 35(11): 1836-1845.

XU Bo, XIAO Yong-ping, GAO Wei, LIU Ya-long, YANG Jian. A Cooperative Navigation Approach and Its Verification of USVs with Leader-fellower Structure[J]. Acta Armamentarii, 2014, 35(11): 1836-1845.

参考文献

［1］ Kurazume R, Nagata S, Hirose S. Cooperative positioning with multiple robots［C］∥International Conference on Robotics and Automation. Los Alamitos,California：IEEE,1994: 1250-1257.
［2］ Win M Z, Conti A, Mazuelas S, et al. Network localization and navigation via cooperation［J］.IEEE Communication Magazine, 2011, 49(5): 56-62 .
［3］ Hidaka Y S, Mourikis A I, Roumeliotis S I. Optimal formations for cooperative localization of mobile robots［C］∥IEEE International Conference on Robotics and Automation (ICRA).Barcelona，Spain：IEEE，2005：4126-4131.
［4］ Bahr A,Walter M,Leonard J.Consistent cooperative localization［C］∥IEEE International Conference on Robotics and Automation.Kobe, Japan: IEEE，2009.
［5］ Engel R, Kalwa J.Coordinated navigation of multiple underwater vehicles［C］ ∥17th International Offshore and Polar Engineering Conference. Bremen, Germany:IEEE，2007:1066-1072.
［6］ Nicosia J. Decentralized cooperative navigation for spacecraft［C］∥2007 IEEE Aerospace Conference.Big Sky, MT:IEEE， 2007:1-6.
［7］ Willcox S,Goldberg D, Vaganay J, et al. Multi-vehicle cooperativenavigation and autonomy with the bluefin CADRE system［C］∥Proceedings of International Federation of Automatic Control Conference. Oxford,UK: Pergamon Press, 2006: 1-6.
［8］ Curcio J, Leonard J, Vaganay J, et al. Experiments in moving baseline navigation using autonomous surface craft［C］∥Proceedings of MTS/IEEE OCEANS. Washington, DC: IEEE, 2005: 730-735.
［9］ Baccou P, Jouvencel B, Creuze V, et al. Cooperative positioning and navigation for multiple AUV operations［C］∥MTS/IEEE Oceans 2001 Conference Proceedings.Honolulu, HI: IEEE, 2001: 1816-1821.
［10］ Singh S, Grund M, Bingham B, et al. Underwater acoustic navigation with the WHOI micro-modem［C］∥Proceedings of the IEEE/MTS OCEANS Conference and Exhibition. Boston, MA:IEEE,2006：1-4.
［11］ Bahr A.Cooperative localization for autonomous underwater vehicles［R］. Cambridge,MA,US: Massachusetts Institute of Technology, 2009.
［12］张立川,刘明雍,徐德民,等. 基于水声传播延迟的主从式多无人水下航行器协同导航定位研究［J］. 兵工学报,2009,30(12): 1674-1678.
ZHANG Li-chuan,LIU Ming-yong,XU De-min,et al. Cooperative localization for multi-UVS based on time-of-flight of acoustic signal［J］.Acta Armamentarii, 2009,30(12):1674-1678.（in Chinese）
［13］ Zhang L C, Xu D M, Liu M Y, et al. Cooperative navigation and location for multiple UUVs［J］.Journal of Marine Science and Application, 2009,8(3):216-221.
［14］张立川,徐德民,刘明雍. 无人水下航行器网络控制器设计［J］. 船舶工程,2010,32(5):30-32.
ZHANG Li-chuan, XU De-min,LIU Ming-yong.Design of networked controller for unmanned underwater vehicle［J］.Ship Engineering,2010,32(5): 30-32.（in Chinese）
［15］姚尧,徐德民,张立川,等.通信延迟下的多UUV协同定位——基于航迹预测的实时更新算法［J］. 机器人,2011,33(1): 161-168.
YAO Yao,XU De-min,ZHANG Li-chuan,et al. Cooperative localization of multiple UUVs with communication delays-a real-time update method based on path predication［J］.Robot,2011,33(1): 161-168.（in Chinese）
［16］李闻白,刘明雍,李虎雄,等. 基于单领航者相对位置测量的多AUV协同导航系统定位性能分析［J］. 自动化学报,2011,37(6):724-736.
LI Wen-bai, LIU Ming-yong,LI Hu-xiong,et al. Localization performance analysis of cooperative navigation system for multiple AUVS based on relative position measurements with a single leader［J］.Acta Automatic Sinica,2011,37(6): 724-736.（in Chinese）
［17］张立川,徐德民,刘明雍. 基于双水听器的多自主水下航行器协同导航方法［J］. 系统工程与电子技术,2011,33(7):1603-1606.
ZHANG Li-chuan,XU De-min,LIU Ming-yong. Cooperative navigation for multiple autonomous underwater vehicle based on two hydrophones［J］. Systems Engineering and Electronics,2011，33(7): 1603-1606.（in Chinese）
［18］王玲,刘云辉,万建伟,等.基于相对方位的多机器人合作定位算法［J］.传感技术学报,2007,20(4):794-799.
WANG Ling,LIU Yun-hui,WAN Jian-wei,et al. Multi-robot cooperative localization based on relative bearing［J］.Chinese Journal of Sensors and Actuators,2007,20(4): 794-799.（in Chinese）
［19］王玲.未知环境中基于相对观测量的多机器人合作定位研究［D］. 长沙:国防科学技术大学,2006.
WANG Ling.Research on multi-robot cooperative localization based on relative observation in unknown environment［D］. Changsha: National University of Defense Technology,2006.（in Chinese）
［20］高伟，刘亚龙，徐博，等.基于双主交替领航的多AUV协同导航方法［J］. 哈尔滨工程大学学报，2014,35（3）：1-6.
GAO Wei，LIU Ya-long，XU Bo，et al. AUVs cooperative navigation based on two leaders alternately［J］.Journal of Harbin Engineering University, 2014,35（3）：1-6.（in Chinese）

[1]	郑荣，辛传龙，汤钟，宋涛. 无人水面艇自主部署自主水下机器人平台技术综述[J]. 兵工学报, 2020, 41(8): 1675-1687.
[2]	赵建博，杨树兴，熊芬芬. 基于领弹-从弹架构的无导引头导弹协同定位与制导方法[J]. 兵工学报, 2019, 40(4): 673-679.
[3]	徐博，李盛新，金坤明，王连钊. 基于径向基函数神经网络辅助容积卡尔曼滤波的多自主水下航行器协同定位方法[J]. 兵工学报, 2019, 40(10): 2119-2128.
[4]	苗建明，王少萍，范磊，李元. 欠驱动自主水下航行器空间曲线路径跟踪控制研究[J]. 兵工学报, 2017, 38(9): 1786-1796.
[5]	查峰，覃方君，李京书，叶斌. 三轴旋转惯性导航系统的旋转控制建模研究[J]. 兵工学报, 2017, 38(8): 1610-1618.
[6]	伍明，张国良，李琳琳，付光远，李承剑. 基于动态和静态环境对象观测一致性约束的移动机器人多传感器标定优化方法[J]. 兵工学报, 2017, 38(8): 1630-1641.
[7]	王世峰，都凯悦，孟颖，王锐. 基于机器学习的车辆路面类型识别技术研究[J]. 兵工学报, 2017, 38(8): 1642-1648.
[8]	周荻，董金鲁. 带襟翼的飞行器非线性控制系统分析和设计[J]. 兵工学报, 2017, 38(7): 1322-1329.
[9]	郑睿，赵伟，方明星，杜友武. 基于多圈环绕结构的超流体陀螺噪声抑制方法[J]. 兵工学报, 2017, 38(7): 1330-1335.
[10]	邢丽, 熊智, 刘建业, 杭义军. 基于对偶四元数的圆锥及划船误差补偿改进算法[J]. 兵工学报, 2017, 38(7): 1336-1347.
[11]	庞辉, 陈嘉楠, 刘凯. 汽车磁流变半主动悬架系统自适应反推跟踪控制[J]. 兵工学报, 2017, 38(7): 1430-1442.
[12]	马艳彤，郑荣，韩晓军. 面向海底光学探测使命的自治水下机器人水平路径跟随控制[J]. 兵工学报, 2017, 38(6): 1147-1153.
[13]	陈慧岩，陈舒平，龚建伟. 智能汽车横向控制方法研究综述[J]. 兵工学报, 2017, 38(6): 1203-1214.
[14]	廖自力，阳贵兵，高强，袁东. 多轮独立电驱动车辆转向稳定性集成控制研究[J]. 兵工学报, 2017, 38(5): 833-842.
[15]	王斌锐，沈国阳，金英连，王凌. 基于干扰观测器的级联气动肌肉肘关节滑模控制[J]. 兵工学报, 2017, 38(4): 793-801.

主从式无人水面艇协同定位滤波方法与实验验证

A Cooperative Navigation Approach and Its Verification of USVs with Leader-fellower Structure

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价