CN113608534A - 一种无人艇跟踪控制方法及系统 - Google Patents

一种无人艇跟踪控制方法及系统 Download PDF

Info

Publication number
CN113608534A
CN113608534A CN202110889686.4A CN202110889686A CN113608534A CN 113608534 A CN113608534 A CN 113608534A CN 202110889686 A CN202110889686 A CN 202110889686A CN 113608534 A CN113608534 A CN 113608534A
Authority
CN
China
Prior art keywords
tracking
error
virtual
unmanned ship
unmanned
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.)
Granted
Application number
CN202110889686.4A
Other languages
English (en)
Other versions
CN113608534B (zh
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.)
University of Shanghai for Science and Technology
Original Assignee
University of Shanghai for Science and Technology
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 University of Shanghai for Science and Technology filed Critical University of Shanghai for Science and Technology
Priority to CN202110889686.4A priority Critical patent/CN113608534B/zh
Publication of CN113608534A publication Critical patent/CN113608534A/zh
Application granted granted Critical
Publication of CN113608534B publication Critical patent/CN113608534B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/0206—Control 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

本发明公开了一种无人艇跟踪控制方法及系统。所述方法，包括：基于实际位置信息和期望位置信息，采用预设性能函数计算非约束跟踪误差；由实际位置信息、期望位置信息和非约束跟踪误差计算虚拟控制率，并由虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差；采用径向基神经网络估计未知时变项目，得到无人艇模型；基于无人艇模型，对复合干扰进行估计，得到复合干扰估计值；由虚拟误差面、滤波误差、无人艇模型和复合干扰估计值确定跟踪控制率；控制率用于控制无人艇的轨迹跟踪。本发明能提高无人艇跟踪控制的精度。

Description

