基于航向约束的无人艇位姿保持制导策略

doi:10.16183/j.cnki.jsjtu.2020.148

上海交通大学学报 ›› 2020, Vol. 54 ›› Issue (9): 987-993.doi: 10.16183/j.cnki.jsjtu.2020.148

• 制导、导航与控制专栏 • 上一篇下一篇

基于航向约束的无人艇位姿保持制导策略

李朋博¹^,²^,³, 苑明哲¹^,²(), 肖金超¹^,², 熊俊峰¹^,²

1.中国科学院沈阳自动化研究所, 沈阳 110016
2.广州中国科学院沈阳自动化研究所分所,广州 511458
3.中国科学院大学, 北京 100049

收稿日期:2020-05-25 出版日期:2020-09-28 发布日期:2020-10-10
通讯作者: 苑明哲 E-mail:mzyuan@sia.cn
作者简介:李朋博(1994-),男,河南省郑州市人,硕士生,研究方向为无人艇运动控制
基金资助:
广东省基础与应用基础研究基金项目(2020A1515010584);中国博士后科学基金项目(2020M672599)

Station Keeping Guidance Strategy Based on Course Constraint for Unmanned Surface Vehicles

LI Pengbo¹^,²^,³, YUAN Mingzhe¹^,²(), XIAO Jinchao¹^,², XIONG Junfeng¹^,²

1. Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China
2. Shenyang Institute of Automation, Guangzhou, Chinese Academy of Sciences, Guangzhou 511458, China
3. University of Chinese Academy of Sciences, Beijing 100049, China

Received:2020-05-25 Online:2020-09-28 Published:2020-10-10
Contact: YUAN Mingzhe E-mail:mzyuan@sia.cn

摘要/Abstract

摘要：

针对欠驱动无人艇位姿保持控制中无法同时兼顾位置和首向角约束的问题,提出了基于航向约束的位姿保持制导策略.首先建立了以无人艇期望位姿为原点的固定坐标系,并将坐标系划分为3个区域:可到达区域A、B和不可到达区域C.在可到达区域内无人艇可依靠前向运动和转首运动回到期望位姿,避免因无法直接产生侧向运动导致首向角变化过大的问题.其次在不同的区域执行不同的制导策略,在制导过程中严格约束无人艇期望航向.最后由制导策略生成的期望速度和期望航向,经由控制器生成执行量,无人艇快速回到期望位姿.基于航向约束的位姿保持制导策略将航向约束由内环控制纳入外环制导,无人艇在不同区域执行不同的制导策略,生成的位姿期望与内环控制相结合,实现了无人艇的位姿保持.外环制导和内环控制约束相结合以兼顾无人艇欠驱动特性,同时简化了控制器设计.仿真实验证明了该制导策略的可行性和有效性.

关键词: 位姿保持, 无人艇, 制导策略

Abstract:

Aimed at the problem that the position and heading angle constrains of under-actuated unmanned surface vehicle (USV) cannot be taken into account at the same time in the position and attitude maintenance control, a strategy based on course constrains for the station keeping control of USV is proposed. First, a new fixed coordinate system based on the desired position and heading of USV is established. The coordinate system is divided into the reachable regions A and B, and unreachable region C. When the USV is in reachable region, it can return to the desired position and heading while it is able to avoid exceeding the desired heading angle range due to the inability to produce a lateral motion. Then different guidance strategies in different regions are used, which strictly restrict the course angle of the USV during the guidance process. Finally, the desired velocity and course angle are generated by the guidance strategy. The controller generates the execution and the USV quickly returns to the desired position and heading. The guidance strategy based on the course constraint incorporates the course constraint from the inner control into the outer guidance. As the USV implements different strategies in different regions, the desired position and heading and the inner loop control realize the station keeping of the USV. The outer loop guidance and inner loop control constraints are combined to take into account the under-actuated characteristics of the USV, which also simplifies the complexity of the controller design. The simulation experiments have proved the feasibility and effectiveness of the guidance strategy.

Key words: station keeping, unmanned surface vehicle (USV), guidance strategy

中图分类号:

TP273

李朋博, 苑明哲, 肖金超, 熊俊峰. 基于航向约束的无人艇位姿保持制导策略[J]. 上海交通大学学报, 2020, 54(9): 987-993.

LI Pengbo, YUAN Mingzhe, XIAO Jinchao, XIONG Junfeng. Station Keeping Guidance Strategy Based on Course Constraint for Unmanned Surface Vehicles[J]. Journal of Shanghai Jiaotong University, 2020, 54(9): 987-993.

图/表 12

图1

图2

图3

图4

图5

图6

表1

表2

图7

表3

图8

表4

参考文献 10

