CN114089749A - 无人艇运动控制抗扰控制器及方法 - Google Patents

无人艇运动控制抗扰控制器及方法 Download PDF

Info

Publication number
CN114089749A
CN114089749A CN202111320194.XA CN202111320194A CN114089749A CN 114089749 A CN114089749 A CN 114089749A CN 202111320194 A CN202111320194 A CN 202111320194A CN 114089749 A CN114089749 A CN 114089749A
Authority
CN
China
Prior art keywords
disturbance rejection
state observer
rejection controller
output end
navigational speed
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.)
Pending
Application number
CN202111320194.XA
Other languages
English (en)
Inventor
李国兰
田立
张海艳
李�浩
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan Liangyu Intelligent Technology Co ltd
Original Assignee
Wuhan Liangyu Intelligent Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Wuhan Liangyu Intelligent Technology Co ltd filed Critical Wuhan Liangyu Intelligent Technology Co ltd
Priority to CN202111320194.XA priority Critical patent/CN114089749A/zh
Publication of CN114089749A publication Critical patent/CN114089749A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明属于无人艇控制领域,涉及无人艇操控系统,具体是一种无人艇运动控制抗扰控制器,包括被控USV模型,其特征在于:将整个控制器分为两部分:航速控制和航向控制,两者相同;其中航速控制部分包括TD滤波过渡器、航速自抗扰控制器和ESO状态观测器;所述TD滤波过渡器的输入端输入航速信号,输出端与航速自抗扰控制器的输入端连接,所述航速自抗扰控制器的输出端分别与ESO状态观测器和被控USV模型连接,所述被控USV模型的航速信号输出端与ESO状态观测器的输入端连接,所述ESO状态观测器的输出端分别与航速自抗扰控制器的输入端和输出端连接。本发明提高了无人艇操控系统的鲁棒性。

Description