一种无人艇跟踪控制方法及系统
技术领域
本发明涉及无人艇控制领域，特别是涉及一种无人艇跟踪控制方法及系统。
背景技术
近几十年来，由于自主式无人水面舰艇(unmanned surface vessel，USV)在海上救援、资源勘探、礁体探测等领域的广泛应用，其跟踪控制引起了海洋技术、控制科学等领域的广泛关注。
USV控制系统的快速准确跟踪能力在珊瑚礁测绘、海上补给、通过狭窄水道等实际应用中发挥着重要作用。因此，要完成这些任务，通常需要USV的高控制性能，即快速跟踪和精确跟踪。然而，USV通常受限于由水动力阻尼力和外部扰动(如波浪、洋流和风)引起的未建模动力学，这可能导致较大的跟踪误差，甚至系统发散。
目前，已设计出的基于事件触发的无人艇跟踪控制，未考虑无人艇模型不确定、外界干扰、无人艇跟踪误差限制以及跟踪时间限制等问题。因此，无人艇跟踪控制精度有待提高。
发明内容
基于此，有必要提供一种无人艇跟踪控制方法及系统，在考虑无人艇模型不确定和外界干扰的情况下，实现在预设误差性能范围内和在有限时间内实现跟踪控制，提高无人艇跟踪控制的精度。
为实现上述目的，本发明提供了如下方案：
一种无人艇跟踪控制方法，包括：
获取无人艇的实际位置信息和期望位置信息；
基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差；
由所述实际位置信息、所述期望位置信息和所述非约束跟踪误差计算虚拟控制率，并由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差；
采用径向基神经网络估计未知时变项目，得到无人艇模型；所述未知时变项目包括水动力阻尼参数、科氏加速度和向心加速度；
基于所述无人艇模型，对复合干扰进行估计，得到复合干扰估计值；所述复合干扰包括所述无人艇模型的估计误差和外界干扰；
由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率；所述跟踪控制率用于控制无人艇的轨迹跟踪。
可选的，在所述由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率之后，还包括：
计算当前时刻的跟踪控制率与上一时刻的跟踪控制率的差值；
判断所述差值是否大于设定值；
若是，则控制执行器以所述当前时刻的跟踪控制率控制无人艇的轨迹跟踪；
若否，则保持上一时刻的跟踪控制率。
可选的，所述实际位置信息包括大地坐标系下的位置坐标、大地坐标系下的艏向角坐标、船体坐标系下的纵向速度、船体坐标系下的横向速度和船体坐标系下的艏向角速度；
所述期望位置信息包括大地坐标系下的期望位置坐标、大地坐标系下的期望艏向角坐标、船体坐标系下的期望纵向速度、船体坐标系下的期望横向速度和船体坐标系下的期望艏向角速度。
可选的，所述基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差，具体包括：
采用所述实际位置信息建立无人艇动力学模型；
采用所述期望位置信息计算期望轨迹；
由所述无人艇动力学模型和所述期望轨迹计算跟踪误差；
采用预设性能函数将所述跟踪误差转换为所述非约束跟踪误差。
可选的，所述虚拟控制率为：
Figure BDA0003195349680000031
Figure BDA0003195349680000032
Figure BDA0003195349680000033
其中，uα为纵向虚拟控制率，vα为横向虚拟控制率，rα为艏向角虚拟控制率，ψ为大地坐标系下的艏向角坐标，ψd为大地坐标系下的期望艏向角坐标，ud为船体坐标系下的期望纵向速度，vd船体坐标系下的期望横向速度，rd为船体坐标系下的期望艏向角速度，
Figure BDA0003195349680000034
为ρ1的一阶导数，
Figure BDA0003195349680000035
为ρ2的一阶导数，
Figure BDA0003195349680000036
为ρ3的一阶导数，k11表示无人艇在纵向方向的虚拟控制器的第一设计参数，k12表示无人艇在纵向方向的虚拟控制器的第二设计参数，k21表示无人艇在横向方向的虚拟控制器的第一设计参数，k22表示无人艇在横向方向的虚拟控制器的第二设计参数，k31表示无人艇在艏向角方向的虚拟控制器的第一设计参数，k32表示无人艇在艏向角方向的虚拟控制器的第二设计参数；l表示跟踪误差收敛指数，0＜l＜1；z1表示无人艇在大地坐标系中沿地球纬线方向的跟踪误差，z2表示无人艇在大地坐标系中沿地球经线方向的跟踪误差，z3表示无人艇在大地坐标系中沿地球艏向方向的跟踪误差，ρ1表示z1的界限函数，ρ2表示z2的界限函数，ρ3表示z3的界限函数，s1表示转换后纵向方向的非约束跟踪误差，s2表示转换后横向方向的非约束跟踪误差，s3表示转换后艏向角方向的非约束跟踪误差，κ1表示无人艇在纵向上的跟踪误差辅助函数，κ2表示无人艇在横向上的跟踪误差辅助函数，κ3表示无人艇在艏向上的跟踪误差辅助函数，sig(s1)表示s1的符号与s1的绝对值的乘积，sig(s2)表示s2的符号与s2的绝对值的乘积，sig(s3)表示s3的符号与s3的绝对值的乘积。
可选的，由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差，具体包括：
将所述虚拟控制率输入一阶低通滤波器，得到滤波控制率；
由所述滤波控制率和所述实际位置信息计算虚拟误差面；所述虚拟误差面包括纵向虚拟误差、横向虚拟误差和艏向角虚拟误差；
由所述滤波控制率和所述虚拟控制率计算滤波误差；所述滤波误差包括纵向滤波误差、横向滤波误差和艏向角滤波误差。
可选的，所述无人艇模型为：
Figure BDA0003195349680000041
Figure BDA0003195349680000042
Figure BDA0003195349680000043
其中，
Figure BDA0003195349680000044
为纵向未知时变项目估计值，
Figure BDA0003195349680000045
为横向未知时变项目估计值，
Figure BDA0003195349680000046
为艏向角未知时变项目估计值，
Figure BDA0003195349680000047
为纵向权重向量估计值，
Figure BDA0003195349680000048
为横向权重向量估计值，
Figure BDA0003195349680000049
为艏向角权重向量估计值，Θu为纵向径向基函数向量，Θv为横向径向基函数向量，Θr为艏向角径向基函数向量。
可选的，所述复合干扰估计值为：
Figure BDA00031953496800000410
Figure BDA00031953496800000411
Figure BDA00031953496800000412
其中，
Figure BDA00031953496800000413
为纵向复合干扰估计值，
Figure BDA00031953496800000414
为横向复合干扰估计值，
Figure BDA00031953496800000415
为艏向角复合干扰估计值，
Figure BDA00031953496800000416
为纵向辅助变量估计值，
Figure BDA00031953496800000417
为横向辅助变量估计值，
Figure BDA00031953496800000418
为艏向角辅助变量估计值，ηu为干扰观测器的横向参数，ηv为干扰观测器的纵向参数，ηr为干扰观测器的艏向角参数，u为船体坐标系下的纵向速度，v为船体坐标系下的横向速度，r为船体坐标系下的艏向角速度。
可选的，所述跟踪控制率为：
Figure BDA00031953496800000419
Figure BDA0003195349680000051
Figure BDA0003195349680000052
其中，
Figure BDA0003195349680000053
为纵向跟踪控制率，
Figure BDA0003195349680000054
为横向跟踪控制率，
Figure BDA0003195349680000055
为艏向角跟踪控制率，s4为纵向虚拟误差，s5为横向虚拟误差，s6为艏向角虚拟误差，
Figure BDA0003195349680000056
为纵向未知时变项目估计值，
Figure BDA0003195349680000057
为横向未知时变项目估计值，
Figure BDA0003195349680000058
为艏向角未知时变项目估计值，
Figure BDA0003195349680000059
为纵向复合干扰估计值，
Figure BDA00031953496800000510
为横向复合干扰估计值，
Figure BDA00031953496800000511
为艏向角复合干扰估计值，zu为纵向滤波误差，zv为横向滤波误差，zr为艏向角滤波误差，m11表示无人艇沿纵向方向的固有质量，m22表示无人艇沿横向方向的固有质量，m33表示无人艇沿艏向角方向的固有质量；k41表示无人艇在纵向方向的跟踪控制器的第一设计参数，k42表示无人艇在纵向方向的跟踪控制器的第二设计参数，k51表示是无人艇在横向方向的跟踪控制器的第一设计参数，k52表示无人艇在横向方向的跟踪控制器的第二设计参数，k61表示是无人艇在艏向角方向的跟踪控制器的第一设计参数，k62表示是无人艇在艏向角方向的跟踪控制器的第二设计参数；
Figure BDA00031953496800000512
表示无人艇在纵向方向的跟踪控制器的触发阀值，
Figure BDA00031953496800000513
表示无人艇在横向方向的跟踪控制器的触发阀值，
Figure BDA00031953496800000514
表示无人艇在艏向角方向的跟踪控制器的触发阀值；ρu表示无人艇在纵向方向的跟踪控制器的触发调节系数，ρv表示无人艇在横向方向的跟踪控制器的触发调节系数，ρr表示无人艇在艏向角方向的跟踪控制器的触发调节系数，λ1表示无人艇在纵向方向的低通滤波器的设计参数，λ2表示无人艇在横向方向的低通滤波器的设计参数，λ3表示在艏向角方向的低通滤波器的设计参数，sig(s4)表示s4的符号与s4的绝对值的乘积，sig(s5)表示s5的符号与s5的绝对值的乘积，sig(s6)表示s6的符号与s6的绝对值的乘积。
本发明还提供了一种无人艇跟踪控制系统，包括：
信息获取模块，用于获取无人艇的实际位置信息和期望位置信息；
误差计算模块，用于基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差；
滤波模块，用于由所述实际位置信息、所述期望位置信息和所述非约束跟踪误差计算虚拟控制率，并由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差；
模型估计模块，用于采用径向基神经网络估计未知时变项目，得到无人艇模型；所述未知时变项目包括水动力阻尼参数、科氏加速度和向心加速度；
干扰估计模块，用于基于所述无人艇模型，对复合干扰进行估计，得到复合干扰估计值；所述复合干扰包括所述无人艇模型的估计误差和外界干扰；
轨迹跟踪控制模块，用于由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率；所述跟踪控制率用于控制无人艇的轨迹跟踪。
与现有技术相比，本发明的有益效果是：
本发明实施例提出了一种无人艇跟踪控制方法及系统，基于实际位置信息和期望位置信息，采用预设性能函数计算非约束跟踪误差，使无人艇的跟踪误差一直保持在预设的范围内，无人艇的跟踪精度得到限制，无人艇能够精准的跟上期望轨迹；采用径向基神经网络估计水动力阻尼参数、科氏加速度和向心加速度，得到的无人艇模型，考虑了模型的不确定性；基于无人艇模型，对估计误差和外界干扰构成的复合干扰进行估计，得到复合干扰估计值，考虑干扰情况；由虚拟误差面、滤波误差、无人艇模型和复合干扰估计值确定跟踪控制率，该跟踪控制率在无人艇轨迹跟踪时具有抵抗模型参数不确定和外界干扰的能力，因此，采用本发明的方法或系统，能提高无人艇跟踪控制的精度。此外，针对某些对时间有要求的任务，采用发明的方法或系统确定的跟踪控制率可以使无人艇在有限的时间内完成跟踪任务。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的无人艇跟踪控制方法的流程图；
图2为无人艇平面模型示意图；
图3为无人艇跟踪控制方法的控制过程示意图；
图4为无人艇轨迹跟踪示意图；
图5为无人艇跟踪误差示意图；
图6为控制输入对比示意图；
图7为控制器的触发时刻示意图；
图8为复合干扰和干扰观测器估计值对比示意图；
图9为本发明实施例提供的无人艇跟踪控制系统的结构图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。
图1为本发明实施例提供的无人艇跟踪控制方法的流程图。参见图1，本实施例的无人艇跟踪控制方法，包括：
步骤101：获取无人艇的实际位置信息和期望位置信息。
所述实际位置信息包括大地坐标系下的位置坐标、大地坐标系下的艏向角坐标、船体坐标系下的纵向速度、船体坐标系下的横向速度和船体坐标系下的艏向角速度。
所述期望位置信息包括大地坐标系下的期望位置坐标、大地坐标系下的期望艏向角坐标、船体坐标系下的期望纵向速度、船体坐标系下的期望横向速度和船体坐标系下的期望艏向角速度。
步骤102：基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差。
步骤102，具体包括：
(1)采用所述实际位置信息建立无人艇动力学模型。无人艇动力学模型为
Figure BDA0003195349680000081
Figure BDA0003195349680000082
其中η＝[x,y,ψ]T，(x,y)和ψ是大地坐标系下的位置坐标和艏向角坐标，
Figure BDA0003195349680000083
为η的一阶导数；ν＝[u,v,r]T，u、v和r分别代表了无人艇船体坐标系下的纵向速度、横向速度和艏向角速度，
Figure BDA0003195349680000084
为ν的一阶导数，如图2所示。图2中，OE表示大地坐标系的原点，XE和YE分别表示地球纬线方向和经线方向；Ob表示船体坐标系的原点，G(Ob)表示船体坐标系，Xb和Yb分别表示无人艇纵向方向和垂直于纵向的横向方向；Fu表示在船体坐标系中的纵向方向的控制输入。横向方向的控制输入和艏向方向的控制输入分别为Fv和Fr，Tr表示无人艇跟踪系统会在跟踪到期望轨迹的时间。
d＝[du,dv,dr]T代表时变外界干扰，例如风、浪、流等；τ＝[τu,τv,τr]T是无人艇的控制输入向量，τu、τv和τr分别为纵向力、横向力和艏向角扭矩。
Figure BDA0003195349680000085
为旋转矩阵；
Figure BDA0003195349680000086
为惯性矩阵；
Figure BDA0003195349680000087
为科氏加速度和向心加速度矩阵；
Figure BDA0003195349680000088
为水动力阻尼矩阵。
(2)采用所述期望位置信息计算期望轨迹。期望轨迹为
Figure BDA0003195349680000089
其中ηd＝[xd,yd,ψd]T，xd、yd和ψd是无人艇在大地坐标系下的期望位置坐标和艏向角坐标，vd＝[ud,vd,rd]T，ud、vd和rd是无人艇船体坐标系下的期望纵向速度、期望横向速度和期望艏向角速度。
(3)由所述无人艇动力学模型和所述期望轨迹计算跟踪误差。具体为：
假设无人艇的跟踪误差为：z＝η-ηd＝[z1,z2,z3]T＝[x-xd,y-yd,ψ-ψd]T。
(4)采用预设性能函数将所述跟踪误差转换为所述非约束跟踪误差。
本实施例对无人艇的跟踪误差要满足如下约束：
-ρi(t)＜zi(t)＜ρi(t),i＝1,2,3；
其中，ρi(t)为预设性能函数，该函数为预先设定以指数形式衰减的界限函数，其形式如下所示：
ρi(t)＝(ρi0-ρi∞)exp(-wit)+ρi∞,i＝1,2,3；
其中ρi0和ρi∞为预设性能函数的初始值和稳定值，wi为预设收敛率，该函数可以调整无人艇跟踪误差的暂态和稳态精度，从而提高无人艇的跟踪精度。
控制器将无人艇的跟踪误差(受限跟踪误差)转换为非约束跟踪误差(非受限跟踪误差)，如下所示：
zi＝ρi(t)Υ(si(t))，t＞0，i＝1,2,3,；
其中，si(t)是转换后得到的非约束跟踪误差，Υ(si(t))为严格递增函数，其形式如下：
Figure BDA0003195349680000091
其中Υi＝Υ(si(t))。如无说明，本实施例中Υi＝Υ(si(t))。
如果该非约束跟踪误差有界，则跟踪误差就保持在预设界限内。
步骤103：由所述实际位置信息、所述期望位置信息和所述非约束跟踪误差计算虚拟控制率，并由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差。具体为：
(1)控制器通过位置传感器获得的无人艇的位置信息、期望位置信息和控制器处理后的非约束跟踪误差，通过跟踪误差反馈设计出如下虚拟控制率：
Figure BDA0003195349680000092
Figure BDA0003195349680000093
Figure BDA0003195349680000094
其中，uα为纵向虚拟控制率，vα为横向虚拟控制率，rα为艏向角虚拟控制率，l为正的虚拟控制率设计参数，ψ为大地坐标系下的艏向角坐标，ψd为大地坐标系下的期望艏向角坐标，ud为船体坐标系下的期望纵向速度，vd船体坐标系下的期望横向速度，rd为船体坐标系下的期望艏向角速度，
Figure BDA0003195349680000101
为ρ1的一阶导数，
Figure BDA0003195349680000102
为ρ2的一阶导数，
Figure BDA0003195349680000103
为ρ3的一阶导数。
其中
Figure BDA0003195349680000104
κ1，κ2，κ3分别表示无人艇在纵向，横向和艏向上的跟踪误差辅助函数。k11、k12、k21、k22、k31、k32和l均为正的虚拟控制器设计参数。k11表示无人艇在纵向方向的虚拟控制器的第一设计参数，k12表示无人艇在纵向方向的虚拟控制器的第二设计参数，k21表示无人艇在横向方向的虚拟控制器的第一设计参数，k22表示无人艇在横向方向的虚拟控制器的第二设计参数，k31表示无人艇在艏向角方向的虚拟控制器的第一设计参数，k32表示无人艇在艏向角方向的虚拟控制器的第二设计参数；l表示跟踪误差收敛指数，0＜l＜1，l表征跟踪误差收敛速度；z1表示无人艇在大地坐标系中沿地球纬线方向的跟踪误差，z2表示无人艇在大地坐标系中沿地球经线方向的跟踪误差，z3表示无人艇在大地坐标系中沿地球艏向方向的跟踪误差，ρ1表示z1的界限函数，ρ2表示z2的界限函数，ρ3表示z3的界限函数，ρ1、ρ2和ρ3用于约束跟踪误差在指数递减边界内，sig(g)表示函数g的符号与其绝对值乘积，即sig(g)＝sign(g)*|g|，sign(·)表示符号函数，g为任意函数。si(t)是转换后得到的非约束跟踪误差，s1表示转换后纵向方向的非约束跟踪误差，s2表示转换后横向方向的非约束跟踪误差，s3表示转换后艏向角方向的非约束跟踪误差。该虚拟控制率可以使无人艇在有限时间内跟踪上期望轨迹。
(2)将所述虚拟控制率输入一阶低通滤波器，得到滤波控制率。具体的：
由于在设计实际控制器之前，控制器需要对虚拟控制率求导，而通常情况下虚拟控制率求导运算计算量较大，因此本实施例引入一阶低通滤波器，将虚拟控制率通过一阶低通滤波器，其输出值即是虚拟控制率导数的估计值。一阶低通滤波器形式如下：
Figure BDA0003195349680000111
Figure BDA0003195349680000112
Figure BDA0003195349680000113
其中，λ1表示无人艇在纵向方向的低通滤波器的设计参数，λ2表示无人艇在横向方向的低通滤波器的设计参数，λ3表示在艏向角方向的低通滤波器的设计参数，λ1、λ2和λ3均为正的设计参数。uf、vf和rf是将虚拟控制率uα、vα和rα通过一阶低通滤波器后得到滤波控制率，uf为纵向滤波控制率，vf为横向滤波控制率，rf为艏向角滤波控制率，
Figure BDA0003195349680000114
为uf的一阶导数，
Figure BDA0003195349680000115
为vf的一阶导数，
Figure BDA0003195349680000116
为rf的一阶导数，uα(0)表示纵向虚拟控制率的初始值，vα(0)表示横向虚拟控制率的初始值，rα(0)表示艏向角虚拟控制率的初始值；uf(0)表示纵向滤波控制率的初始值，vf(0)表示横向滤波控制率的初始值，rf(0)表示艏向角滤波控制率的初始值。
(3)由所述滤波控制率和所述实际位置信息计算虚拟误差面；所述虚拟误差面包括纵向虚拟误差、横向虚拟误差和艏向角虚拟误差。由所述滤波控制率和所述虚拟控制率计算滤波误差；所述滤波误差包括纵向滤波误差、横向滤波误差和艏向角滤波误差。具体的：
同时将无人艇的实际速度与滤波控制率相减获得虚拟误差，将滤波控制率和虚拟控制率相减得滤波误差，如下式所示：
s4＝u-uf,s5＝v-vf,s6＝r-rf,
zu＝uf-uα,zv＝vf-vα,zr＝rf-rα。
其中s4、s5、s6构成虚拟误差面，s4为纵向虚拟误差，s5为横向虚拟误差，s6为艏向角虚拟误差；zu为纵向滤波误差，zv为横向滤波误差，zr为艏向角滤波误差。
步骤104：采用径向基神经网络估计未知时变项目，得到无人艇模型；所述未知时变项目包括水动力阻尼参数、科氏加速度和向心加速度。
步骤104，具体包括：
在实际工作中，无人艇的水动力阻尼参数和科氏加速度、向心加速度往往很难测量，故本实施例利用径向基神经网络在线估计出系统包括水动力阻尼参数和科式加速度在内的不确定项。
无人艇的不确定项如下：
Figure BDA0003195349680000121
其中，
Figure BDA0003195349680000122
为未知时变项目，本实施例利用径向基神经网络在线估计出来这一项，从而完成无人艇的跟踪控制，其神经网络表示形式如下：
Figure BDA0003195349680000123
其中，
Figure BDA0003195349680000124
为最优权重向量，Θj(v)＝[θ1(v),...,θn(v)]T为径向基函数向量，θi(v)，i＝1,...,n为高斯径向基函数，其形式如下：
Figure BDA0003195349680000125
其中，v＝[u,v,r]T为神经网络的输入向量，
Figure BDA0003195349680000126
和
Figure BDA0003195349680000127
为径向基神经网络的中心和宽度。
通过径向基神经网络，所述无人艇模型为：
Figure BDA0003195349680000128
Figure BDA0003195349680000129
Figure BDA00031953496800001210
其中，
Figure BDA00031953496800001211
为纵向未知时变项目估计值，
Figure BDA00031953496800001212
为横向未知时变项目估计值，
Figure BDA00031953496800001213
为艏向角未知时变项目估计值，
Figure BDA00031953496800001214
为纵向权重向量估计值，
Figure BDA00031953496800001215
为横向权重向量估计值，
Figure BDA00031953496800001216
为艏向角权重向量估计值，Θu为纵向径向基函数向量，Θv为横向径向基函数向量，Θr为艏向角径向基函数向量。
由此，步骤102中的无人艇动力学模型可以描述如下：
Figure BDA00031953496800001217
Figure BDA00031953496800001218
Figure BDA00031953496800001219
其中
Figure BDA00031953496800001220
为径向基神经网络权重估计误差，
Figure BDA00031953496800001221
步骤105：基于所述无人艇模型，对复合干扰进行估计，得到复合干扰估计值；所述复合干扰包括所述无人艇模型的估计误差和外界干扰。
步骤105，具体包括：
由于径向基神经网络对无人艇模型估计存在误差δj，j＝u,v,r，并且无人艇受到海洋中的风浪涌等干扰，故本实施例将模型估计误差和外界干扰综合考虑作为符合干扰，即：Dj＝dj/mjj+δj，j＝u,v,r。然后将神经网络估计的无人艇模型
Figure BDA0003195349680000131
无人艇的实际速度、控制输入等信号输入到干扰观测器中获得对复合干扰的估计值。
首先，引入辅助变量ξj，j＝u,v,r，定义如下：
Figure BDA0003195349680000132
ηj为干扰观测器设计参数。
对辅助变量求导可得如下式子：
Figure BDA0003195349680000133
Figure BDA0003195349680000134
Figure BDA0003195349680000135
对辅助变量进行如下估计：
Figure BDA0003195349680000136
Figure BDA0003195349680000137
Figure BDA0003195349680000138
其中，
Figure BDA0003195349680000139
为ξj的估计值。复合干扰的估计值可以设计如下：
Figure BDA00031953496800001310
Figure BDA00031953496800001311
Figure BDA00031953496800001312
其中，
Figure BDA00031953496800001313
为纵向复合干扰估计值，
Figure BDA00031953496800001314
为横向复合干扰估计值，
Figure BDA00031953496800001315
为艏向角复合干扰估计值，
Figure BDA00031953496800001316
为纵向辅助变量估计值，
Figure BDA00031953496800001317
为横向辅助变量估计值，
Figure BDA00031953496800001318
为艏向角辅助变量估计值，ηu为干扰观测器的横向参数，ηv为干扰观测器的纵向参数，ηr为干扰观测器的艏向角参数，u为船体坐标系下的纵向速度，v为船体坐标系下的横向速度，r为船体坐标系下的艏向角速度。
步骤106：由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率；所述跟踪控制率用于控制无人艇的轨迹跟踪。
所述跟踪控制率为：
Figure BDA0003195349680000141
Figure BDA0003195349680000142
Figure BDA0003195349680000143
其中，
Figure BDA0003195349680000144
为纵向跟踪控制率，
Figure BDA0003195349680000145
为横向跟踪控制率，
Figure BDA0003195349680000146
为艏向角跟踪控制率，s4为纵向虚拟误差，s5为横向虚拟误差，s6为艏向角虚拟误差，
Figure BDA0003195349680000147
为纵向未知时变项目估计值，
Figure BDA0003195349680000148
为横向未知时变项目估计值，
Figure BDA0003195349680000149
为艏向角未知时变项目估计值，
Figure BDA00031953496800001410
为纵向复合干扰估计值，
Figure BDA00031953496800001411
为横向复合干扰估计值，
Figure BDA00031953496800001412
为艏向角复合干扰估计值，zu为纵向滤波误差，zv为横向滤波误差，zr为艏向角滤波误差，k41、k42、k51、k52、k61和k62均为正的设计参数。m11表示无人艇沿纵向方向的固有质量，m22表示无人艇沿横向方向的固有质量，m33表示无人艇沿艏向角方向的固有质量；k41表示无人艇在纵向方向的跟踪控制器的第一设计参数，k42表示无人艇在纵向方向的跟踪控制器的第二设计参数，k51表示是无人艇在横向方向的跟踪控制器的第一设计参数，k52表示无人艇在横向方向的跟踪控制器的第二设计参数，k61表示是无人艇在艏向角方向的跟踪控制器的第一设计参数，k62表示是无人艇在艏向角方向的跟踪控制器的第二设计参数；
Figure BDA00031953496800001413
表示无人艇在纵向方向的跟踪控制器的触发阀值，
Figure BDA00031953496800001414
表示无人艇在横向方向的跟踪控制器的触发阀值，
Figure BDA00031953496800001415
表示无人艇在艏向角方向的跟踪控制器的触发阀值；ρu表示无人艇在纵向方向的跟踪控制器的触发调节系数，ρv表示无人艇在横向方向的跟踪控制器的触发调节系数，ρr表示无人艇在艏向角方向的跟踪控制器的触发调节系数，λ1表示无人艇在纵向方向的低通滤波器的设计参数，λ2表示无人艇在横向方向的低通滤波器的设计参数，λ3表示在艏向角方向的低通滤波器的设计参数，sig(s4)表示s4的符号与s4的绝对值的乘积，sig(s5)表示s5的符号与s5的绝对值的乘积，sig(s6)表示s6的符号与s6的绝对值的乘积。
在步骤106之后，还包括：
计算当前时刻的跟踪控制率与上一时刻的跟踪控制率的差值；判断所述差值是否大于设定值；若是，则控制执行器以所述当前时刻的跟踪控制率控制无人艇的轨迹跟踪；若否，则保持上一时刻的跟踪控制率。该步骤，具体包括：
建立事件触发机制。利用上一触发时刻控制器输出的跟踪控制率
Figure BDA0003195349680000151
Figure BDA0003195349680000152
和当前时刻控制器计算所得跟踪控制率ατ(t)差值来判断此刻是否触发控制器。其形式如下：
Figure BDA0003195349680000153
Figure BDA0003195349680000154
控制器向执行器传递的实际跟踪控制率如下：
Figure BDA0003195349680000155
Figure BDA0003195349680000156
Figure BDA0003195349680000157
其中
Figure BDA0003195349680000158
为三个方向控制器的触发阈值。τj(t)，j＝u,v,r是控制器实际输出的跟踪控制率。
控制器在每一个时刻通过传感器得到的数据计算出有限时间跟踪控制率，并将其存在零阶保持器里面。控制器将该时刻计算的控制率与上一个触发时刻的控制率相比较，当该时刻的控制率ατ(t)减去上一触发时刻控制率
Figure BDA0003195349680000159
的绝对值|ej(t)|大于某一个常值mj时，控制器与执行器之间的信道开启，控制率从控制器传递给执行器，从而执行器进行工作，使无人艇完成跟踪任务。无人艇跟踪系统会在Tr时间内跟踪到期望轨迹，系统内各误差信号都保持在ΩV内，并且跟踪误差失踪保持在有界函数ρi(t)，i＝1,2,3内。其中Tr和ΩV通过下面两式可得：
Figure BDA00031953496800001510
Figure BDA0003195349680000161
式中，0＜θ0＜1；
Figure BDA0003195349680000162
Figure BDA0003195349680000163
Figure BDA0003195349680000164
其中，a是低通滤波器的滤波误差引起的微小的常值；
Figure BDA0003195349680000165
分别是纵向，横向和艏向方向上的滤波器误差上界值；DuM，DvM，DrM分别是无人艇在纵向，横向和艏向上受到的未知干扰的上界值；λu，λv，λr分别是纵向，横向和艏向方向上神经网络权重更新的设计参数；
Figure BDA0003195349680000166
分别是神经网络在无人艇纵向，横向和艏向上动力估计的最佳权值，χ(t)表示包含无人艇控制系统中所有误差信号的向量，
Figure BDA0003195349680000167
χ(0)是χ(t)的初始值；
Figure BDA0003195349680000168
是常数对称矩阵。
对Lyapunov函数V求导，并带入本实施例提出的控制率和自适应率中，通过不等式处理可得如下函数：
Figure BDA0003195349680000171
式中，C1为Lyapunov函数V的一次项系数，C2为Lyapunov函数V的l次项系数，Λ为Lyapunov函数V的常数项。
上述无人艇跟踪控制方法的控制过程如图3所示。图3显示了无人艇的控制系统。无人艇通过传感器获得无人艇的位置、姿态信息以及速度信息，根据预设轨迹计算出虚拟速度，将虚拟速度通过一阶低通滤波器，并通过神经网络和干扰观测器计算出无人艇的未知模型和所受干扰。控制器根据相关信息计算出无人艇跟踪预设轨迹所需的控制率，并放入零阶保持器，根据触发条件向执行器传输控制信号。
下面提供了一个具体实例。
利用Cyber-ship II的参数，期望轨迹选择如下：
0s≤t≤9s；[ud,vd,rd]＝[3,0,0]；9s＜t≤30s；[ud,vd,rd]＝[3,0,0.3]。
外界扰动选择如下：
Figure BDA0003195349680000172
预设性能函数选择如下：
ρ1(t)＝(1-0.1)exp(-2t)+0.1；
ρ2(t)＝(1-0.1)exp(-2t)+0.1；
ρ3(t)＝(1-0.2)exp(-2t)+0.2。
径向基神经网络的输入是v＝[u,v,r]T。隐藏层选择7个节点，高斯函数的中心分布在[0,3]×[0,1.2]×[-0.2,1.2]上，高斯函数的宽度选择为10。无人艇的初始位置选择为x(0)＝-0.5，y(0)＝-0.5，ψ(0)＝0。控制器增益选择为：k11＝5，k12＝5，k21＝4，k22＝4，k31＝9，k32＝9，k41＝3.5，k42＝3.5，k51＝6.2，k52＝6.2，k61＝9，k62＝9。事件触发的固定阀值及相应参数选择为：mu＝8，mv＝0.5，mr＝2；hu＝2，hv＝1，hr＝2；ρu＝2，ρv＝1，ρr＝2。
图4显示事件触发控制和时间触发控制下的无人艇轨迹跟踪情况。从图4中可以看出，两种控制方法都能使得无人艇跟踪预设轨迹上，事件触发控制器会比时间触发控制器使得无人艇的跟踪有较大的波动。
图5显示两种控制策略使无人艇在X向(纵向)、Y向(横向)和艏向角三个方向上的跟踪误差。从图5中可以看出两种控制器都可以使无人艇的跟踪误差收敛到零的小邻域内，并且失踪保持在预设边界ρi，i＝1,2,3内。但是从图5中可以看出，事件触发控制器比时间触发控制器有较大波动。
图6的(a)-(c)部分显示三个方向的控制输入，分别为在船体坐标系中的纵向方向的控制输入、横向方向的控制输入和艏向方向的控制输入。图7的(a)-(c)部分显示三个方向的触发情况，分别为在船体坐标系中的纵向方向的触发情况、横向方向的触发情况和艏向方向的触发情况。从图7可以看出在本实施例设计的事件触发控制器作用下，执行器的工作次数少于时间触发控制器作用下执行器的工作次数。通过计算，在本实施例设计的控制器作用下，三个执行器在30s内工作的次数分别是3420次、1595次和4419次，执行器未触发次数分别是6580次、8405次和5581次。所以可以得出，本实施例所设计的控制器在保证控制精度的情况下能减少执行器的工作次数，从而降低执行器的磨损和消耗，并且降低了控制器到执行器之间信道的通信负担。
图8显示本实施例设计的复合干扰观测器对外界干扰和神经网络估计误差复合误差的估计效果，其中图8的(a)-(c)部分分别显示在船体坐标系中的纵向方向的干扰实际值与估计值对比、横向方向的干扰实际值与估计值的对比和艏向方向的干扰实际值与估计值的对比。从图8中可以看出，本实施例设计的控制器对复合干扰具有良好的估计效果。
本实施例的无人艇跟踪控制方法，具有如下优点：
针对无人艇精准跟踪，本实施例利用预设性能函数使无人艇的跟踪误差一直保持在预设的范围内，无人艇的跟踪精度得到限制，无人艇能够精准的跟上期望轨迹。从而能更好的完成一些任务，如精准测量测绘，狭窄海道通行，精确的目标跟踪等。
针对无人艇动力学模型中的不确定参数，如水动力阻尼系数，科氏加速度，向心加速度，以及参数摄动等通过径向基神经网络进行估计，从而在控制器设计中进行补偿。
针对海洋中的风浪流等干扰和径向基神经网络对参数估计中产生的估计误差，本实施例设计了非现行干扰观测器对这两者组成的复合干扰进行在线估计，并在控制器中得到补偿，从而使无人艇跟踪具有抵抗模型参数不确定和外界干扰的能力。
针对某些对时间有要求的任务，本实施例设计的控制率可以使无人艇能在有限的时间内完成跟踪任务。
针对控制器和执行器之间的信号传递负担的问题，本实施例利用事件触发机制对控制率信号的传递进行了限制，减少控制器对执行器的控制频率，从而使得控制器在较少的执行次数的同时，无人艇依旧能够精准的跟踪轨迹。
本发明还提供了一种无人艇跟踪控制系统，图9为本发明实施例提供的无人艇跟踪控制系统的结构图。
参见图9，本实施例的系统包括：
信息获取模块201，用于获取无人艇的实际位置信息和期望位置信息。
误差计算模块202，用于基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差。
滤波模块203，用于由所述实际位置信息、所述期望位置信息和所述非约束跟踪误差计算虚拟控制率，并由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差。
模型估计模块204，用于采用径向基神经网络估计未知时变项目，得到无人艇模型；所述未知时变项目包括水动力阻尼参数、科氏加速度和向心加速度。
干扰估计模块205，用于基于所述无人艇模型，对复合干扰进行估计，得到复合干扰估计值；所述复合干扰包括所述无人艇模型的估计误差和外界干扰。
轨迹跟踪控制模块206，用于由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率；所述跟踪控制率用于控制无人艇的轨迹跟踪。
本说明书中各个实施例采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言，由于其与实施例公开的方法相对应，所以描述的比较简单，相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处。综上所述，本说明书内容不应理解为对本发明的限制。

