CN109752957B - 一种无人艇的制导指令调节器结构及设计方法 - Google Patents
一种无人艇的制导指令调节器结构及设计方法 Download PDFInfo
- Publication number
- CN109752957B CN109752957B CN201910026842.7A CN201910026842A CN109752957B CN 109752957 B CN109752957 B CN 109752957B CN 201910026842 A CN201910026842 A CN 201910026842A CN 109752957 B CN109752957 B CN 109752957B
- Authority
- CN
- China
- Prior art keywords
- unit
- output end
- unmanned ship
- representing
- signal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种无人艇的制导指令调节器结构及设计方法,所述的结构包括制导指令调节器和闭环控制器。本发明所设计的无人艇制导指令调节器,对外环给定指令信号进行优化处理,考虑了无人艇的模型不确定性与海洋环境引起的外部扰动问题,并且制导指令调节器优化处理后得到制导指令信号同时满足无人艇的输入约束与状态约束,解决了现有的一些方案中运动学制导律违反无人艇实际物理特性的问题,使得控制性能得到提高。本发明所设计的无人艇制导指令调节器在处理制导信号时不依赖于精确的无人艇模型,无需进行多步的预测计算,节省了无人艇控制系统的计算资源与计算时间,从而能够快速跟踪外部时变指令信号,提高无人艇的机动性。
Description
技术领域
本发明涉及无人艇运动控制技术领域,尤其是一种无人艇的制导指令调节器结构及设计方法。
背景技术
21世纪是海洋的世纪,海洋资源的认识、开发与保护对人类生存与可持续发展具有重要意义。无人艇在人类认识海洋、开发海洋与保护海洋等方面发挥着不可替代的作用,在军事领域与民用领域具有广泛的应用前景,例如:利用无人艇搭载不同的调查勘测设备在复杂的海洋环境中执行勘探、安防、搜救、投送等任务。然而无人艇关键技术领域中,无人艇的运动控制技术是实现无人艇工程应用的前提和基础。无人艇的运动控制场景主要包括目标跟踪、轨迹跟踪与路径跟踪。
针对无人艇运动控制问题,已经有了一些可行的技术方案。例如:中国专利CN108319138A提出了一种欠驱动无人艇的滑模-反步双回路轨迹跟踪控制方法,该方法通过设计基于反步法的运动学回路轨迹跟踪控制器与基于滑模控制算法的动力学回路轨迹跟踪控制器来实现对水面无人艇的轨迹跟踪控制。中国专利CN106773713A公开了一种针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法,该方法采用传统视线角制导方法计算期望视线角,并设计基于观测器的非线性路径跟踪控制器,实现对航行器期望路径的精确跟踪控制。
但是,现有的一些无人艇运动控制方案中存在以下几点问题有待解决:
第一,现有的一些无人艇的运动控制方法设计大多仅考虑了无人艇的模型不确定性与海洋环境引起的外部扰动问题,却忽略了无人艇的运动控制中所存在的一些不可避免的约束问题,例如状态约束、输入约束。忽略这些约束问题所设计出的运动学制导律可能会违反无人艇的实际特性,使得控制性能大大降低,严重时甚至会导致控制失效。
第二,现有的处理约束问题的方法有障碍函数设计、辅助系统设计和模型预测控制方法等。但障碍函数设计仅考虑了输出约束而非输入与状态约束,辅助系统设计仅考虑了输入约束却没考虑到状态约束,模型预测控制方法考虑到了输入与状态约束,却高度依赖于精确的无人艇模型,并且计算量较大,对时变信号的跟踪性能差。
发明内容
为解决现有技术存在的上述问题,本发明要设计一种既能提高控制性能,又结构简单、计算量小、能够快速跟踪时变指令信号的无人艇的制导指令调节器结构及设计方法。
为了实现上述目的,本发明的技术方案如下:一种无人艇的制导指令调节器结构,包括制导指令调节器和闭环控制器;
所述的制导指令调节器由作差单元1、作差单元2、转置单元1、转置单元2、乘法单元1、乘法单元2、增益单元1、增益单元2、求和单元、作差单元3、偏导单元、激活函数投影单元、作差单元4和积分单元组成,所述的作差单元1的输入端分别与积分单元输出端和指令发生器输出端相连;转置单元1的输入端与作差单元1的输出端相连;乘法单元1的输入端分别与作差单元1的输出端和转置单元1的输出端相连;增益单元1的输入端与乘法单元1的输出端相连;作差单元2的输入端分别与无人艇的输出端和积分单元的输出端相连;转置单元2的输入端与作差单元2的输出端相连;乘法单元2的输入端分别与作差单元2的输出端和转置单元2的输出端相连;增益单元2的输入端与乘法单元2的输出端相连;求和单元的输入端分别与增益单元1的输出端和增益单元2的输出端相连,求和单元的输出端与偏导单元连接;作差单元4的输入端分别与积分单元的输出端和偏导单元的输出端相连;激活函数投影单元的输入端分别与作差单元4的输出端和闭环控制器的集总不确定性输出端相连;作差单元3的输入端分别与激活函数投影单元的输出端和积分单元的输出端相连;积分单元的输入端与作差单元3的输出端相连;积分单元的输出端与闭环控制器的输入端相连,闭环控制器的输出端与无人艇的输入端相连。
所述的积分单元的输出端即为制导指令调节器的输出端,所述的制导指令调节器的输入信号为外部给定速度指令信号与无人艇输出的当前速度信号;无人艇的输入端与闭环控制器的输出端相连。
一种无人艇的制导指令调节器结构的设计方法,所述的无人艇满足下面的三自由度动力学模型:
其中:
所述的方法,包括下述步骤:
A.闭环控制器的设计
具体观测方法设计如下:
B.制导指令调节器的设计
评价函数具体设计方法如下:
激活函数P=(Pu Pv Pq)T的具体设计方法如下:
其中:约束变量lu、hu、lv、hv、lq、hq的选取方法如下:
其中:和代表纵向速度、横向速度和艏摇角速度的状态约束的下界;和代表纵向速度、横向速度和艏摇角速度的状态约束的上界;和代表纵向、横向和艏摇角方向的控制输入约束的下界,和代表纵向、横向和艏摇角方向的控制输入约束的上界。
相比现有技术,本发明的有益效果是:
第一,本发明所设计的无人艇制导指令调节器,对外环给定指令信号进行优化处理,考虑了无人艇的模型不确定性与海洋环境引起的外部扰动问题,并且制导指令调节器优化处理后得到制导指令信号同时满足无人艇的输入约束与状态约束,解决了现有的一些方案中运动学制导律违反无人艇实际物理特性的问题,使得控制性能得到提高。
第二,本发明所设计的无人艇制导指令调节器在处理制导信号时不依赖于精确的无人艇模型,与现有的模型预测方法相比,本发明无需进行多步的预测计算,节省了无人艇控制系统的计算资源与计算时间,从而能够快速跟踪外部时变指令信号,提高无人艇的机动性。
第三,本发明所设计的无人艇制导指令调节器,当将无人艇满足下面的三自由度动力学模型(1)中控制分量τv设置为零的时候,则该模型就变换为欠驱动无人艇的模型,表明本发明所设计的方法既适用于全驱动无人艇,同时也适用于欠驱动无人艇的制导指令调节。
附图说明
本发明共有附图7张,其中:
图1是无人艇制导指令调节器结构示意图。
图2是纵向集总不确定性观测示意图。
图3是艏摇角速度方向集总不确定性观测示意图。
图4是纵向速度控制分量示意图。
图5是艏摇角速度控制分量示意图。
图6是纵向速度跟踪效果示意图。
图7是艏摇角速度跟踪效果示意图。
具体实施方式
本发明涉及的无人艇的制导指令调节器结构示意图如图1所示。下面针对一个具体的无人艇跟踪外部给定速度指令信号为例对本发明进行进一步说明。
实时给定外部速度指令信号,经过无人艇制导指令调节器优化后输出优化制导信号给闭环控制器,使得无人艇实时准确跟踪外部速度指令信号。无人艇指令调节器结构与设计方法满足式(1)-(11),具体的控制参数如下:
仿真结果如图2-7所示。图2是纵向集总不确定性观测示意图,其中线条σu为纵向集总不确定性的实际值,线条为纵向集总不确定性的观测值,由图2可以看出线条σu与线条吻合程度很高;图3是艏摇角速度方向集总不确定性观测示意图,其中线条σq为艏摇角速度方向集总不确定性实际值,线条为艏摇角速度方向集总不确定性的观测值,由图3可以看出线条σq与线条吻合程度很高;图2-3表明本发明所设计方法对集总不确定性有良好的观测效果。图4是纵向控制分量示意图,其中虚线为纵向控制输入约束的上下界限,线条τu为闭环控制器所给出的纵向控制分量,由图4可以看出所给出的控制输入分量在控制输入约束上下界限内,满足输入约束要求。图5是艏摇角速度方向控制分量示意图,其中虚线为艏摇角速度方向控制输入约束的上下界限,线条τq为闭环控制器所给出的艏摇角速度方向控制分量,由图5可以看出所给出的控制输入分量在控制输入约束上下界限内,没有违反输入约束要求。图6是纵向速度跟踪效果示意图,线条uc为指令发生器给出的纵向速度指令信号,线条u0为无人艇的制导指令调节器给出的纵向制导指令信号,线条u为无人艇的实际纵向速度信号,由图6可以看出线条u与线条u0吻合度极高,并且很快跟踪上线条uc。图6表明无人艇制导指令调节器能够实时给出最优的纵向制导指令信号,使得无人艇准确跟踪上纵向速度指令信号。图7是艏摇角速度跟踪效果示意图,线条qc为指令发生器给出的艏摇角速度指令信号,线条q0为无人艇的制导指令调节器给出的艏摇角制导指令信号,线条q为无人艇的实际艏摇角速度信号,由图7可以看出线条q与线条q0吻合度很高,并且很快跟踪上线条qc。图7表明无人艇制导指令调节器能够实时给出最优的艏摇角制导指令信号,使得无人艇准确跟踪上艏摇角速度指令信号。
本发明不局限于本实施例,任何在本发明披露的技术范围内的等同构思或者改变,均列为本发明的保护范围。
Claims (2)
1.一种无人艇的制导指令调节器结构,其特征在于:包括制导指令调节器和闭环控制器;
所述的制导指令调节器由作差单元1、作差单元2、转置单元1、转置单元2、乘法单元1、乘法单元2、增益单元1、增益单元2、求和单元、作差单元3、偏导单元、激活函数投影单元、作差单元4和积分单元组成,所述的作差单元1的输入端分别与积分单元输出端和指令发生器输出端相连;转置单元1的输入端与作差单元1的输出端相连;乘法单元1的输入端分别与作差单元1的输出端和转置单元1的输出端相连;增益单元1的输入端与乘法单元1的输出端相连;作差单元2的输入端分别与无人艇的输出端和积分单元的输出端相连;转置单元2的输入端与作差单元2的输出端相连;乘法单元2的输入端分别与作差单元2的输出端和转置单元2的输出端相连;增益单元2的输入端与乘法单元2的输出端相连;求和单元的输入端分别与增益单元1的输出端和增益单元2的输出端相连,求和单元的输出端与偏导单元连接;作差单元4的输入端分别与积分单元的输出端和偏导单元的输出端相连;激活函数投影单元的输入端分别与作差单元4的输出端和闭环控制器的集总不确定性输出端相连;作差单元3的输入端分别与激活函数投影单元的输出端和积分单元的输出端相连;积分单元的输入端与作差单元3的输出端相连;积分单元的输出端与闭环控制器的输入端相连,闭环控制器的输出端与无人艇的输入端相连;
所述的积分单元的输出端即为制导指令调节器的输出端,所述的制导指令调节器的输入信号为外部给定速度指令信号与无人艇输出的当前速度信号;无人艇的输入端与闭环控制器的输出端相连。
2.一种无人艇的制导指令调节器结构的设计方法,其特征在于:所述的无人艇满足下面的三自由度动力学模型:
其中:
所述的方法,包括下述步骤:
A.闭环控制器的设计
具体观测方法设计如下:
B.制导指令调节器的设计
评价函数具体设计方法如下:
激活函数P=(Pu Pv Pq)T的具体设计方法如下:
其中:约束变量lu、hu、lv、hv、lq、hq的选取方法如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910026842.7A CN109752957B (zh) | 2019-01-11 | 2019-01-11 | 一种无人艇的制导指令调节器结构及设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910026842.7A CN109752957B (zh) | 2019-01-11 | 2019-01-11 | 一种无人艇的制导指令调节器结构及设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109752957A CN109752957A (zh) | 2019-05-14 |
CN109752957B true CN109752957B (zh) | 2021-07-30 |
Family
ID=66405506
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910026842.7A Active CN109752957B (zh) | 2019-01-11 | 2019-01-11 | 一种无人艇的制导指令调节器结构及设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109752957B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110262524B (zh) * | 2019-08-02 | 2022-04-01 | 大连海事大学 | 一种无人艇集群最优聚集控制器的设计方法 |
CN112327638B (zh) * | 2020-12-03 | 2022-11-01 | 大连海事大学 | 一种具有指定性能并带有输入饱和限制的无人船轨迹跟踪最优控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9669904B2 (en) * | 2011-05-12 | 2017-06-06 | Unmanned Innovations, Inc. | Systems and methods for multi-mode unmanned vehicle mission planning and control |
CN108121338B (zh) * | 2016-11-30 | 2019-12-03 | 中国科学院沈阳自动化研究所 | 一种usv的航迹闭环控制方法 |
CN106773713B (zh) * | 2017-01-17 | 2020-02-07 | 北京航空航天大学 | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 |
CN107168335B (zh) * | 2017-06-28 | 2020-06-23 | 大连海事大学 | 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法 |
CN108710373B (zh) * | 2018-05-31 | 2021-01-15 | 大连海事大学 | 一种网络化欠驱动无人艇分布式编队控制器及其设计方法 |
-
2019
- 2019-01-11 CN CN201910026842.7A patent/CN109752957B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109752957A (zh) | 2019-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108803632B (zh) | 基于饱和补偿技术的水面无人艇全状态约束轨迹跟踪控制方法 | |
CN109976349B (zh) | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 | |
CN109507885B (zh) | 基于自抗扰的无模型自适应auv控制方法 | |
CN108445892A (zh) | 一种欠驱动无人船编队控制器结构及设计方法 | |
CN105807789B (zh) | 基于t-s模糊观测器补偿的uuv控制方法 | |
CN104850122B (zh) | 基于可变船长比的抵抗侧风无人水面艇直线路径跟踪方法 | |
CN112965371B (zh) | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 | |
Xia et al. | Adaptive energy-efficient tracking control of a X rudder AUV with actuator dynamics and rolling restriction | |
CN109752957B (zh) | 一种无人艇的制导指令调节器结构及设计方法 | |
Wu et al. | Adaptive neural network and extended state observer-based non-singular terminal sliding modetracking control for an underactuated USV with unknown uncertainties | |
Huo et al. | Horizontal path-following control for deep-sea work-class ROVs based on a fuzzy logic system | |
Mu et al. | Path following for podded propulsion unmanned surface vehicle: Theory, simulation and experiment | |
CN112650257A (zh) | 一种无人艇区域保持控制方法及装置 | |
Liu et al. | A hierarchical disturbance rejection depth tracking control of underactuated AUV with experimental verification | |
CN114442640A (zh) | 一种水面无人艇轨迹跟踪控制方法 | |
Zhang et al. | Sliding mode prediction control for 3d path following of an underactuated auv | |
Dai et al. | Dual closed loop AUV trajectory tracking control based on finite time and state observer | |
Yuan et al. | An efficient control allocation algorithm for over-actuated AUVs trajectory tracking with fault-tolerant control | |
CN110647161B (zh) | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 | |
CN116048090A (zh) | 一种具有能耗优化效应的风帆助航船路径跟踪控制方法 | |
Shen et al. | Nonlinear observer-based adaptive output feedback tracking control of underactuated ships with input saturation | |
Liu et al. | Active fault-tolerant control design for a submarine semi-physical simulation system | |
Do et al. | Robust path following of underactuated ships using Serret-Frenet frame | |
CN114564015A (zh) | 一种拒止环境下的欠驱动无人艇分布式编队控制方法 | |
Jiang et al. | Design of novel sliding-mode controller for high-velocity AUV with consideration of residual dead load |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |