收稿日期: 2023-04-03
修回日期: 2023-05-29
录用日期: 2023-07-03
网络出版日期: 2023-07-17
基金资助
水动力学国家重点实验室开放基金(6142203210205);中央高校基本科研业务费专项资金(AF0100142/005/002);航运技术与安全国家重点实验室、交通行业重点实验室开放课题基金(W22CG000114)
Ship Path Following and Collision Avoidance Based on Vector Field Guidance Law and Model Predictive Control
Received date: 2023-04-03
Revised date: 2023-05-29
Accepted date: 2023-07-03
Online published: 2023-07-17
为提高船舶路径跟踪和避碰效果,提出了一种基于矢量场制导法的模型预测控制方法.首先,采用矢量场制导算法将船舶的路径跟踪和船舶避碰问题转换为航向控制问题;然后,采用一阶 Nomoto 响应模型作为模型预测控制的动力学模型,考虑船舶的舵角输入受限问题,引入干扰观测器对模型误差项和环境扰动进行补偿,并应用Lyapunov理论证明了所设计的路径跟踪控制系统的稳定性;最后,设计了基于矢量场制导法的避碰策略,使船舶在路径跟踪的过程中同时完成自主避碰.仿真计算结果表明,开发的方法可以使船舶在波浪干扰作用下准确地跟踪目标路径并有效实现避碰.
何宇 , 欧阳子路 , 邹璐 , 陈伟民 , 邹早建 . 基于矢量场制导法和模型预测控制的船舶路径跟踪与避碰[J]. 上海交通大学学报, 2024 , 58(11) : 1644 -1653 . DOI: 10.16183/j.cnki.jsjtu.2023.121
A model predictive control (MPC) method based on the vector field guidance law is proposed to improve the effectiveness of path following and collision avoidance for ships. First, the path following and collision-avoidance problems are transformed into heading-control problems by the vector field guidance law. Then, the first-order Nomoto response model is adopted as the ship dynamic model for the model predictive control. Considering the input limitation of the rudder angle, the disturbance observer is introduced to compensate the model error and the environmental disturbances. The stability of the designed path following control system is verified by the Lyapunov theory. Finally, a collision avoidance strategy based on the vector field guidance law is designed to enable the ship to avoid collision autonomously in the process of path following. The simulation results indicate that the proposed methods can make the ship track the target path accurately and realize collision avoidance under the impacts of wave disturbances.
[1] | MOREIRA L, FOSSEN T I, GUEDES SOARES C. Path following control system for a tanker ship model[J]. Ocean Engineering, 2007, 34(14): 2074-2085. |
[2] | BORHAUG E, PAVLOV A, PETTERSEN K Y. Integral LOS control for path following of underactuated marine surface vessels in the presence of constant ocean currents[C]//IEEE Conference on Decision and Control. Cancun, Mexico: IEEE, 2008: 4984-4991. |
[3] | FOSSEN T I, PETTERSEN K Y, GALEAZZI R. Line-of-sight path following for Dubins paths with adaptive sideslip compensation of drift forces[J]. IEEE Transactions on Control Systems Technology, 2015, 23(2): 820-827. |
[4] | NIE J, LIN X. Improved adaptive integral line-of-sight guidance law and adaptive fuzzy path following control for underactuated MSV[J]. ISA Transactions, 2019, 94: 151-163. |
[5] | NELSON D R, BARBER D B, MCLAIN T W, et al. Vector field path following for small unmanned air vehicles[C] //2006 American Control Conference. Minneapolis, USA: IEEE, 2006: 7. |
[6] | NELSON D R, BARBER D B, MCLAIN T W, et al. Vector field path following for miniature air vehicles[J]. IEEE Transactions on Robotics, 2017, 23(3): 519-529. |
[7] | XU H T, FOSSEN T I, GUEDES SOARES C. Uniformly semiglobally exponential stability of vector field guidance law and autopilot for path-following[J]. European Journal of Control, 2020, 53: 88-97. |
[8] | XU H T, HINOSTROZA M A, GUEDES SOARES C. Modified vector field path-following control system for an underactuated autonomous surface ship model in the presence of static obstacles[J]. Journal of Marine Science and Engineering, 2021, 9(6): 652. |
[9] | SMIERZCHALSKI R. Evolutionary trajectory planning of ships in navigation traffic areas[J]. Journal Marine Science and Technology, 1999, 4(1): 1-6. |
[10] | 周凤杰. 船舶避碰的粒子群-遗传(PSO-GA)的混合优化算法研究[J]. 船舶力学, 2021, 25(7): 909-916. |
ZHOU Fengjie. Research on hybrid optimization algorithm of particle swarm-genetic (PSO-GA) for ship collision avoidance[J]. Journal of Ship Mechanics, 2021, 25(7): 909-916. | |
[11] | ABDELAAL M, FRANZLR M, HAHN A. Nonlinear model predictive control for trajectory tracking and collision avoidance of underactuated vessels with disturbances[J]. Ocean Engineering, 2018, 160: 168-180. |
[12] | LIU Z L, SONG S M, YUAN S Z, et al. ALOS-based USV path-following control with obstacle avoidance strategy[J]. Journal of Marine Science and Engineering, 2022, 10(9): 1203. |
[13] | 陆潇杨, 刘志全, 高迪驹, 等. 带漂角和输入饱和的水面船舶航向控制[J]. 中国舰船研究, 2021, 16(2): 194-202. |
LU Xiaoyang, LIU Zhiquan, GAO Diju, et al. Surface ship heading control with sideslip angle and input saturation[J]. Chinese Journal of Ship Research, 2021, 16(2): 194-202. | |
[14] | QIU B, WANG G, FAN Y, et al. Adaptive sliding mode trajectory tracking control for unmanned surface vehicle with modeling uncertainties and input saturation[J]. Applied Sciences, 2019, 9(6): 1240. |
[15] | 柳晨光, 初秀民, 王乐, 等. 欠驱动水面船舶的轨迹跟踪模型预测控制器[J]. 上海交通大学学报, 2015, 49(12): 1842-1854. |
LIU Chenguang, CHU Xiumin, WANG Le, et al. Trajectory tracking controller for underactuated surface vessels based on model predictive control[J]. Journal of Shanghai Jiao Tong University, 2015, 49(12): 1842-1854. | |
[16] | WANG L, LI S J, LIU J L, et al. Data-driven model identification and predictive control for path-following of underactuated ships with unknown dynamics[J]. International Journal of Naval Architecture and Ocean Engineering, 2022, 14: 100445. |
[17] | ZHANG H G, ZHANG X K, BU R X. Active disturbance rejection control of ship course keeping based on nonlinear feedback and ZOH component[J]. Ocean Engineering, 2021, 233: 109136. |
[18] | YANG H L, DENG F, HE Y, et al. Robust nonlinear model predictive control for reference tracking of dynamic positioning ships based on nonlinear disturbance observer[J]. Ocean Engineering, 2020, 215: 107885. |
[19] | 贺宏伟, 邹早建, 曾智华. 欠驱动水面船舶的自适应神经网络-滑模路径跟随控制[J]. 上海交通大学学报, 2020, 54(9): 890-897. |
HE Hongwei, ZOU Zaojian, ZENG Zhihua. Adaptive NN-SM control for path following of underactuated surface vessel[J]. Journal of Shanghai Jiao Tong University, 2020, 54(9): 890-897. | |
[20] | DU J, HU X, KRSTI? M, et al. Robust dynamic positioning of ships with disturbances under input saturation[J]. Automatica, 2016, 73: 207-214. |
[21] | MAYNE D Q, RAWLINGS J B, RAO C V, et al. Constrained model predictive control: Stability and optimality[J]. Automatica, 2000, 36(6): 789-814. |
[22] | ZENG Z H, ZOU Z J, WANG Z H, et al. Path following of underactuated marine vehicles based on model predictive control[J]. International Journal of Offshore and Polar Engineering, 2020, 30(4): 463-470. |
[23] | LI Z X, LI R H, BU R X. Path following of under-actuated ships based on model predictive control with state observer[J]. Journal of Marine Science and Technology, 2021, 26(2): 408-418. |
[24] | FOSSEN T I. Handbook of marine craft hydrodynamics and motion control[M]. New York, USA: John Wiley & Sons, 2011. |
[25] | NMRI. Tokyo 2015: A workshop on CFD in ship hydrodynamics[DB/OL]. (2015-12-02)[2023-04-02]. https://t2015.nmri.go.jp/onrt_gc.html. |
[26] | GUO H P, ZOU Z J. System-based investigation on 4-DOF ship maneuvering with hydrodynamic derivatives determined by RANS simulation of captive model tests[J]. Applied Ocean Research, 2017, 68: 11-25. |
/
〈 |
|
〉 |