[1]	FOSSEN T I. Handbook of marine craft hydrodynamics and motion control[M]. Chichester, UK: John Wiley & Sons, 2011.
[2]	QU H, SARDA E I, BERTASKA I R, et al. Wind feed-forward control of a USV [C]//OCEANS 2015: Genova. Genoa, Italy: IEEE, 2015: 1-10.
[3]	QU H, VON ELLENRIEDER K D, Adaptive wind feedforward control of an Unmanned Surface Vehicle for station keeping [C]//OCEANS 2015: MTS/IEEE Washington. Washington, DC, USA: IEEE, 2015: 1-10.
[4]	SAKIYAMA J, MOTOI N. Position and attitude control method using disturbance observer for station keeping in underwater vehicle [C]//IECON 2018: 44th Annual Conference of the IEEE Industrial Electronics Society. Washington, DC, USA: IEEE, 2018: 5469-5474.
[5]	KNUDSEN K B, NIELSEN M C, SCHJ?LBERG I. Deep learning for station keeping of AUVs [C]//OCEANS 2019 MTS/IEEE, Seattle. Seattle, WA, USA: IEEE, 2019: 1-6.
[6]	CHEN E, HUANG S, LIN Y, et al. Station keeping of an autonomous surface vehicle in surf zone [C]//2013 MTS/IEEE OCEANS: Bergen. Bergen, Norway: IEEE, 2013: 1-6.
[7]	BERTASKA I R, VON ELLENRIEDER K D. Supervisory switching control of an unmanned surface vehicle [C]//OCEANS 2015: MTS/IEEE Washington. Washington, DC, USA: IEEE, 2015: 1-10.
[8]	BERTASKA I R, ELLENRIEDER K D. Experimental evaluation of supervisory switching control for unmanned surface vehicles[J]. IEEE Journal of Oceanic Engineering, 2019,44(1):7-28.
[9]	SONNENBURG C R, WOOLSEY C A. Modeling, identification, and control of an unmanned surface vehicle[J]. Journal of Field Robotics, 2013,30(3):371-398.
[10]	HAN J D, XIONG J F, HE Y Q, et al. Nonlinear modeling for a water-jet propulsion USV: An experimental study[J]. IEEE Transactions on Industrial Electronics, 2017,64(4):3348-3358.

参数	取值
a	-0.005
b	0.004
T_r	23.1280
K_r	0.5149
T_β	43.5650
K_β	-1.0755

参数	取值
航向角PID	P=30,I=0,D=15
前向速度PID	P=200,I=0,D=0
航向角扰动n₁(t)/[(°)·s^-1]	4sin(π²t)
纵荡速度扰动n₂(t)/(m·s^-1)	3sin(π²t)
横漂速度扰动n₃(t)/(m·s^-1)	0.5sin(π²t)

条件/m	位置平均误差/m	位置标准差/m	首向角平均误差/(°)	首向角标准误差/(°)
R_e=0,d_e=0	1.02	0.62	14.12	8.74
R_e=0,d_e=0.3	0.86	0.59	14.30	8.99
R_e=0.1,d_e=0.1	0.91	0.56	13.29	8.54
R_e=0.1,d_e=0.3	0.72	0.48	11.44	8.34
R_e=0.4,d_e=0.1	0.61	0.67	14.82	13.41

分组	控制策略	位置平均误差/m	位置标准差/m	首向角平均误差/(°)	首向角标准差/(°)
1	本文策略	0.95	0.54	13.43	8.95
	PD控制	0.54	0.31	30.79	26.09
2	本文策略	1.08	0.89	14.24	11.03
	PD控制	0.56	0.47	41.93	31.75
3	本文策略	1.06	0.41	15.32	10.17
	PD控制	0.59	0.32	44.41	34.79

基于航向约束的无人艇位姿保持制导策略

Station Keeping Guidance Strategy Based on Course Constraint for Unmanned Surface Vehicles

RichHTML

PDF (PC)

可视化

摘要/Abstract

引用本文

使用本文

图/表 12

参考文献 10

相关文章 3

编辑推荐

Metrics

本文评价

[1]	刘杰, 孙全, 贾军. 无人艇防空装备设想及作战模式初探[J]. 空天防御, 2018, 1(2): 7-13.
[2]	王健a，刘旌扬a, b，魏成柱a，易宏a, b. 新概念无人穿梭艇静水操纵性能[J]. 上海交通大学学报（自然版）, 2017, 51(3): 288-.
[3]	孙寒冰1, 苏玉民1, 邹劲1, 张可心2, 庄佳园1. 高速无人艇纵向航行性能试验[J]. 上海交通大学学报（自然版）, 2013, 47(02): 278-283.