A Decision-support System for Automated Collision Avoidance of Ships with Variable Speed Based on Simulation of Maneuvering Process
-
摘要: 为了解决船舶部分场景中仅靠变向避让效果差的问题,研究了多物标环境下符合避碰规则的船舶可变速自动避碰决策方法。基于船舶会遇四阶段理论和船舶领域模型量化船舶碰撞危险度,通过可变速MMG模型和模糊自适应PID航向控制方法推演船舶定、变速改向操纵过程。在此基础上,改进了基于操纵过程推演和速度障碍理论的动态可行操纵区间求解算法。以实船为仿真目标,进行了不同操纵方案下的对比实验和多物标场景下的仿真实验。将程序运行步长设置为1 s,结果表明:①预设他船位置(4 n mile,4 n mile),航向270,航速12 kn,本船位置(0 n mile,0 n mile),航向000,航速12 kn的交叉相遇态势下,变向变速避让和仅变向避让采取操纵行动的最晚时间点分别为711 s和643 s;②在物标较远的多物标环境下,本船O保向保速至663 s,与目标船TA,TC,TD构成碰撞危险,采取目标航向、转速区间为[48°, 61°]、[75 r/min, 85 r/min] 中任意组合可让清所有物标。Abstract: A decision-making method for variable speed automatic collision avoidance of ships in a multi-objective environment meeting the International Regulations for Preventing Collisions at Sea is studied to solve the problem of the poor effect of collision avoidance only by altering the direction in some scenes of ships. The risk of ship collision is quantified based on the four-stage theory of ship encounters and the ship domain model. The variable-speed MMG model and fuzzy adaptive PID heading control method are used to derive the ships' steering process at fixed and variable speeds. On this basis, an algorithm is improved for solving the dynamic feasible maneuvering interval based on the deduction of the maneuvering process and the speed obstacle theory. Combined with the actual scenarios, comparative experiments under different maneuvering schemes, simulations, and multi-objective scenarios are carried out. The results show that: ① The program running step length is set to 1 s. Under the pre-set position of other ship (4 n mile, 4 n mile), heading 270, speed of 12 kn, ship position (0 n mile, 0 n mile), heading 000, speed of 12 kn, the latest time point for maneuvering action to alter directions and speeds for yielding is 711 s. The latest time point for manipulative actions to be taken only by altering directions for yielding is 643 s, and that to be taken is delayed by 68 s. ② In a multi-object environment with distant objects, ship O driving to 663 s and keeping the speed and direction, which poses a collision risk with target ship TA, TC and TD. At this time, any combination of target course interval [48°, 61°] and rotation rate interval [75 r/min, 85 r/min] can clear all targets.
-
表 1 船舶资料
Table 1. Particular of the ship
参数 数值 参数 数值 吃水/m 14.5 舵面积/m2 56.88 船长/m 225 水密度(/kg/m3) 1 025 船宽/m 32.5 额定转速(/r/min) 93 排水量/kg 90 000×103 螺旋桨进距/m 4.738 表 2 车钟转速表
Table 2. Tachometer of the propulsion
车令 转速(/r/min) 航速/kn 前进 海上速度 93 14 前进三 85 12 前进二 70 10.5 前进一 48 5 微速前进 35 3 后退 微速后退 35 3 后退一 48 5 后退二 70 10.5 后退三 85 12 表 3 碰撞危险形成限定条件
Table 3. Conditions for collision risk formation
局面 潜在碰撞危险 2船距离/n mile 时间/s 对遇局面 存在PCR 距离≤6 追越局面 存在PCR 距离≤3 交叉相遇局面 存在PCR 距离≤6 TCS < 1 200 表 4 对比实验参数
Table 4. Parameters in the contrast experiment
船舶类型 坐标/n mile 航向/° 航速/kn 初始转速(/r/min) 本船 (0,0) 0 12 85 目标船 (4,4) 270 12 85 表 5 仿真实验参数
Table 5. Parameters in the simulation experiment
目标类型 坐标/n mile,半径/m 航向(/°) 航速/kn TCS /s CRI k1 k2 k3 k1 k2 k3 目标船TA (3.5,8.8) 210 10 951 349 349 0 0.12 0 目标船TB (5.5,8.3) 173 12 0 0 0 0 0 0 目标船TC (-4.4,1.5) 60 13 1582 842 0 0 0.03 0 目标船TD (-2.9,6.8) 120 11 1136 537 767 0 0.06 0 圆形障碍物1 (-3,6),r = 200 1715 1115 278 0 0 0 圆形障碍物2 (4,3),r = 300 1014 414 976 0 0 0 -
[1] TAM C, BUCKNALL R. Path-planning algorithm for ships in close-range encounters[J]. Journal of Marine Science and Technology, 2010, 15(4): 395-407. doi: 10.1007/s00773-010-0094-x [2] 李丽娜, 陈国权, 李国定, 等. 船舶拟人智能避碰决策方法研究综述[J]. 航海, 2014(2): 42-49. doi: 10.3969/j.issn.1009-8526.2014.02.013LI Lina, CHEN Guoquan, LI Guoding, et al. Overview of research on intelligent collision avoidance decision-making method for ships[J]. Navigation, 2014(2): 42-49. doi: 10.3969/j.issn.1009-8526.2014.02.013 [3] WANG Ning, MENG Xianyao, XU Qingyang, et al. A unified analytical framework for ship domains[J]. Journal of Navigation 2009, 62 (4): 643-655. (in Chinese) doi: 10.1017/S0373463309990178 [4] WANG Ning. An intelligent spatial collision risk based on the quaternion ship domain[J]. Journal of Navigation, 2010, 63(4): 733-749. doi: 10.1017/S0373463310000202 [5] 刘冬冬, 史国友, 李伟峰, 等. 基于最短避碰距离和碰撞危险度的避碰决策支持[J]. 上海海事大学学报, 2018, 39(1): 13-18. https://www.cnki.com.cn/Article/CJFDTOTAL-SHHY201801004.htmLIU Dongdong, SHI Guoyou, LI Weifeng, et al. Decision support of collision avoidance based on shortest avoidance distance and collision risk[J]. Journal of Shanghai Maritime University, 2018, 39(1): 13-18. (in Chinese). https://www.cnki.com.cn/Article/CJFDTOTAL-SHHY201801004.htm [6] 吉大海, 杨溢, 戴捷, 等. 高速水面无人艇动态障碍物危险规避算法[J]. 应用科技, 2014, 41(3): 40-45. https://www.cnki.com.cn/Article/CJFDTOTAL-YYKJ201403009.htmJI Dahai, YANG Yi, DAI Jie, etal. Dynamic obstacle avoidance algorithm for high-speed unmaned surface vehicles[J]. Applied Science and Technology, 2014, 41(3): 40-45. (in Chinese). https://www.cnki.com.cn/Article/CJFDTOTAL-YYKJ201403009.htm [7] 张洋洋, 瞿栋, 柯俊, 等. 基于速度障碍法和动态窗口法的无人水面艇动态避障[J]. 上海大学学报(自然科学版), 2017, 23(1): 1-16. https://www.cnki.com.cn/Article/CJFDTOTAL-SDXZ201701002.htmZHANG Yangyang, QU Dong, KE Jun, et al. Dynamic obstacle avoidance for USV based on velocity obstacle and dynamic window method[J]. Journal of Shanghai University(Natural Science Edition), 2017, 23(1): 1-16. (in Chinese). https://www.cnki.com.cn/Article/CJFDTOTAL-SDXZ201701002.htm [8] 熊勇, 贺益雄, 黄立文. 基于速度障碍的多船自动避碰控制方法[J]. 中国航海, 2015, 38(3): 46-51. doi: 10.3969/j.issn.1000-4653.2015.03.011XIONG Yong, HE Yixiong, HUANG Liwen. Multi-ships collision avoiding control considering velocity obstacle[J]. Navigation of China, 2015, 38(3): 46-51. (in Chinese). doi: 10.3969/j.issn.1000-4653.2015.03.011 [9] 贺益雄, 黄立文, 牟军敏, 等. 交叉相遇局面让路船自动避碰行动方案[J]. 哈尔滨工程大学学报, 2015(8): 1024-1029. https://www.cnki.com.cn/Article/CJFDTOTAL-HEBG201508004.htmHE Yixiong, HUANG Liwen, MOU Junmin, et al. A scheme for automatic collision avoidance of a give-way vessel in the crossiong situation[J]. Journal of Harbin Engineering University, 2015(8): 1024-1029. (in Chinese). https://www.cnki.com.cn/Article/CJFDTOTAL-HEBG201508004.htm [10] 吴博, 熊勇, 文元桥. 基于速度障碍原理的无人艇自动避碰算法[J]. 大连海事大学学报, 2014, 40(2): 13-16. doi: 10.3969/j.issn.1006-7736.2014.02.004WU Bo, XIONG Yong, WEN Yuanquao. Automatic collision avoidance algorithm for unmaned surface vehicles based on velocity obstacle[J]. Journal of Dalian Maritime University, 2014, 40(2): 13-16. (in Chinese). doi: 10.3969/j.issn.1006-7736.2014.02.004 [11] 王仁强, 赵月林, 谢宝峰. 船舶动态转向避碰行动数学模型[J]. 大连海事大学学报, 2014, 40(1): 17-20. doi: 10.3969/j.issn.1006-7736.2014.01.005WANGRenqiang, ZHAO Yuelin, XIE Baofeng. Dynamic mathematical model for collision avoidance by ship steering[J]. Journal of Dalian Maritime University, 2014, 40(1): 17-20. (in Chinese). doi: 10.3969/j.issn.1006-7736.2014.01.005 [12] 贺益雄, 张晓寒, 胡惟璇, 等. 基于航向控制系统的船舶动态避碰机理研究[J]. 西南交通大学学报, 2020, 55(5): 988-993. doi: 10.3969/j.issn.1009-4474.2020.05.001HE Yixiong, ZHANG Xiaohan, HU Weixuan, et al. The research of ship dynamic collision machenism based on course control system[J]. Journal of Southwest Jiaotong University, 2020, 55(5): 1-7. (in Chinese). doi: 10.3969/j.issn.1009-4474.2020.05.001 [13] 郭晟江, 周琦. 船舶主机车令与转速对应关系探讨[J]. 船舶设计通讯, 2017(2): 65-68. doi: 10.3969/j.issn.1001-4624.2017.02.012GUO Shengjiang, ZHOU Qi. Discussion about the relationship between telegraph transmitter and main engine speed[J]. Journal of Ship Design, 2017(2): 65-68. (in Chinese). doi: 10.3969/j.issn.1001-4624.2017.02.012 [14] 钟建东. 碰撞危险、紧迫局面和紧迫危险剖析[J]. 上海海运学院学报, 1999(2): 78-82. https://www.cnki.com.cn/Article/CJFDTOTAL-SHHY902.012.htmZHONG Jiandong. Analysis of collision danger, urgent situation and urgent danger[J]. Journal of Shanghai Maritime University, 1999(2): 78-82. https://www.cnki.com.cn/Article/CJFDTOTAL-SHHY902.012.htm [15] 郑中义, 吴兆麟. 最晚施舵点模型及其应用[J]. 航海技术, 2001(2): 2-4. https://www.cnki.com.cn/Article/CJFDTOTAL-HHJS200102000.htmZHENG Zhongyi, WU Zhaolin. The latest rudder point model and its application[J]. Navigation Technology, 2001(2): 2-4. (in Chinese). https://www.cnki.com.cn/Article/CJFDTOTAL-HHJS200102000.htm [16] 郑中义. 船舶自动避碰决策系统的研究[D]. 大连: 大连海事大学, 2000.ZHENG Zhongyi. Research on automatic decision-making system of vessel collision avoidance[D]. Dalian: Dalian Maritime University, 2000. [17] FIORINI P, SHILLER Z. Motion planning in dynamic environments using velocity obstacles[J]. International Journal of Robotics Research, 1998, 17(7): 760-772. [18] 贺益雄. 规则量化解析下船舶自动避碰模型与仿真研究[D]. 武汉: 武汉理工大学, 2015.HE Yixiong. The research of models and simulations about ship autonomous collision avoidance constrained byquantified resolution of rules[D]. Wuhan: Wuhan University of Technology, 2015. (in Chinese). [19] HE Yixiong, JIN Yi, HUANG Liwen, et al. Quantitative analysis of COLREG rules and seamanship for autonomous collision avoidance atopensea[J]. Ocean Engineering, 2017, 140(1): 281-29.