无人艇运动控制抗扰控制器及方法
技术领域
本发明属于无人艇控制领域,涉及无人艇操控系统,具体是一种无人艇运动控制抗扰控制器及方法。
背景技术
近年来,应用自主驾驶技术的无人水面艇受到广泛重视,处于高速发展阶段。特别是随着无人艇广泛地应用于民用领域和军用领域,如水质监测、测量测绘、警戒巡逻、火力打击等,无人艇载航行过程中通常会遇到船舶通航密度大、航道弯曲、浅窄航段较多、气象和水文条件复杂等情形。为保证无人艇航行的稳定性和安全性,要求无人艇载航向控制方面,具备很高的机动性和鲁棒性。
为达到上述水面无人艇运动控制的目标,当前各国相关研究人员设置了多种控制算法,大致有比例积分控制(PID)、自适应控制、模糊控制、人工神经网络控制、滑模控制等,但是每种控制算法在特定环境下都有各自的缺陷,比如PID在对海浪高频干扰的处理时,容易导致控制系统低频特性恶化,产生持续的周期性偏航,降低航行精度,增加燃料消耗;自适应控制对于船舶在风浪中航行,当缓变干扰与突变干扰同时存在时,其航向自动舵的鲁棒性较差。
发明内容
本发明的目的在于提供一种无人艇运动控制抗扰控制器及方法,本发明拥有较高的鲁棒性。
为实现上述目的,本发明提供如下技术方案:
一种无人艇运动控制抗扰控制器,包括被控USV模型,其特征在于:将整个控制器分为两部分:航速控制和航向控制;
航速控制部分包括TD滤波过渡器、航速自抗扰控制器和ESO状态观测器;所述TD滤波过渡器的输入端输入航速信号,输出端与航速自抗扰控制器的输入端连接,所述航速自抗扰控制器的输出端分别与ESO状态观测器和被控USV模型连接,所述被控USV模型的航速信号输出端与ESO状态观测器的输入端连接,所述ESO状态观测器的输出端分别与航速自抗扰控制器的输入端和输出端连接;
航向控制部分包括TD滤波过渡器、航向自抗扰控制器和ESO状态观测器;所述TD滤波过渡器的输入端输入航速信号,输出端与航速自抗扰控制器的输入端连接,所述航速自抗扰控制器的输出端分别与ESO状态观测器和被控USV模型连接,所述被控USV模型的航速信号输出端与ESO状态观测器的输入端连接,所述ESO状态观测器的输出端分别与航速自抗扰控制器的输入端和输出端连接。
进一步地,所述被控USV模型为欠驱动水面船舶数学模型。
进一步地,所述TD滤波过渡器为跟踪微分器。
进一步地,所述航速自抗扰控制器和航向自抗扰控制器均为非线性状态误差反馈律。
进一步地,所述ESO状态观测器为扩张状态观测器。
一种无人艇运动控制抗扰控制方法,其特征在于:
建立无人艇的欠驱动水面船舶数学模型,将欠驱动水面船舶数学模型的输入和输出均分为航速和航向,对航速和航向的控制方式相同,包括:
向跟踪微分器输入航速/航向目标,经过跟踪微分器处理后输出目标信号和目标信号的微分信号,所述目标信号和目标信号的微分信号分别减去所述扩张状态观测器观察出来的目标信号和目标信号的微分信号,再输入到非线性状态误差反馈律,非线性状态误差反馈律输出控制参数,所述控制参数减去所述扩张状态观测器观测出来的总系统扰动得到最终控制参数,所述最终控制参数分别输入给扩张状态观测器和欠驱动水面船舶数学模型,所述欠驱动水面船舶数学模型将输出的航速/航向输入给对应的扩张状态观测器,所述扩张状态观测器的输出包括观察出来的目标信号、目标信号的微分信号和总系统扰动。
进一步地,在非线性状态误差反馈律输出的控制参数转换为最终控制参数的过程中引入一个预设系数,用于调整输出结果;所述控制参数先减去总系统扰动,再除以所述预设系数,得到最终控制参数。
与现有技术相比,本发明的有益效果如下:本发明设计了非线性鲁棒控制器(鲁棒性是在异常和危险情况下系统生存的能力),利用跟踪微分器(TD)、扩张状态观测器(ESO)和非线性状态误差反馈律(NLSEF)来组合构成无人艇运动控制系统。根据无人艇运动学方程及动力学方程,并选取相关船型参数,搭建无人艇运动控制微分方程模型,验证自抗扰控制方法效果。
附图说明
图1是无人艇运动控制抗扰控制器流程框图。
图2是本发明所使用自抗扰控制器仿真时航向跟踪效果。
图3是本发明所使用自抗扰控制器仿真时航速跟踪效果。
图4是无人艇运动学方程及动力学方程建立时双坐标系对比关系。
具体实施方式
下面将结合具体实施例对本发明实施例中的技术方案进行清楚、完整地描述。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
无人艇需要在海况复杂的情况下出海巡航或者执行相关任务,传统的线性运动控制方法受到模型不确定性及风浪流的干扰,收敛效果不稳定。本方案的一种无人艇运动控制抗扰控制器及方法,将ADRC技术与无人艇运动控制相结合,进而设计非线性模型预测控制器,能够改善线性运动控制方法鲁棒性不够、易受外界干扰的问题。如图1所示,具体实施方式如下:
无人艇运动控制抗扰控制器,如图1所示,包括欠驱动水面船舶数学模型,将整个控制器分为两部分,分别进行航速控制和航向控制。
航速控制部分包括跟踪微分器、航速自抗扰控制器和扩张状态观测器;所述跟踪微分器的输入端输入航速信号,输出端与航速自抗扰控制器的输入端连接,所述航速自抗扰控制器的输出端分别与扩张状态观测器和欠驱动水面船舶数学模型连接,所述欠驱动水面船舶数学模型的航速信号输出端与扩张状态观测器的输入端连接,所述扩张状态观测器的输出端分别与航速自抗扰控制器的输入端和输出端连接。
航向控制部分包括跟踪微分器、航向自抗扰控制器和扩张状态观测器;所述跟踪微分器的输入端输入航速信号,输出端与航速自抗扰控制器的输入端连接,所述航速自抗扰控制器的输出端分别与扩张状态观测器和欠驱动水面船舶数学模型连接,所述欠驱动水面船舶数学模型的航速信号输出端与扩张状态观测器的输入端连接,所述扩张状态观测器的输出端分别与航速自抗扰控制器的输入端和输出端连接。
所述航速自抗扰控制器和航向自抗扰控制器均为非线性状态误差反馈律。
无人艇运动控制抗扰控制过程包括:建立无人艇的欠驱动水面船舶数学模型,将欠驱动水面船舶数学模型的输入和输出均分为航速和航向,对航速和航向的控制方式相同,包括:向跟踪微分器输入航速/航向目标,经过跟踪微分器处理后输出目标信号和目标信号的微分信号,所述目标信号和目标信号的微分信号分别减去所述扩张状态观测器观察出来的目标信号和目标信号的微分信号,再输入到非线性状态误差反馈律,非线性状态误差反馈律输出控制参数u0,所述控制参数u0减去所述扩张状态观测器观测出来的总系统扰动得到最终控制参数(u和u(τu),两者相等),所述最终控制参数分别输入给扩张状态观测器(u)和欠驱动水面船舶数学模型(u(τu)),所述欠驱动水面船舶数学模型将输出的航速/航向输入给对应的扩张状态观测器,所述扩张状态观测器的输出包括观察出来的目标信号、目标信号的微分信号和总系统扰动。作为优秀方案,在非线性状态误差反馈律输出的控制参数转换为最终控制参数的过程中引入一个预设系数b,用于调整输出结果;所述控制参数先减去总系统扰动,再除以所述预设系数b,得到最终控制参数。
具体包括:
一、建立无人艇的欠驱动水面船舶数学模型
主要分为运动学模型和动力学模型两部分,运动学模型描述船舶运动的几何特征,动力学模型对引起船舶运动的力和力矩进行分析。然后建立风、浪、流引起的环境干扰数学模型,通过综合分析建立欠驱动水面船舶数学模型,如图4。
定义η=[η12]T为船舶在惯性坐标系下的位置和方向,其中η1=[x,y,z]T,η2=[φ,θ,ψ]T
定义υ=[υ12]T为船舶在船舶附体坐标系下的船舶的线速度和角速度,其中υ1=[u,v,w]T,υ2=[p,q,r]T
定义τ=[τ12]T为船舶在船舶附体坐标系下作用在船舶上的力和力矩,其中τ1=[X,Y,Z]T代表的是船舶在附体坐标系三个轴方向上所受到的力,τ2=[K,M,N]T代表的是船舶在附体坐标系中三个方向所受到的力矩。
下表是无人艇运动学方程及动力学方程建立时各符号含义。
Figure BDA0003344903320000051
Figure BDA0003344903320000061
Figure BDA0003344903320000062
是六自由度的船舶运动学模型。
Figure BDA0003344903320000063
表示船舶的动力学模型。
其中,矩阵M包括:MRB代表刚体惯性矩阵,和MA代表流体惯性附加质量矩阵。
矩阵C包括:CRB(υ)代表刚体的科里奥利和向心力矩阵,和CA(υ)代表流体动力学科里奥利和向心力矩阵。
g(η)代表由位置和方向决定的回复力和回复力矩。
最终简化为三自由度的水平面船舶模型(忽略风、浪、流引起的环境干扰)。
如果需要考虑风浪流的干扰,则在Bf位置添加τE所带来的影响,τE为风、浪、流引起的环境干扰矩阵;化简得出无人艇的欠驱动水面船舶数学模型,如下。
Figure BDA0003344903320000064
其中,τu和τr作为无人艇模型的纵向输入力矩和转向偏转力矩。x yψu v r分别代表无人艇在大地坐标系中X轴的位置坐标、y轴的位置坐标、航向角、纵向运动速度、横向运动速度、艏向角变化角速度。其余的变量(m11、m22、m33)均为无人艇固有的一些相关参数,通过操纵实验,回转实验后的实验数据参数辨识得到。
二、跟踪微分器的过渡过程安排;
Figure BDA0003344903320000071
跟踪微分器对目标的航向或者航速信号v(k)安排过渡过程,采用二阶最速综合函数fhan,可以避免突然的节约信号所代来的系统输出严重滞后问题,并得到目标输入信号的过滤信号以及其近似微分信号。
上述公式采用的是离散化的跟踪微分器,v(k)代表根据LOS方法或者其他路径规划方法得到的航向或者航速目标信号;x1代表的是滤波后得到的航向/航速目标信号,x2代表的是近似的航向/航速目标信号的微分信号。r0和h0作为系统控制参数,与系统采样时间步长和过滤过程快慢有关,人工进行调整。
步骤三、扩张状态观测器扩张状态观测过程;
Figure BDA0003344903320000072
扩张状态观测器将总扰动扩张成系统的一个新的状态变量,然后利用系统的输入、输出重构(也就是观测)出包含系统原有状态变量和扰动的所有状态。
y(k)为系统实际输出;z1(k)为观测出来的航速/航向信号输出;z2(k)为观测出来的系统航速/航向信号的微分信号;z3(k)为观测出来的总的系统扰动。ε1代表的是观测偏差,为系统观测输出和实际输出的差值;h为系统离散化过程中的采样周期;β01β02β03为系统控制参数,一般与观测器的带宽有关,根据采用步长决定;δ为系统控制参数,一般5h≤δ≤10h;fal为非线性观测函数;
步骤四、非线性状态误差反馈律(NLSEF):
Figure BDA0003344903320000081
非线性状态误差反馈律其实就是在传统PID控制方法上的改进。通过跟踪微分器及其产生的过渡过程,可以跟踪误差信号。利用误差信号e1和误差微分信号e2,可以生成误差积分信号e0,就可以采用传统PID控制方法;但是针对无人艇这种滞后大,受外界干扰明显的非线性系统,线性PID控制方法很难取得较好的控制效果,所以采用非线性控制组合,且干扰扰动在ESO扩张状态观测中进行了观测和补偿,所以可以忽略积分项。
其中fal为非线性函数,β1、β2为系统的比例和微分控制系数,α1、α2为系统的控制参数且一般0<α1<1<α2;δ为系统的控制参数,一般5h≤δ≤10h;u即是控制器最终的控制输出,作用于系统运动学及动力学数学模型上。
上述一二三四的关系参考图1,将整个系统的闭环流程规划完毕,形成闭环反馈控制系统;并通过Simulink仿真搭建系统模型,离散化仿真获得航向跟踪曲线及航速跟踪曲线如附图2、3所示(目标航速为10kn/15kn节约信号,目标航向为30°/70°阶跃跳变信号)。
本方案提出利用跟踪微分器(TD)、扩张状态观测器(ESO)和非线性状态误差反馈(NLSEF)来组合构成无人艇运动控制系统,根据无人艇运动学方程及动力学方程,搭建无人艇运动控制微分方程模型,验证自抗扰控制方法效果。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。