Claims (10)

1.一种无人艇跟踪控制方法，其特征在于，包括：
获取无人艇的实际位置信息和期望位置信息；
基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差；
由所述实际位置信息、所述期望位置信息和所述非约束跟踪误差计算虚拟控制率，并由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差；
采用径向基神经网络估计未知时变项目，得到无人艇模型；所述未知时变项目包括水动力阻尼参数、科氏加速度和向心加速度；
基于所述无人艇模型，对复合干扰进行估计，得到复合干扰估计值；所述复合干扰包括所述无人艇模型的估计误差和外界干扰；
由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率；所述跟踪控制率用于控制无人艇的轨迹跟踪。
2.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，在所述由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率之后，还包括：
计算当前时刻的跟踪控制率与上一时刻的跟踪控制率的差值；
判断所述差值是否大于设定值；
若是，则控制执行器以所述当前时刻的跟踪控制率控制无人艇的轨迹跟踪；
若否，则保持上一时刻的跟踪控制率。
3.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，
所述实际位置信息包括大地坐标系下的位置坐标、大地坐标系下的艏向角坐标、船体坐标系下的纵向速度、船体坐标系下的横向速度和船体坐标系下的艏向角速度；
所述期望位置信息包括大地坐标系下的期望位置坐标、大地坐标系下的期望艏向角坐标、船体坐标系下的期望纵向速度、船体坐标系下的期望横向速度和船体坐标系下的期望艏向角速度。
4.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，所述基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差，具体包括：
采用所述实际位置信息建立无人艇动力学模型；
采用所述期望位置信息计算期望轨迹；
由所述无人艇动力学模型和所述期望轨迹计算跟踪误差；
采用预设性能函数将所述跟踪误差转换为所述非约束跟踪误差。
5.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，所述虚拟控制率为：
Figure FDA0003195349670000021
Figure FDA0003195349670000022
Figure FDA0003195349670000023
其中，uα为纵向虚拟控制率，vα为横向虚拟控制率，rα为艏向角虚拟控制率，ψ为大地坐标系下的艏向角坐标，ψd为大地坐标系下的期望艏向角坐标，ud为船体坐标系下的期望纵向速度，vd船体坐标系下的期望横向速度，rd为船体坐标系下的期望艏向角速度，
Figure FDA0003195349670000024
为ρ1的一阶导数，
Figure FDA0003195349670000025
为ρ2的一阶导数，
Figure FDA0003195349670000026
为ρ3的一阶导数，k11表示无人艇在纵向方向的虚拟控制器的第一设计参数，k12表示无人艇在纵向方向的虚拟控制器的第二设计参数，k21表示无人艇在横向方向的虚拟控制器的第一设计参数，k22表示无人艇在横向方向的虚拟控制器的第二设计参数，k31表示无人艇在艏向角方向的虚拟控制器的第一设计参数，k32表示无人艇在艏向角方向的虚拟控制器的第二设计参数；l表示跟踪误差收敛指数，0＜l＜1；z1表示无人艇在大地坐标系中沿地球纬线方向的跟踪误差，z2表示无人艇在大地坐标系中沿地球经线方向的跟踪误差，z3表示无人艇在大地坐标系中沿地球艏向方向的跟踪误差，ρ1表示z1的界限函数，ρ2表示z2的界限函数，ρ3表示z3的界限函数，s1表示转换后纵向方向的非约束跟踪误差，s2表示转换后横向方向的非约束跟踪误差，s3表示转换后艏向角方向的非约束跟踪误差，κ1表示无人艇在纵向上的跟踪误差辅助函数，κ2表示无人艇在横向上的跟踪误差辅助函数，κ3表示无人艇在艏向上的跟踪误差辅助函数，sig(s1)表示s1的符号与s1的绝对值的乘积，sig(s2)表示s2的符号与s2的绝对值的乘积，sig(s3)表示s3的符号与s3的绝对值的乘积。
6.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差，具体包括：
将所述虚拟控制率输入一阶低通滤波器，得到滤波控制率；
由所述滤波控制率和所述实际位置信息计算虚拟误差面；所述虚拟误差面包括纵向虚拟误差、横向虚拟误差和艏向角虚拟误差；
由所述滤波控制率和所述虚拟控制率计算滤波误差；所述滤波误差包括纵向滤波误差、横向滤波误差和艏向角滤波误差。
7.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，所述无人艇模型为：
Figure FDA0003195349670000031
Figure FDA0003195349670000032
Figure FDA0003195349670000033
其中，
Figure FDA0003195349670000034
为纵向未知时变项目估计值，
Figure FDA0003195349670000035
为横向未知时变项目估计值，
Figure FDA0003195349670000036
为艏向角未知时变项目估计值，
Figure FDA0003195349670000037
为纵向权重向量估计值，
Figure FDA0003195349670000038
为横向权重向量估计值，
Figure FDA0003195349670000039
为艏向角权重向量估计值，Θu为纵向径向基函数向量，Θv为横向径向基函数向量，Θr为艏向角径向基函数向量。
8.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，所述复合干扰估计值为：
Figure FDA00031953496700000310
Figure FDA0003195349670000041
Figure FDA0003195349670000042
其中，
Figure FDA0003195349670000043
为纵向复合干扰估计值，
Figure FDA0003195349670000044
为横向复合干扰估计值，
Figure FDA0003195349670000045
为艏向角复合干扰估计值，
Figure FDA0003195349670000046
为纵向辅助变量估计值，
Figure FDA0003195349670000047
为横向辅助变量估计值，
Figure FDA0003195349670000048
为艏向角辅助变量估计值，ηu为干扰观测器的横向参数，ηv为干扰观测器的纵向参数，ηr为干扰观测器的艏向角参数，u为船体坐标系下的纵向速度，v为船体坐标系下的横向速度，r为船体坐标系下的艏向角速度。
9.根据权利要求1所述的一种无人艇跟踪控制方法，其特征在于，所述跟踪控制率为：
Figure FDA0003195349670000049
Figure FDA00031953496700000410
Figure FDA00031953496700000411
其中，
Figure FDA00031953496700000412
为纵向跟踪控制率，
Figure FDA00031953496700000413
为横向跟踪控制率，
Figure FDA00031953496700000414
为艏向角跟踪控制率，s4为纵向虚拟误差，s5为横向虚拟误差，s6为艏向角虚拟误差，
Figure FDA00031953496700000415
为纵向未知时变项目估计值，
Figure FDA00031953496700000416
为横向未知时变项目估计值，
Figure FDA00031953496700000417
为艏向角未知时变项目估计值，
Figure FDA00031953496700000418
为纵向复合干扰估计值，
Figure FDA00031953496700000419
为横向复合干扰估计值，
Figure FDA00031953496700000420
为艏向角复合干扰估计值，zu为纵向滤波误差，zv为横向滤波误差，zr为艏向角滤波误差，m11表示无人艇沿纵向方向的固有质量，m22表示无人艇沿横向方向的固有质量，m33表示无人艇沿艏向角方向的固有质量；k41表示无人艇在纵向方向的跟踪控制器的第一设计参数，k42表示无人艇在纵向方向的跟踪控制器的第二设计参数，k51表示是无人艇在横向方向的跟踪控制器的第一设计参数，k52表示无人艇在横向方向的跟踪控制器的第二设计参数，k61表示是无人艇在艏向角方向的跟踪控制器的第一设计参数，k62表示是无人艇在艏向角方向的跟踪控制器的第二设计参数；
Figure FDA00031953496700000421
表示无人艇在纵向方向的跟踪控制器的触发阀值，
Figure FDA00031953496700000422
表示无人艇在横向方向的跟踪控制器的触发阀值，
Figure FDA00031953496700000423
表示无人艇在艏向角方向的跟踪控制器的触发阀值；ρu表示无人艇在纵向方向的跟踪控制器的触发调节系数，ρv表示无人艇在横向方向的跟踪控制器的触发调节系数，ρr表示无人艇在艏向角方向的跟踪控制器的触发调节系数，λ1表示无人艇在纵向方向的低通滤波器的设计参数，λ2表示无人艇在横向方向的低通滤波器的设计参数，λ3表示在艏向角方向的低通滤波器的设计参数，sig(s4)表示s4的符号与s4的绝对值的乘积，sig(s5)表示s5的符号与s5的绝对值的乘积，sig(s6)表示s6的符号与s6的绝对值的乘积。
10.一种无人艇跟踪控制系统，其特征在于，包括：
信息获取模块，用于获取无人艇的实际位置信息和期望位置信息；
误差计算模块，用于基于所述实际位置信息和所述期望位置信息，采用预设性能函数计算非约束跟踪误差；
滤波模块，用于由所述实际位置信息、所述期望位置信息和所述非约束跟踪误差计算虚拟控制率，并由所述虚拟控制率和一阶低通滤波器，得到虚拟误差面和滤波误差；
模型估计模块，用于采用径向基神经网络估计未知时变项目，得到无人艇模型；所述未知时变项目包括水动力阻尼参数、科氏加速度和向心加速度；
干扰估计模块，用于基于所述无人艇模型，对复合干扰进行估计，得到复合干扰估计值；所述复合干扰包括所述无人艇模型的估计误差和外界干扰；
轨迹跟踪控制模块，用于由所述虚拟误差面、所述滤波误差、所述无人艇模型和所述复合干扰估计值确定跟踪控制率；所述跟踪控制率用于控制无人艇的轨迹跟踪。
CN202110889686.4A 2021-08-04 2021-08-04 一种无人艇跟踪控制方法及系统 Active CN113608534B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110889686.4A CN113608534B (zh) 2021-08-04 2021-08-04 一种无人艇跟踪控制方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110889686.4A CN113608534B (zh) 2021-08-04 2021-08-04 一种无人艇跟踪控制方法及系统

