CN110377036A - 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 - Google Patents
一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 Download PDFInfo
- Publication number
- CN110377036A CN110377036A CN201910615393.XA CN201910615393A CN110377036A CN 110377036 A CN110377036 A CN 110377036A CN 201910615393 A CN201910615393 A CN 201910615393A CN 110377036 A CN110377036 A CN 110377036A
- Authority
- CN
- China
- Prior art keywords
- water surface
- unmanned water
- surface ship
- track
- ship
- 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
Links
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 title claims abstract description 146
- 238000000034 method Methods 0.000 title claims abstract description 32
- 238000013461 design Methods 0.000 claims abstract description 47
- 230000007613 environmental effect Effects 0.000 claims description 10
- 230000005540 biological transmission Effects 0.000 claims description 4
- 238000001914 filtration Methods 0.000 claims description 2
- 230000005764 inhibitory process Effects 0.000 claims description 2
- 241000208340 Araliaceae Species 0.000 claims 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 claims 1
- 235000003140 Panax quinquefolius Nutrition 0.000 claims 1
- 235000008434 ginseng Nutrition 0.000 claims 1
- 239000011800 void material Substances 0.000 claims 1
- 230000033001 locomotion Effects 0.000 description 10
- 238000013016 damping Methods 0.000 description 8
- 230000006870 function Effects 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 6
- 230000008569 process Effects 0.000 description 4
- 230000003068 static effect Effects 0.000 description 4
- 230000006872 improvement Effects 0.000 description 3
- 238000013178 mathematical model Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000002401 inhibitory effect Effects 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000013519 translation Methods 0.000 description 2
- 206010008190 Cerebrovascular accident Diseases 0.000 description 1
- 208000006011 Stroke Diseases 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000001035 drying Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明属于船舶领域,公开了一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,包含如下步骤:步骤(1):采集当前无人水面艇的实际位置信息和实际艏向信息;步骤(2):将无人水面艇期望的位置信息与实际位置信息做差得到无人水面艇的位置误差信息,将无人水面艇期望的艏向信息与实际艏向信息做差得到无人水面艇的艏向误差信息,然后设计虚拟控制律;步骤(3):利用二阶指令滤波器对虚拟控制律进行约束;步骤(4):针对外界海洋环境的干扰力进行干扰观测器的设计;步骤(5):设计固定时间反步控制器,解算得到喷水推进器的推力及转矩信息实现无人水面艇的航迹跟踪控制。本发明保证了控制系统鲁棒性,抗未知时变干扰能力强。
Description
技术领域
本发明属于船舶领域,尤其涉及一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法。
背景技术
无人水面艇,简称USV,是一种无人操作的水面舰艇。主要用于执行危险以及不适于有人船只执行的任务。一旦配备先进的控制系统、传感器系统、通信系统和武器系统后,可以执行多种战争和非战争军事任务,比如,侦察、搜索、探测和排雷;搜救、导航和水文地理勘察;反潜作战、反特种作战以及巡逻、打击海盗、反恐攻击等。在无人水面艇研发和使用领域,美国和以色列一直处于领先地位。目前各国都竞相研制无人艇,国内比较知名的单位包括海兰信、哈尔滨工程大学、中船重工701所、中船重工707所、中科院沈阳自动化所、北京方位智能系统技术有限公司等,无人艇家族正在日益壮大。
我国颁布了《“十三五”国家科技新规划》,在规划中明确的提出了“突破智能船舶核心技术,研发高性能船舶”的内容,因此海洋发展战略已经成为了我国科技强国重点战略之一。无人水面艇智能控制的研究作为海洋战略发展中的核心内容之一,也得到了越来越多科研工作者的青睐,无人水面艇的导航、编队控制以及航迹跟踪等问题的研究随着计算机以及人工智能技术的发展均取得了重大突破。
由于无人水面艇体积较小,质量轻,以及高速航行等特点,无人水面艇经常会受到海洋环境中风、浪、流的显著影响,因此在复杂恶劣的海洋环境下避免艏向角及位置等误差量对于无人水面艇安全控制过程的影响,如无人水面艇转弯的时候,由于侧滑角或者回转率超出安全边界导致无人水面艇侧翻的情况。
申请号为201610987001.9的专利公开了基于增强学习型智能算法的无人艇航迹跟踪控制方法,用位置参考系统测得无人艇的位置信息、用姿态参考系统测得无人艇的艏向姿态信息;对获取的位置信息及姿态信息进行滤波及融合,得到无人艇的实际位置及姿态;将期望的位置及姿态与实际的位置及姿态做比较,并经过解算得到误差信号;利用Backstepping法不断反演,最终得到无人艇航迹跟踪控制系统的控制律。近似策略迭代增强学习的航迹跟踪学习控制,在不依赖于环境模型的基础上实现了Backstepping控制器的学习优化,相较于传统的航迹跟踪控制器其算法更加智能,跟踪控制响应更加迅速,跟踪效果更加平滑,跟踪误差小。但是该方法没有针对海洋未知时变干扰做出相应的优化,控制系统鲁棒性不好,可靠性差。
发明内容
本发明的目的在于公开静态干扰误差小、控制系统鲁棒性好的一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法。
本发明的目的是这样实现的:
一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,包含如下步骤:
步骤(1):通过无人水面艇上安装的传感器,采集当前无人水面艇的实际位置信息和实际艏向信息,并进行实时传输;
步骤(2):将无人水面艇期望的位置信息与实际位置信息做差得到无人水面艇的位置误差信息,将无人水面艇期望的艏向信息与实际艏向信息做差得到无人水面艇的艏向误差信息,然后设计虚拟控制律;
步骤(3):利用二阶指令滤波器对虚拟控制律进行约束,将二阶指令滤波器滤波后的虚拟控制律发送给系统控制器,使滤波后的虚拟控制律成为中间变量;
步骤(4):针对外界海洋环境的干扰力进行干扰观测器的设计,对于无法避免的风、浪、流环境干扰进行干扰补偿,加入辅助积分环节,提高对干扰的抑制:
步骤(5):设计固定时间反步控制器,利用位置误差信息、艏向误差信息、滤波后的虚拟控制律以及干扰观测器的估计值进行解算,得到喷水推进器的推力及转矩信息,从而实现无人水面艇的航迹跟踪控制。
本发明还包括以下特征:
1、步骤(3)中利用二阶指令滤波器对虚拟控制律进行约束,是指利用二阶指令滤波器使得指令约束滤波器的输出信号Iro和指令约束滤波器的输入信号Ir之间满足如下关系:
上式中,ωn表示自然频率;ξ表示阻尼系数;s表示二阶滤波器拉普拉斯变换后的变量参数。
2、所述的干扰观测器:
上式中,τwu和τwr是外界环境干扰量;和为干扰估计值;χu和χr为设计的辅助变量;ku、kr、kiu、kir、kui、kri为给定的控制参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;u表示无人水面艇的纵向速度,v表示无人水面艇的横向速度,r表示无人水面艇的转艏角速度;ue表示无人水面艇的纵向速度偏差,re表示无人水面艇的转艏角速度偏差;Iu表示无人水面艇的纵向速度虚拟控制律,Ir表示转艏角速度虚拟控制律;τu表示无人水面艇的纵向速度控制力,τr表示无人水面艇的转艏角速度控制力矩。
3、设计固定时间反步控制器,包含如下步骤:
第一步:设计固定时间性能函数P(t):
上式中,αr,u,βr,u>0,0<γr,u<1均为预先设定的参数;t代表系统时间;Tf代表性能函数的期望稳定时间,Ps代表性能函数的稳态值。
第二步:根据李雅普诺夫稳定性理论,设计满足无人水面艇航迹跟踪控制律:
上式中,k1,k2,k3,k4>0为给定的常值参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;ψe表示无人水面艇的转艏角度偏差;εu和εr为设计的辅助变量;P代表固定时间性能函数。
本发明的有益效果为:
本发明针对无人水面艇航迹跟踪控制,实现了快速航迹跟踪目的,同时保证了控制系统鲁棒性;保证了在海洋环境存在未知时变干扰下,能够更好地消除静态干扰误差。本发明所设计的基于固定时间反步控制器的控制方法,针对无人水面艇航迹跟踪控制,实现了快速航迹跟踪目的,同时保证了控制系统鲁棒性。
附图说明
图1是一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法流程图;
图2是无人水面艇航迹跟踪控制系统结构图;
图3是指令约束滤波器结构图;
图4是干扰观测器结构图;
图5是无人水面艇的给定路径跟踪仿真图。
具体实施方式
下面结合附图来进一步描述本发明:
一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,包含如下步骤:
步骤一:通过无人水面艇上安装的传感器,采集当前无人水面艇的位置信息和艏向信息,并进行实时传输;
通过GPS传感器采集无人水面艇的位置信息,通过罗经采集无人水面艇的艏向信息,然后通过无线传输技术,传回给控制器。
步骤二:根据无人水面艇期望的位置和艏向信息进行虚拟控制律的设计;
通过无人水面艇的期望位置和艏向信息与实际位置和艏向信息做差相减得到无人水面艇的位值误差信息和艏向误差信息,并进行虚拟控制律的设计。
步骤三:利用二阶指令滤波器对得到的虚拟控制律进行约束,将滤波后的虚拟控制律发送给系统控制器,成为中间变量;
通过设计的二阶指令滤波器,保证指令约束控制器的输出信号Iro与输入信号Ir之间的关系满足如下线性关系:
其中:Iro和Ir分别表示指令约束滤波器的输出信号和输入信号;ωn表示自然频率;ξ表示阻尼系数;s表示二阶滤波器拉普拉斯变换后的变量参数;滤波器对输入信号Ir进行幅值限制,将其约束在合理的范围之内,使其满足|Ir|<krr,krr表示存在的大于零的常量。
步骤四:针对外界海洋环境的干扰力进行干扰观测器的设计,并且进行干扰观测器的改进;
引入干扰观测器对外界环境干扰进行估计,其中对于无法避免的风、浪、流环境干扰进行干扰补偿,同时在设计中加入了辅助的积分环节,提高了对干扰的抑制作用,更好的消除了干扰静态误差,保证了系统干扰观测器的高效性和准确性。因此针对外界环境干扰量τwu和τwr分别设计非线性干扰观测器如下:
其中:和为干扰估计值;χu和χr为设计的辅助变量;ku、kr、kiu、kir、kui、kri分别为给定的控制参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;u、v和r分别表示无人水面艇的纵向速度、横向速度和转艏角速度;ue和re分别表示无人水面艇的纵向速度偏差和转艏角速度偏差;Iu和Ir分别表示无人水面艇的纵向速度虚拟控制律和转艏角速度虚拟控制律;τu和τr分别表示无人水面艇的纵向速度控制力和转艏角速度控制力矩。
步骤五:设计固定时间反步控制器,将得到的位置和艏向偏差信息、虚拟控制律以及干扰观测器的估计值等中间变量进行使用并解算,得到喷水推进器的推力及转矩信息,从而实现无人水面艇的航迹跟踪控制。
基于误差转换技术,实现对轨迹跟踪误差的性能约束,同时设计了一种基于固定时间性能函数的反步控制方法,该方法在海洋环境干扰存在的情况下依然能够保证系统在固定的时间内实现控制器收敛到设定的稳态值并实现航迹跟踪。
为实现满足暂稳态性能要求的航迹跟踪控制,对航迹跟踪的艏向角速度误差re和纵向速度误差ue约束如下:
设计固定时间性能函数P(t):
其中:ρrl,ρru,ρul,ρuu>0,αr,u,βr,u>0,0<γr,u<1均为预先设定的参数;t代表了系统时间;Tf和Ps分别代表了性能函数的期望稳定时间和稳态值。
转换误差方程:
其中:re(t)和ru(t)分别代表了艏向角速度偏差和纵向速度偏差随时间t的变量;εe(t)和εu(t)分别代表了艏向角速度偏差和纵向速度偏差随时间t的转换量;P(t)表示固定时间函数。
进一步地,通过李雅普诺夫稳定性理论,设计满足无人水面艇航迹跟踪控制律如下:
其中:τu和τr分别表示无人水面艇的纵向速度控制力和转艏角速度控制力矩;Iu和Ir分别表示无人水面艇的纵向速度虚拟控制律和转艏角速度虚拟控制律;k1,k2,k3,k4>0为给定的常值参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;u、v和r分别表示无人水面艇的纵向速度、横向速度和转艏角速度;ue、re、ψe分别表示无人水面艇的纵向速度偏差、转艏角速度偏差和转艏角度偏差;和为干扰估计值;εu和εr为设计的辅助变量;P代表了固定时间性能函数。
实施例1:
本实施方式所述的一种基于指令约束滤波器和改进干扰观测器的无人艇航迹跟踪固定时间控制方法,如图1所示通过如下步骤实现:
步骤一:采集无人水面艇的实际位置信息和艏向信息;
步骤二:根据无人水面艇模型以及期望的位置和艏向信息进行虚拟控制律的设计;
步骤三:根据无人水面艇模型设计二阶指令约束滤波器;
步骤四:根据无人水面艇模型设计改进的干扰观测器;
步骤五:设计固定时间反步控制器,实现无人水面艇的航迹跟踪控制。
步骤六:无人水面艇给定路径跟踪仿真。
本实施方式包括以下有益效果:本实施方式引入了指令约束滤波器和改进的干扰观测器,能够解决无人艇控制中指令超调以及时变环境干扰等问题。本实施方式所述的基于固定时间的Back-stepping控制方法,解决了无人艇航迹跟踪控制的快速性以及鲁棒性等问题。
实施例2:
本实施方式是对一种基于指令约束滤波器和改进干扰观测器的无人艇航迹跟踪固定时间反步控制方法的进一步说明,如图2控制系统结构框图所示,其详细的实施过程如下:
步骤1、建立无人水面艇三自由度数学模型:
其中:η=[x,y,ψ]T表示无人艇位置和艏向角;υ=[u,v,r]T表示无人艇速度和角速度;M=diag{m,m,Iz}表示无人艇质量和转动惯量;τ=[τu,0,τr]T表示控制力与控制力矩;τw=[τwu τwv τwr]T表示环境力作用在三个自由度上的分力;C(υ)表示科里奥利向心力矩阵,D(υ)表示阻尼系数矩阵和R(ψ)表示坐标系变换矩阵,其具体形式如下:
其中:m11、m22为无人水面艇的船模参数,u、v分别表示无人水面艇的纵向速度、横向速度;Xu表示无人水面艇纵向运动时对X轴方向的阻尼力;Yv表示无人水面艇横向运动时对Y轴方向的阻尼力;Nr表示无人水面艇转艏运动时对Z轴方向的阻尼力矩;X|u|u表示无人水面艇纵向运动时对X轴方向的高阶阻尼力;Y|v|r表示无人水面艇横向运动和回转运动时对Y轴方向产生的高阶耦合阻尼力;Y|v|v表示无人水面艇横向运动时对Y轴方向的高阶阻尼力;N|v|r表示无人水面艇回转运动和横向运动时对Z轴方向产生的高阶耦合阻尼力矩;N|v|v表示无人水面艇转艏运动时对Z轴方向的高阶阻尼力矩,ψ表示无人水面艇的艏摇角。
进一步地,为了方便控制系统控制律的设计,将无人水面艇三自由度数学模型按标量形式展开如下:
其中:表示了无人水面艇关于时间导数的实际轨迹参数;表示了无人水面艇关于时间导数的实际速度参数;u、v和r分别表示无人水面艇的纵向速度、横向速度和转艏角速度;d11、d22、d33和m11、m22、m33为无人水面艇的船模参数;τu和τr分别表示无人水面艇的纵向速度控制力和转艏角速度控制力矩;τwu、τwv和τwr分别表示环境力作用在三个自由度上的分力;ψ表示无人水面艇的艏摇角。
定义无人水面艇的纵向、横向、艏向以及绝对跟踪误差:
其中:(x y ψ)、(xd yd ψd)和(xe ye ψe)分别表示无人水面艇在北东坐标系下的实际位置、艏向角以及期望位置、艏向角和位置偏差、艏向角偏差;ze表示无人水面艇与虚拟船之间位置误差。
步骤2、设计指令约束滤波器:
根据设计的虚拟控制律,约束无人水面艇在正常航行时的转艏角速度,防止其航行时因转艏角速度过大超出安全界限而引起的安全隐患。由转艏角速度误差方程re=Ir-r可知,其中re表示转艏角速度误差,Ir表示虚拟控制率,r表示实际转艏角速度,因此可以通过约束方程中的re和Ir在可控区间内变化,实现间接的约束r在预先规定的范围之内改变。
通过设计的二阶指令滤波器如图3所示,保证指令约束控制器的输出信号Iro与输入信号Ir之间的关系满足如下线性关系:
其中:Iro和Ir分别表示指令约束滤波器的输出信号和输入信号;ωn表示自然频率;ξ表示阻尼系数;s表示二阶滤波器拉普拉斯变换后的变量参数;滤波器对输入信号Ir进行幅值限制,将其约束在合理的范围之内,使其满足|Ir|<krr,krr表示存在的大于零的常量。
步骤3、设计改进的干扰观测器:
引入干扰观测器对外界环境干扰进行估计,其中对于无法避免的风、浪、流环境干扰进行干扰补偿,同时在设计中加入了辅助的积分环节,提高了对干扰的抑制作用,更好的消除了干扰静态误差,保证了系统干扰观测器的高效性和准确性,如图4所示。针对外界环境干扰量τwu和τwr分别设计改进的非线性干扰观测器如下:
其中:和为干扰估计值;χu和χr为设计的辅助变量;ku、kr、kiu、kir、kui、kri分别为给定的控制参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;u、v和r分别表示无人水面艇的纵向速度、横向速度和转艏角速度;ue和re分别表示无人水面艇的纵向速度偏差和转艏角速度偏差;Iu和Ir分别表示无人水面艇的纵向速度虚拟控制律和转艏角速度虚拟控制律;τu和τr分别表示无人水面艇的纵向速度控制力和转艏角速度控制力矩。
步骤4、设计无人水面艇固定时间反步控制器:
定义无人水面艇航迹跟踪控制中的艏向角速度误差re和纵向速度误差ue约束为:
进一步地,定义固定时间性能函数P(t):
其中:ρrl,ρru,ρul,ρuu>0,αr,u,βr,u>0,0<γr,u<1均为预先设定的参数;t代表了系统时间;Tf和Ps分别代表了性能函数的期望稳定时间和稳态值。
进一步地,定义误差转换函数:
其中:re(t)和ru(t)分别代表了艏向角速度偏差和纵向速度偏差随时间t的变量;εe(t)和εu(t)分别代表了艏向角速度偏差和纵向速度偏差随时间t的转换量;P(t)表示固定时间函数。
进一步地,对误差转换函数求导可得,
根据误差转换函数,定义艏向角速度误差re和纵向速度跟踪误差ue如下:
其中:Ir和Iu分别表示转艏角速度和纵向速度的虚拟控制律;r和u分别表示实际转艏角速度和实际纵向速度。
根据纵向速度的虚拟控制律Iu和转艏角速度虚拟控制律Ir:
其中:k1,k2>0为给定的常值参数;εu和εr为设计的辅助变量;P代表了固定时间性能函数;ψe表示无人水面艇的转艏角度偏差。
进一步地,选取全局的李雅普诺夫函数如下所示:
其中:εu为设计的辅助变量;ψe表示无人水面艇的转艏角度偏差;m11、m33为无人水面艇的船模参数;ue、re分别表示无人水面艇的纵向速度偏差、转艏角速度偏差;和为干扰估计误差值。
对V求导可得:
所以通过李雅普诺夫稳定性理论,设计满足无人水面艇航迹跟踪控制律如下:
其中:τu和τr分别表示无人水面艇的纵向速度控制力和转艏角速度控制力矩;k1,k2,k3,k4>0为给定的常值参数;d11、d22、d33和m11、m22、m33为无人水面艇的船模参数;Iu和Ir分别表示无人水面艇的纵向速度虚拟控制律和转艏角速度虚拟控制律;u、v和r分别表示无人水面艇的纵向速度、横向速度和转艏角速度;ue、re、ψe分别表示无人水面艇的纵向速度偏差、转艏角速度偏差和转艏角度偏差;和为干扰估计值;εu和εr为设计的辅助变量;P代表了固定时间性能函数。
实施例3:
本实施方式是一种基于指令约束滤波器和改进的干扰观测器的无人水面艇航迹跟踪固定时间控制方法的进一步说明,结合本发明所设计的控制器,选取给定航路进行跟踪仿真过程如下:
首先给出仿真过程中的海洋环境参数:风速为5m/s,风向为45°。
然后采用基于指令约束滤波器以及改进干扰观测器的固定时间航迹跟踪控制器,以无人水面艇为控制对象,进行仿真,如图5所示。其中显示了期望航迹与实际航迹的曲线对比,其中红线代表了期望航速与期望航路,红点表示船的出发点,蓝线代表了实际的航速与实际的位置信息,期望航速值为7节,进行给定折线航路跟踪控制,证明了本发明提出的方法能够很好地实现无人水面艇的航迹跟踪控制。
综上,本发明通过二阶指令滤波器实现对输入信号的约束,保证指令的有效性,同时利用改进的干扰观测器解决了无人水面艇控制中外界环境的时变干扰等问题,将固定时间控制方法运用到无人水面艇航迹跟踪控制中。基于固定时间控制的无人水面艇航迹跟踪控制方法步骤如下:一、建立无人水面艇运动三自由度数学模型;二、设计二阶指令滤波器;三、设计改进的干扰观测器;四、设计固定时间反步控制器。本发明所设计的控制方法,能够在外界存在时变干扰的情况下快速的实现航迹跟踪并保证无人水面艇的安全性和稳定性。
Claims (5)
1.一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,其特征在于:包含如下步骤:
步骤(1):通过无人水面艇上安装的传感器,采集当前无人水面艇的实际位置信息和实际艏向信息,并进行实时传输;
步骤(2):将无人水面艇期望的位置信息与实际位置信息做差得到无人水面艇的位置误差信息,将无人水面艇期望的艏向信息与实际艏向信息做差得到无人水面艇的艏向误差信息,然后设计虚拟控制律;
步骤(3):利用二阶指令滤波器对虚拟控制律进行约束,将二阶指令滤波器滤波后的虚拟控制律发送给系统控制器,使滤波后的虚拟控制律成为中间变量;
步骤(4):针对外界海洋环境的干扰力进行干扰观测器的设计,对于无法避免的风、浪、流环境干扰进行干扰补偿,加入辅助积分环节,提高对干扰的抑制;
步骤(5):设计固定时间反步控制器,利用位置误差信息、艏向误差信息、滤波后的虚拟控制律以及干扰观测器的估计值进行解算,得到喷水推进器的推力及转矩信息,实现无人水面艇的航迹跟踪控制。
2.根据权利要求1所述的一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,其特征在于:步骤(3)中利用二阶指令滤波器对虚拟控制律进行约束,是指利用二阶指令滤波器使得指令约束滤波器的输出信号Iro和指令约束滤波器的输入信号Ir之间满足如下关系:
上式中,ωn表示自然频率;ξ表示阻尼系数;s表示二阶滤波器拉普拉斯变换后的变量参数。
3.根据权利要求1或2所述的一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,其特征在于:所述的干扰观测器:
上式中,τwu和τwr是外界环境干扰量;和为干扰估计值;χu和χr为设计的辅助变量;ku、kr、kiu、kir、kui、kri为给定的控制参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;u表示无人水面艇的纵向速度,v表示无人水面艇的横向速度,r表示无人水面艇的转艏角速度;ue表示无人水面艇的纵向速度偏差,re表示无人水面艇的转艏角速度偏差;Iu表示无人水面艇的纵向速度虚拟控制律,Ir表示转艏角速度虚拟控制律;τu表示无人水面艇的纵向速度控制力,τr表示无人水面艇的转艏角速度控制力矩。
4.根据权利要求1或2所述的一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,其特征在于:所述的设计固定时间反步控制器,包含如下步骤:
第一步:设计固定时间性能函数P(t):
上式中,αr,u,βr,u>0,0<γr,u<1均为预先设定的参数;t代表系统时间;Tf代表性能函数的期望稳定时间,Ps代表性能函数的稳态值;
第二步:根据李雅普诺夫稳定性理论,设计满足无人水面艇航迹跟踪控制律:
上式中,k1,k2,k3,k4>0为给定的常值参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;ψe表示无人水面艇的转艏角度偏差;εu和εr为设计的辅助变量;P代表固定时间性能函数。
5.根据权利要求3所述的一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法,其特征在于:所述的设计固定时间反步控制器,包含如下步骤:
第一步:设计固定时间性能函数P(t):
上式中,αr,u,βr,u>0,0<γr,u<1均为预先设定的参数;t代表系统时间;Tf代表性能函数的期望稳定时间,Ps代表性能函数的稳态值;
第二步:根据李雅普诺夫稳定性理论,设计满足无人水面艇航迹跟踪控制律:
上式中,k1,k2,k3,k4>0为给定的常值参数;d11、d33和m11、m22、m33为无人水面艇的船模参数;ψe表示无人水面艇的转艏角度偏差;εu和εr为设计的辅助变量;P代表固定时间性能函数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910615393.XA CN110377036B (zh) | 2019-07-09 | 2019-07-09 | 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910615393.XA CN110377036B (zh) | 2019-07-09 | 2019-07-09 | 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110377036A true CN110377036A (zh) | 2019-10-25 |
CN110377036B CN110377036B (zh) | 2022-04-05 |
Family
ID=68252529
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910615393.XA Active CN110377036B (zh) | 2019-07-09 | 2019-07-09 | 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110377036B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110703765A (zh) * | 2019-11-07 | 2020-01-17 | 大连海事大学 | 一种无人船的碰撞自规避方法及系统 |
CN110879599A (zh) * | 2019-12-12 | 2020-03-13 | 大连海事大学 | 一种基于有限时间扰动观测器的固定时间编队控制方法 |
CN111045432A (zh) * | 2019-12-31 | 2020-04-21 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111798701A (zh) * | 2020-07-07 | 2020-10-20 | 中国船舶工业系统工程研究院 | 无人艇路径跟踪控制方法、系统、存储介质及终端 |
CN112034865A (zh) * | 2020-08-12 | 2020-12-04 | 浙江大学 | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 |
CN112965371A (zh) * | 2021-01-29 | 2021-06-15 | 哈尔滨工程大学 | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 |
CN113608534A (zh) * | 2021-08-04 | 2021-11-05 | 上海大学 | 一种无人艇跟踪控制方法及系统 |
CN115686034A (zh) * | 2022-11-21 | 2023-02-03 | 哈尔滨理工大学 | 考虑速度传感器失效的无人潜航器轨迹跟踪控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2000034837A1 (en) * | 1998-11-19 | 2000-06-15 | Abb Industri As | A method for automatic positioning of a vessel |
US20020099677A1 (en) * | 2000-05-27 | 2002-07-25 | Calise Anthony J. | Adaptive control system having direct output feedback and related apparatuses and methods |
CN103324195A (zh) * | 2013-06-14 | 2013-09-25 | 哈尔滨工程大学 | 基于反步法的船舶自适应鲁棒航向跟踪控制方法 |
CN105629721A (zh) * | 2016-02-01 | 2016-06-01 | 金陵科技学院 | 基于指令滤波Backstepping二阶非线性系统无模型控制方法 |
CN106338919A (zh) * | 2016-11-02 | 2017-01-18 | 哈尔滨工程大学 | 基于增强学习型智能算法的无人艇航迹跟踪控制方法 |
CN108052009A (zh) * | 2018-01-23 | 2018-05-18 | 哈尔滨工程大学 | 基于滤波反步法的水面目标救援跟踪观测控制器设计方法 |
-
2019
- 2019-07-09 CN CN201910615393.XA patent/CN110377036B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2000034837A1 (en) * | 1998-11-19 | 2000-06-15 | Abb Industri As | A method for automatic positioning of a vessel |
US20020099677A1 (en) * | 2000-05-27 | 2002-07-25 | Calise Anthony J. | Adaptive control system having direct output feedback and related apparatuses and methods |
CN103324195A (zh) * | 2013-06-14 | 2013-09-25 | 哈尔滨工程大学 | 基于反步法的船舶自适应鲁棒航向跟踪控制方法 |
CN105629721A (zh) * | 2016-02-01 | 2016-06-01 | 金陵科技学院 | 基于指令滤波Backstepping二阶非线性系统无模型控制方法 |
CN106338919A (zh) * | 2016-11-02 | 2017-01-18 | 哈尔滨工程大学 | 基于增强学习型智能算法的无人艇航迹跟踪控制方法 |
CN108052009A (zh) * | 2018-01-23 | 2018-05-18 | 哈尔滨工程大学 | 基于滤波反步法的水面目标救援跟踪观测控制器设计方法 |
Non-Patent Citations (3)
Title |
---|
FUGUANG DING 等: "Trajectory-tracking controller design of underactuated surface vessels", 《OCEANS"11 MTS/IEEE KONA》 * |
HUA LI 等: "Fixed-time synchronization of a class of second-order nonlinear multi-agent systems", 《2016 14TH INTERNATIONAL CONFERENCE ON CONTROL, AUTOMATION, ROBOTICS AND VISION (ICARCV)》 * |
王元慧 等: "性能函数约束下的动力定位船轨迹跟踪控制", 《哈尔滨工程大学学报》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110703765A (zh) * | 2019-11-07 | 2020-01-17 | 大连海事大学 | 一种无人船的碰撞自规避方法及系统 |
CN110879599A (zh) * | 2019-12-12 | 2020-03-13 | 大连海事大学 | 一种基于有限时间扰动观测器的固定时间编队控制方法 |
CN111045432A (zh) * | 2019-12-31 | 2020-04-21 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111045432B (zh) * | 2019-12-31 | 2022-07-15 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111798701A (zh) * | 2020-07-07 | 2020-10-20 | 中国船舶工业系统工程研究院 | 无人艇路径跟踪控制方法、系统、存储介质及终端 |
CN112034865A (zh) * | 2020-08-12 | 2020-12-04 | 浙江大学 | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 |
CN112034865B (zh) * | 2020-08-12 | 2021-10-08 | 浙江大学 | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 |
CN112965371A (zh) * | 2021-01-29 | 2021-06-15 | 哈尔滨工程大学 | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 |
CN112965371B (zh) * | 2021-01-29 | 2021-09-28 | 哈尔滨工程大学 | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 |
CN113608534A (zh) * | 2021-08-04 | 2021-11-05 | 上海大学 | 一种无人艇跟踪控制方法及系统 |
CN113608534B (zh) * | 2021-08-04 | 2023-10-24 | 上海大学 | 一种无人艇跟踪控制方法及系统 |
CN115686034A (zh) * | 2022-11-21 | 2023-02-03 | 哈尔滨理工大学 | 考虑速度传感器失效的无人潜航器轨迹跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110377036B (zh) | 2022-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110377036A (zh) | 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 | |
CN106292287B (zh) | 一种基于自适应滑模控制的uuv路径跟踪方法 | |
CN106444794B (zh) | 一种无参数欠驱动uuv垂直面路径跟踪滑模控制方法 | |
CN106325291B (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及系统 | |
CN104898688B (zh) | Uuv四自由度动力定位自适应抗扰滑模控制系统及控制方法 | |
CN108008628A (zh) | 一种不确定欠驱动无人艇系统的预设性能控制方法 | |
CN108681246A (zh) | 一种基于执行器故障的无人水面船航迹跟踪方法 | |
CN103777522B (zh) | 基于模糊pid的无人水面艇直线跟踪方法 | |
CN112612209B (zh) | 基于指令滤波神经网络控制器的全驱动船舶轨迹跟踪控制方法及系统 | |
CN106444796B (zh) | 一种不确定时变时滞的欠驱动uuv深度自适应全局滑模控制方法 | |
CN110262494B (zh) | 一种同构多无人艇系统的协同学习与编队控制方法 | |
CN109634307A (zh) | 一种无人水下航行器复合航迹跟踪控制方法 | |
CN106227223A (zh) | 一种基于动态滑模控制的uuv轨迹跟踪方法 | |
CN104635773B (zh) | 一种基于改进强跟踪滤波状态观测器的船舶动力定位方法 | |
CN104316025B (zh) | 一种基于船体姿态信息估计海浪浪高的系统 | |
CN111948937B (zh) | 多智能体系统的多梯度递归强化学习模糊控制方法及系统 | |
CN105549611B (zh) | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 | |
CN104950901A (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
Wille et al. | Modeling and course control of sailboats | |
CN109240289A (zh) | 波浪滑翔器艏摇信息自适应滤波方法 | |
CN112965375A (zh) | 一种基于固定时间终端滑模的多无人艇编队控制方法 | |
CN113467231A (zh) | 基于侧滑补偿ilos制导律的无人艇路径跟踪方法 | |
Shen et al. | Prescribed performance LOS guidance-based dynamic surface path following control of unmanned sailboats | |
CN104142626A (zh) | 一种基于逆系统和内模控制的船舶动力定位控制方法 | |
Chen et al. | Coordinated path-following and attitude control for multiple surface vessels via curve extension method |
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 |