Claims (7)

1.一种无人艇运动控制抗扰控制器,包括被控USV模型,其特征在于:将整个控制器分为两部分:航速控制和航向控制;
航速控制部分包括TD滤波过渡器、航速自抗扰控制器和ESO状态观测器;所述TD滤波过渡器的输入端输入航速信号,输出端与航速自抗扰控制器的输入端连接,所述航速自抗扰控制器的输出端分别与ESO状态观测器和被控USV模型连接,所述被控USV模型的航速信号输出端与ESO状态观测器的输入端连接,所述ESO状态观测器的输出端分别与航速自抗扰控制器的输入端和输出端连接;
航向控制部分包括TD滤波过渡器、航向自抗扰控制器和ESO状态观测器;所述TD滤波过渡器的输入端输入航速信号,输出端与航速自抗扰控制器的输入端连接,所述航速自抗扰控制器的输出端分别与ESO状态观测器和被控USV模型连接,所述被控USV模型的航速信号输出端与ESO状态观测器的输入端连接,所述ESO状态观测器的输出端分别与航速自抗扰控制器的输入端和输出端连接。
2.根据权利要求1所述的无人艇运动控制抗扰控制器,其特征在于:所述被控USV模型为欠驱动水面船舶数学模型。
3.根据权利要求2所述的无人艇运动控制抗扰控制器,其特征在于:所述TD滤波过渡器为跟踪微分器。
4.根据权利要求3所述的无人艇运动控制抗扰控制器,其特征在于:所述航速自抗扰控制器和航向自抗扰控制器均为非线性状态误差反馈律。
5.根据权利要求4所述的无人艇运动控制抗扰控制器,其特征在于:所述ESO状态观测器为扩张状态观测器。
6.根据权利要求5所述的无人艇运动控制抗扰控制器的一种无人艇运动控制抗扰控制方法,其特征在于:
建立无人艇的欠驱动水面船舶数学模型,将欠驱动水面船舶数学模型的输入和输出均分为航速和航向,对航速和航向的控制方式相同,包括:
向跟踪微分器输入航速/航向目标,经过跟踪微分器处理后输出目标信号和目标信号的微分信号,所述目标信号和目标信号的微分信号分别减去所述扩张状态观测器观察出来的目标信号和目标信号的微分信号,再输入到非线性状态误差反馈律,非线性状态误差反馈律输出控制参数,所述控制参数减去所述扩张状态观测器观测出来的总系统扰动得到最终控制参数,所述最终控制参数分别输入给扩张状态观测器和欠驱动水面船舶数学模型,所述欠驱动水面船舶数学模型将输出的航速/航向输入给对应的扩张状态观测器,所述扩张状态观测器的输出包括观察出来的目标信号、目标信号的微分信号和总系统扰动。
7.根据权利要求6所述的无人艇运动控制抗扰控制方法,其特征在于:在非线性状态误差反馈律输出的控制参数转换为最终控制参数的过程中引入一个预设系数,用于调整输出结果;所述控制参数先减去总系统扰动,再除以所述预设系数,得到最终控制参数。
CN202111320194.XA 2021-11-09 2021-11-09 无人艇运动控制抗扰控制器及方法 Pending CN114089749A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111320194.XA CN114089749A (zh) 2021-11-09 2021-11-09 无人艇运动控制抗扰控制器及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111320194.XA CN114089749A (zh) 2021-11-09 2021-11-09 无人艇运动控制抗扰控制器及方法