Publications (2)

Publication Number Publication Date
CN113608534A true CN113608534A (zh) 2021-11-05
CN113608534B CN113608534B (zh) 2023-10-24

Family

ID=78339389

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110889686.4A Active CN113608534B (zh) 2021-08-04 2021-08-04 一种无人艇跟踪控制方法及系统

Country Status (1)

Country Link
CN (1) CN113608534B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115617044A (zh) * 2022-10-28 2023-01-17 华中科技大学 非奇异有限时间无人艇预设性能动力定位控制方法及系统
CN117260718A (zh) * 2023-09-21 2023-12-22 广东工业大学 一种四足机器人的自适应载荷补偿控制方法及系统
CN117369471A (zh) * 2023-11-06 2024-01-09 大连海事大学 一种具有预设性能的无人船数据驱动模糊航向控制方法
WO2024152478A1 (zh) * 2023-01-18 2024-07-25 重庆邮电大学工业互联网研究院 一种针对网络控制系统的基于预设性能的自适应反演滑模控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103760902A (zh) * 2014-01-14 2014-04-30 上海海事大学 一种基于模糊控制的无人水面艇直线路径跟踪方法
CN103955218A (zh) * 2014-04-28 2014-07-30 上海大学 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法
WO2015066964A1 (zh) * 2013-11-07 2015-05-14 哈尔滨工程大学 基于自适应模糊估计器的滤波反歩船舶运动控制系统
CN109808853A (zh) * 2019-03-05 2019-05-28 上海大学 一种无人艇艏向航速分级控制系统及其控制方法
KR20190107948A (ko) * 2018-03-13 2019-09-23 국방과학연구소 표적 추종 제어 장치
CN110377036A (zh) * 2019-07-09 2019-10-25 哈尔滨工程大学 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法
CN110618611A (zh) * 2019-10-23 2019-12-27 哈尔滨工程大学 一种基于回转率约束的无人艇轨迹跟踪安全控制方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015066964A1 (zh) * 2013-11-07 2015-05-14 哈尔滨工程大学 基于自适应模糊估计器的滤波反歩船舶运动控制系统
CN103760902A (zh) * 2014-01-14 2014-04-30 上海海事大学 一种基于模糊控制的无人水面艇直线路径跟踪方法
CN103955218A (zh) * 2014-04-28 2014-07-30 上海大学 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法
KR20190107948A (ko) * 2018-03-13 2019-09-23 국방과학연구소 표적 추종 제어 장치
CN109808853A (zh) * 2019-03-05 2019-05-28 上海大学 一种无人艇艏向航速分级控制系统及其控制方法
CN110377036A (zh) * 2019-07-09 2019-10-25 哈尔滨工程大学 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法
CN110618611A (zh) * 2019-10-23 2019-12-27 哈尔滨工程大学 一种基于回转率约束的无人艇轨迹跟踪安全控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
张昕;: "欠驱动水面无人艇轨迹跟踪的反步滑模控制", 数字技术与应用, no. 01, pages 180 - 183 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115617044A (zh) * 2022-10-28 2023-01-17 华中科技大学 非奇异有限时间无人艇预设性能动力定位控制方法及系统
WO2024152478A1 (zh) * 2023-01-18 2024-07-25 重庆邮电大学工业互联网研究院 一种针对网络控制系统的基于预设性能的自适应反演滑模控制方法
CN117260718A (zh) * 2023-09-21 2023-12-22 广东工业大学 一种四足机器人的自适应载荷补偿控制方法及系统
CN117369471A (zh) * 2023-11-06 2024-01-09 大连海事大学 一种具有预设性能的无人船数据驱动模糊航向控制方法
CN117369471B (zh) * 2023-11-06 2024-05-28 大连海事大学 一种具有预设性能的无人船数据驱动模糊航向控制方法