Publications (1)

Publication Number Publication Date
CN114089749A true CN114089749A (zh) 2022-02-25

Family

ID=80299654

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111320194.XA Pending CN114089749A (zh) 2021-11-09 2021-11-09 无人艇运动控制抗扰控制器及方法

Country Status (1)

Country Link
CN (1) CN114089749A (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114755917A (zh) * 2022-03-18 2022-07-15 大连海事大学 一种无模型自适应抗干扰船舶速度控制器及设计方法
CN115016471A (zh) * 2022-05-30 2022-09-06 武汉理工大学 一种船舶路径跟随控制方法、系统、装置及存储介质
CN115616920A (zh) * 2022-11-17 2023-01-17 三亚哈尔滨工程大学南海创新发展基地 一种多无人艇系统中耦合干扰主动抑制方法
CN117647981A (zh) * 2023-11-23 2024-03-05 中船(北京)智能装备科技有限公司 一种无人艇智能航行控制方法、装置及设备

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114755917A (zh) * 2022-03-18 2022-07-15 大连海事大学 一种无模型自适应抗干扰船舶速度控制器及设计方法
CN114755917B (zh) * 2022-03-18 2024-05-21 大连海事大学 一种无模型自适应抗干扰船舶速度控制器及设计方法
CN115016471A (zh) * 2022-05-30 2022-09-06 武汉理工大学 一种船舶路径跟随控制方法、系统、装置及存储介质
CN115616920A (zh) * 2022-11-17 2023-01-17 三亚哈尔滨工程大学南海创新发展基地 一种多无人艇系统中耦合干扰主动抑制方法
CN115616920B (zh) * 2022-11-17 2024-03-29 哈尔滨工程大学三亚南海创新发展基地 一种多无人艇系统中耦合干扰主动抑制方法
CN117647981A (zh) * 2023-11-23 2024-03-05 中船(北京)智能装备科技有限公司 一种无人艇智能航行控制方法、装置及设备

Similar Documents

Publication Publication Date Title
CN108008628A (zh) 一种不确定欠驱动无人艇系统的预设性能控制方法
CN110018687B (zh) 基于强化学习方法的无人水面船最优轨迹跟踪控制方法
CN114089749A (zh) 无人艇运动控制抗扰控制器及方法
Miao et al. Spatial curvilinear path following control of underactuated AUV with multiple uncertainties
Fan et al. Course keeping control based on integrated nonlinear feedback for a USV with pod-like propulsion
Zhang et al. Anti-disturbance control for dynamic positioning system of ships with disturbances
Zhang et al. A novel event-triggered robust neural formation control for USVs with the optimized leader–follower structure
CN112947375B (zh) 一种考虑未知死区的复合自适应容错控制器设计方法
CN115113524B (zh) 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法
Liu et al. A hierarchical disturbance rejection depth tracking control of underactuated AUV with experimental verification
CN116048090A (zh) 一种具有能耗优化效应的风帆助航船路径跟踪控制方法
CN115016277A (zh) 一种考虑船间事件触发通信的多船分布式容错控制方法
Tang et al. Robust fixed-time trajectory tracking control of the dynamic positioning ship with actuator saturation
CN115903820A (zh) 多无人艇追逃博弈控制方法
Dai et al. Dual closed loop AUV trajectory tracking control based on finite time and state observer
Zhang et al. Adaptive integral terminal sliding mode based trajectory tracking control of underwater glider
Song et al. Event-triggered fuzzy finite-time reliable control for dynamic positioning of nonlinear unmanned marine vehicles
Wang et al. Direct adaptive neural network control for ship manoeuvring modelling group model-based uncertain nonlinear systems in non-affine pure-feedback form
Tang et al. Simulation of optimal integral sliding mode controller for the depth control of AUV
CN117032209A (zh) 一种欠驱动船舶鲁棒自适应神经网络控制方法
Tang et al. Robust adaptive tracking control for dynamic positioning ships subject to dynamic safety constraints and actuator saturation
An et al. Observer based fixed-time integral sliding mode tracking control for underactuated AUVs via an event-triggered mechanism
Miyamaoto et al. Maneuvering control system design for autonomous underwater vehicle
Xiao et al. Nonlinear robust heading control for sailing yachts
Liu et al. Robust event-triggered formation control for underactuated ships under the practice constraint

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