Also Published As

Publication number Publication date
CN113608534B (zh) 2023-10-24

Similar Documents

Publication Publication Date Title
CN113608534A (zh) 一种无人艇跟踪控制方法及系统
Fossen et al. Nonlinear output feedback control of dynamically positioned ships using vectorial observer backstepping
Do Global robust and adaptive output feedback dynamic positioning of surface ships
CN104898688B (zh) Uuv四自由度动力定位自适应抗扰滑模控制系统及控制方法
KR101706367B1 (ko) 과소작동기를 갖는 자율무인 이동체의 신경회로망 기반 결함포용 컨트롤 방법
CN105807789B (zh) 基于t-s模糊观测器补偿的uuv控制方法
CN107168312A (zh) 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法
CN113467231B (zh) 基于侧滑补偿ilos制导律的无人艇路径跟踪方法
Yan et al. Continuous and periodic event-triggered sliding-mode control for path following of underactuated surface vehicles
Zhang et al. Anti-disturbance control for dynamic positioning system of ships with disturbances
CN104635773A (zh) 一种基于改进强跟踪滤波状态观测器的船舶动力定位方法
CN109739248B (zh) 基于adrc的船载三自由度并联稳定平台稳定控制方法
Rigatos Sensor fusion-based dynamic positioning of ships using Extended Kalman and Particle Filtering
CN111273549A (zh) 一种智能船舶自动舵系统的模糊自适应输出反馈容错控制方法及系统
CN110334411A (zh) 一种基于Huber M估计的水下机器人动力学模型参数辨识方法
CN113110511B (zh) 一种基于广义模糊双曲模型的智能船舶航向控制方法
CN114442640B (zh) 一种水面无人艇轨迹跟踪控制方法
CN116185024A (zh) 一种无人艇的艏向抗扰控制方法
CN109946976A (zh) 一种宽航速auv运动控制方法
CN114967714A (zh) 一种自主式水下机器人抗扰运动控制方法及系统
CN106527454A (zh) 一种无稳态误差的远程水下航行器定深控制方法
CN115047891B (zh) 基于有限时间扩展状态观测器的auv推进器容错控制方法
CN115686034B (zh) 考虑速度传感器失效的无人潜航器轨迹跟踪控制方法
Kurowski et al. Generic navigation and control methods for classes of unmanned surface vehicles
CN116820081A (zh) 基于无模型自适应滑模的欠驱动无人艇路径跟踪控制方法

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