CN110362075A - 一种具有预设性能的无人艇输出反馈编队控制设计方法 - Google Patents
一种具有预设性能的无人艇输出反馈编队控制设计方法 Download PDFInfo
- Publication number
- CN110362075A CN110362075A CN201910560206.2A CN201910560206A CN110362075A CN 110362075 A CN110362075 A CN 110362075A CN 201910560206 A CN201910560206 A CN 201910560206A CN 110362075 A CN110362075 A CN 110362075A
- Authority
- CN
- China
- Prior art keywords
- surface vehicle
- unmanned surface
- unmanned
- design
- leader
- 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
- 238000013461 design Methods 0.000 title claims abstract description 90
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 81
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000005516 engineering process Methods 0.000 claims abstract description 14
- 230000001052 transient effect Effects 0.000 claims abstract description 12
- 238000009795 derivation Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 27
- 238000004891 communication Methods 0.000 claims description 25
- 238000001914 filtration Methods 0.000 claims description 16
- 230000001537 neural effect Effects 0.000 claims description 11
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 11
- 230000003044 adaptive effect Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 230000007306 turnover Effects 0.000 claims description 6
- 238000013016 damping Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 210000004218 nerve net Anatomy 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 16
- 230000001133 acceleration Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
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)
Abstract
本发明公开了一种具有预设性能的无人艇输出反馈编队控制设计方法,包括以下步骤:构建水面无人艇的动态模型;定义第i个水面无人艇与其领导者之间的距离变量;设计水面无人艇编队距离误差与方位角误差的性能函数,采用tan型障碍李雅普诺夫函数确保距离误差与方位角误差满足暂态性能的约束条件;设计第i个水面无人艇的速度估计器;运用反步设计法针对第i个水面无人艇的距离误差系统和方位角误差系统进行虚拟控制器设计;在控制器设计中运用动态面技术避免对虚拟控制器求导。本发明能避免水面无人艇与其领导者发生碰撞,编队误差满足预设的暂态性能,控制效果佳。
Description
技术领域
本发明涉及水面无人艇的编队控制领域,特别涉及一种具有预设性能的无人艇输出反馈编队控制设计方法。
背景技术
近些年来,水面无人艇的编队控制越来越成为研究的热点,具有一定编队结构的一群水面无人艇在完成某些复杂危险操作时相比单个水面无人艇效率更高,诸如目标搜寻、环境保护、资源测量等。在众多的编队结构中,领导者-跟随者编队结构因为其结构简单并易于扩展,因而得到了更多的关注,目前关于此编队结构已有一定的研究成果。在基于输出反馈的领导者-跟随者编队结构中,每个水面无人艇设计各自的速度估计器,传统的速度估计器采用高增益的设计方法,由于高增益估计器本身是线性的,所以对于非线性不确定系统存在缺陷,而水面无人艇正是高度非线性系统。
由于每个水面无人艇需要利用通讯获取其领导者和跟随者信息,而通讯范围却是有限的,因此所设计的控制器应使得在编队运动的整个过程中每个水面无人艇都能始终利用通讯获取其领导者和跟随者信息,同时还需要与其领导者保持一定的安全距离以避免发生碰撞。性能受限的设计方法,可以解决这个问题,具体的设计方法为设计常数上下边界,以及转换函数,使得所控制的状态维持在此边界之中,此方法只能保证稳态的性能。在实际的应用中暂态性能也是需要考虑的问题,因为若编队误差收敛太慢则每个水面无人艇需要更长的时间才能达到其期望位置,而编队误差的超调量过大,则可能会导致每个水面无人艇在运动过程与其领导者发生碰撞。因此需对编队误差的暂态性能,如收敛速度与超调量等进行限制。
发明内容
本发明的目的在于克服现有技术中的缺点与不足,提供一种具有预设性能的无人艇输出反馈编队控制设计方法,本方法针对模型不确定的水面无人艇设计编队控制器,既能保证在领导者-跟随者编队结构中,每个水面无人艇都能始终利用通讯获取其领导者与跟随者的信息,同时保证了编队误差的暂态性能。
为实现以上目的,本发明采取如下技术方案:
一种具有预设性能的无人艇输出反馈编队控制设计方法,包含以下步骤:
步骤(1):建立领导者-跟随者编队结构中水面无人艇的动态模型;
步骤(2):定义领导者-跟随者编队结构中第i个水面无人艇与其领导者之间的角度和距离变量di,i=1,2,3...N,并确保距离变量di满足水面无人艇的通讯约束条件,即第i个水面无人艇能够利用通讯获取其领导者与跟随者的信息;
步骤(3):根据领导者-跟随者编队距离误差edi和方位角误差eψi的约束条件,设计指数递减的性能函数βji,采用tan型障碍李雅普诺夫函数确保编队距离误差edi和方位角误差eψi满足暂态性能的约束条件;
步骤(4):领导者-跟随者编队中第i个水面无人艇利用通讯获取其领导者与其跟随者的位置信息,并结合自身信息采用RBF神经网络设计其速度估计器;
步骤(5):利用步骤(4)第i个水面无人艇速度估计值,运用反步设计法针对第i个水面无人艇的距离误差系统和方位角误差系统进行虚拟控制器设计;
步骤(6):领导者-跟随者编队结构中每个水面无人艇利用通讯获取其领导者与其跟随者的信息,在控制器设计中运用动态面技术避免对虚拟控制器求导;
步骤(7):基于步骤(3)到步骤(6)中的tan型障碍李雅普诺夫函数、RBF神经网络技术、反步设计法与动态面技术设计编队控制器。
作为优选的技术方案,步骤(1)中,第i个水面无人艇的动态模型为:
其中,ηi=[xi,yi,ψi]T为第i个水面无人艇相对于大地坐标的位置和航向角,其中xi为第i个水面无人艇在x轴的坐标,yi为第i个水面无人艇在y轴的坐标,ψi为第i个水面无人艇的航向角;vi=[ui,vi,ri]T为第i个水面无人艇的速度向量,其中ui为第i个水面无人艇的纵向速度,vi为第i个水面无人艇的横向速度,ri为第i个水面无人艇的航向角速度;τi=[τui,τvi,τri]T为第i个水面无人艇的控制输入向量,其中τui为第i个水面无人艇的纵向控制输入,τvi为第i个水面无人艇的横向控制输入,τri为第i个水面无人艇的航向控制输入;J(ηi)为第i个水面无人艇的旋转矩阵;Mi为第i个水面无人艇的质量矩阵;C(vi)为第i个水面无人艇的科氏力矩阵;D(vi)为第i个水面无人艇的阻尼矩阵;其中:
其中 c13i(vi,ri)=-m22ivi-m23iri,d22i(vi,ri)=-Yvi-Y|vi|vi|vi|-Y|ri|vi|ri|,d23i(vi,ri)=-Yri-Y|vi|ri|vi|-Y|ri|ri|ri|,d32i(vi,ri)=-Nvi-N|vi|vi|vi|-N|ri|vi|ri|,d33i(vi,ri)=-Nri-N|vi|ri|vi|-N|ri|ri|ri|。mi表示第i个水面无人艇的质量;xgi表示第i个水面无人艇的中心和重心之间的距离;Izi,Xui,X|ui|ui,Xuiuiui,Yvi,Y|vi|vi,Y|ri|vi,Yri,Y|vi|ri,Y|ri|ri,Nvi,N|vi|vi,N|ri|vi,Nri,N|vi|ri,N|ri|ri为第i个水面无人艇的动力参数,通常可由海上试验得到。
作为优选的技术方案,步骤(2)中,所述第i个水面无人艇与其领导者之间的距离变量di和角度具体由如下公式定义:
为了保证水面无人艇能够实时利用通讯获取其领导者与跟随者的信息,要求在整个编队的运动过程中距离变量di满足碰撞避免和通讯约束条件:
dcol,i<di(t)<dcon,i
其中,dcol,1、dcon,i分别为设计的第i个水面无人艇的碰撞距离、通讯距离;
为了保证水面无人艇编队满足碰撞避免和通讯约束条件以及保持领导者-跟随者编队形式,定义编队距离误差edi和方位角误差eψi:
edi=di-ddes,i
eψi=ψi-1-ψi
其中,ddes,i=(dcol,i+dcon,i)/2为设计的第i个水面无人艇与其领导者之间的期望距离,编队距离误差edi满足以下约束条件:
dcol,i-ddes,i<edi(t)<dcon,i-ddes,i
进一步,要求编队距离误差edi和方位角误差eψi满足以下时变函数约束:
|edi|<βdi(t)
|eψi|<βψi(t)。
作为优选的技术方案,步骤(3)中,所述指数递减的性能函数βji的具体形式为:
其中,βdi,0=dcon,i-ddes,i,βψi,0分别为距离、方位角性能函数的初始值,βji,∞为性能函数的稳态值,κji为性能函数的设计参数;
采用tan型障碍李雅普诺夫函数为:
当设计的编队控制器能保证tan型障碍李雅普诺夫函数Vdi,Vψi始终有界,则误差edi,eψi始终满足|edi|<βdi(t),|eψi|<βψi(t);则编队距离变量di始终满足暂态性能的约束条件:
-βdi<edi<βdi
约束条件表示编队误差eji的收敛速度始终大于性能函数βji的收敛速度,编队误差eji的超调量始终小于性能函数βii所构造的边界。
作为优选的技术方案,步骤(4)中,针对第i个水面无人艇,设计其速度估计器为:
其中, 为第i个水面无人艇位置ηi的估计值;为第i个水面无人艇速度vi的估计值; K1i>0为设计参数矩阵,K2i>0为设计参数矩阵,K3i>0为设计参数矩阵。
设计RBF神经网络估计器的更新率为:
其中,Γl1i为自适应增益;σl1i>0为权值修正参数。
作为优选的技术方案,步骤(5)中,结合步骤(4)中速度估计值,运用反步设计法针对距离误差系统和方位角误差系统进行虚拟控制器设计,得到的虚拟控制器为:
其中,α1i表示针对纵向线速度动态模型设计的虚拟控制器;α2i表示针对横向线速度动态模型设计的虚拟控制器;α3i表示针对方位角速度动态模型设计的虚拟控制器;kdi>0,kψi>0为设计参数。
作为优选的技术方案,步骤(6)中,运用动态面技术,将虚拟控制器通过一阶滤波器得到滤波虚拟控制器:
其中αfi=[αf1i,αf2i,αf3i]T为滤波虚拟控制器,αf1i表示针对纵向线速度动态模型设计的虚滤波拟控制器,αf2i表示针对横向线速度动态模型设计的滤波虚拟控制器,αf3i表示针对方位角速度动态模型设计的滤波虚拟控制器;αi=[α1i,α2i,α3i]T为虚拟控制器;μi=diag[μ1i,μ2i,μ3i]>0为滤波时间常数;
作为优选的技术方案,步骤(7)中,基于步骤(3)到步骤(6)中的tan型障碍李雅普诺夫函数、RBF神经网络、反步设计法与动态面技术设计编队控制器,具体为:
其中,K4i>0为设计参数矩阵;μi为滤波时间常数;I3为三阶单位阵;
设计RBF神经网络估计器的更新率为:
其中,Γli为自适应增益;σli>0为权值修正参数。
表示第i个水面无人艇的速度估计值与滤波虚拟控制器αfi之差:
eαi表示第i个水面无人艇的滤波虚拟控制器αfi与虚拟控制器αi之差:
eαi=αfi-αi
本发明相对于现有技术具有如下的优点和效果:
1、本发明所设计的编队控制器为基于输出反馈的编队控制器,即在领导者-跟随者编队结构中每个水面无人艇利用通讯获取其领导者与跟随者的信息,具体为位置、估计的速度信息,而不需要测量水面无人艇速度、加速度等信息。
2、本发明结合具有对称边界的tan型障碍李雅普诺夫函数和指数递减性能函数,可保证编队误差始终在性能函数规定的界内,这既能确保在领导者-跟随者编队结构中,每个水面无人艇都能始终利用通讯获取其领导者与跟随者的信息,并避免与其领导者发生碰撞,还保证了编队误差的暂态性能。
附图说明
图1为本发明实施例领导者-跟随者编队示意图。
图2为本发明实施例水面无人艇的编队控制的整体控制框图。
图3为本发明实施例水面无人艇编队运动的相平面图。
图4为本发明实施例编队距离变量di仿真图。
图5为本发明实施例编队方位角变量ψi仿真图。
图6为本发明实施例第1个水面无人艇的速度估计值仿真图。
图7为本发明实施例第2个水面无人艇的速度估计值仿真图。
图8为本发明实施例第3个水面无人艇的速度估计值仿真图。
图9为本发明实施例第4个水面无人艇的速度估计值仿真图。
图10为本发明实施例第5个水面无人艇的速度估计值仿真图。
图11为本发明实施例编队控制器τui输出仿真图。
图12为本发明实施例编队控制器τvi输出仿真图。
图13为本发明实施例编队控制器τri输出仿真图。
具体实施方式
为了使本发明的目的、技术方案以及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步的详细说明。应当理解,此处所描述的具体实施例仅用于解释本发明,并不限于本发明。
实施例
具有预设性能的水面无人艇领导者-跟随者输出反馈编队控制,编队中一共有5个水面无人艇,图1为水面无人艇的领导者-跟随者编队示意图。
如图2所示为具有预设性能的水面无人艇领导者-跟随者输出反馈编队控制方法的整体控制框图,该控制方法的详细实施过程包括下述步骤:
步骤(1):建立领导者-跟随者编队结构中水面无人艇的动态模型;
建立领导者-跟随者编队结构中的第i(i=1,2,3,4)个移动机器人的系统模型,其向量形式为:
其中,ηi=[xi,yi,ψi]T为第i个水面无人艇相对于大地坐标的位置和航向角,其中xi为第i个水面无人艇在x轴的坐标,yi为第i个水面无人艇在y轴的坐标,ψi为第i个水面无人艇的航向角;vi=[ui,vi,ri]T为第i个水面无人艇的速度向量,其中ui为第i个水面无人艇的纵向速度,vi为第i个水面无人艇的横向速度,ri为第i个水面无人艇的航向角速度;τi=[τui,τvi,τri]T为第i个水面无人艇的控制输入向量,其中τui为第i个水面无人艇的纵向控制输入,τvi为第i个水面无人艇的横向控制输入,τri为第i个水面无人艇的航向控制输入;J(ηi)为第i个水面无人艇的旋转矩阵;Mi为第i个水面无人艇的质量矩阵;C(vi)为第i个水面无人艇的科氏力矩阵;D(vi)为第i个水面无人艇的阻尼矩阵;其中:
其中 c13i(vi,ri)=-m22ivi-m23iri,d22i(vi,ri)=-Yvi-Y|vi|vi|vi|-Y|ri|vi|ri|,d23i(vi,ri)=-Yri-Y|vi|ri|vi|-Y|ri|ri|ri|,d32i(vi,ri)=-Nvi-N|vi|vi|vi|-N|ri|vi|ri|,d33i(vi,ri)=-Nri-N|vi|ri|vi|-N|ri|ri|ri|。mi表示第i个水面无人艇的质量;xgi表示第i个水面无人艇的中心和重心之间的距离;Izi,Xui,X|ui|ui,Xuiuiui,Yvi,Y|vi|vi,Y|ri|vi,Yri,Y|vi|ri,Y|ri|ri,Nvi,N|vi|vi,N|ri|vi,Nri,N|vi|ri,N|ri|ri为第i个水面无人艇的动力参数,通常可由海上试验得到。
在本实施例中,水面无人艇的系统参数分别为mi=23.8,xgi=0.046, Izi=1.760,Xui=-0.7225,X|ui|ui=-1.3274,Xuiuiui=-5.8664,Yvi=-0.8612,Y|vi|vi=-36.2823,Y|ri|vi=-0.805,Yri=0.1079,Y|vi|ri=-0.845,Y|ri|ri=-3.450,Nvi=0.1052,N|vi|vi=5.0437,N|ri|vi=0.130,Nri=-1.90,N|vi|ri=0.08,N|ri|ri=-0.750。
在本实例中,水面无人艇的初始位置、初始速度分别为:
η1(0)=[0,5.15,0]T,η2(0)=[0,10.03,0]T,η3(0)=[0,14.91,0]T,η4(0)=[0,20,0]T,η5(0)=[0,25,0]T,vi(0)=[0,0,0]T,i=1,2,3,4,5;
第1个水面无人艇领导者的参考轨迹η0、参考速度v0分别为:
η0=[60sin(0.05t),60(1-cos(0.05t)),0.05t]T,v0=[3cos(0.05t),3sin(0.05t),0.05]T如图3所示为领导者-跟随者编队中5个水面无人艇的运动轨迹图。
步骤(2):所述第i个水面无人艇与其领导者之间的距离变量di和角度具体由如下公式定义:
其中
为了保证水面无人艇能够实时利用通讯获取其领导者与跟随者的信息,要求在整个编队的运动过程中距离变量di满足碰撞避免和通讯约束条件:
dcol,i<di(t)<dcon,i
其中,dcol,i、dcon,i分别为设计的第i个水面无人艇的碰撞距离、通讯距离;
在本实施例中,选取第i个水面无人艇的碰撞距离dcol,i=4.7m,通讯距离dcon,i=5.3m。
为了保证水面无人艇编队满足碰撞避免和通讯约束条件以及保持领导者-跟随者编队形式,定义编队距离误差edi和方位角误差eψi:
edi=di-ddes,i
eψi=ψi-1-ψi
其中,ddes,i=(dcol,i+dcon,i)/2为设计的第i个水面无人艇与其领导者之间的期望距离,在本实施例中,选取第i个水面无人艇与其领导者的期望距离ddes,i=5m。编队距离误差edi满足以下约束条件:
dcol,i-ddes,i<edi(t)<dcon,i-ddes,i
进一步,要求编队距离误差edi和方位角误差eψi满足以下时变函数约束:
|edi|<βdi(t)
|eψi|<βψi(t)
步骤(3):所述指数递减的性能函数βji的具体形式为:
其中,βdi,0=dcon,i-ddes,i,βψi,0为性能函数的初始值,βji,∞为性能函数的稳态值,κji为性能函数的设计参数;在本实施例中,选取βdi,∞=0.05m,βψi,0=0.4rad,βψi,∞=0.1rad,κji=0.15。
采用tan型障碍李雅普诺夫函数为:
当设计的编队控制器能保证tan型障碍李雅普诺夫函数Vdi,Vψi始终有界,则误差edi,eψi始终满足|edi|<βdi(t),|eψi|<βψi(t);则编队距离变量di始终满足暂态性能的约束条件:
-βdi<edi<βdi
约束条件表示编队误差eji的收敛速度始终大于性能函数βji的收敛速度,编队误差eji的超调量始终小于性能函数βji所构造的边界。
如图4所示为编队距离变量di随时间的变化图,图5所示为编队方位角误差eψi随时间的变化图,可见距离变量di在经过一段时间的波动后最终能分别到达期望距离ddes,i附近,误差在零点附近的较小的领域内,且在调节过程中距离变量di与方位角误差eψi始终满足约束条件各个水面无人艇在运动过程中利用通讯获取其领导者与跟随者的信息,同时能避免与其领导者发生碰撞。
步骤(4):针对第i个水面无人艇,设计其速度估计器为:
其中, 为第i个水面无人艇位置ηi的估计值;为第i个水面无人艇速度vi的估计值; K1i>0为设计参数矩阵,K2i>0为设计参数矩阵,K3i>0为设计参数矩阵;在本实施例中,选取K1i=diag[2,2,2],K2i=diag[41,41,41],K3i=diag[20,20,20]。
设计RBF神经网络估计器的更新率为:
其中,Γl1i为自适应增益;σl1i>0为权值修正参数。在本实施例中,选取Γ11i=1,Γ21i=0.2,Γ31i=1,σ11i=0.001,σ21i=0.001,σ31i=0.005。
如图6所示为第1个水面无人艇的速度估计值与真实值,图7所示为第2个水面无人艇的速度估计值与真实值,图8所示为第3个水面无人艇的速度估计值与真实值,图9所示为第4个水面无人艇的速度估计值与真实值,图10所示为第5个水面无人艇的速度估计值与真实值,可见经过一段时间的波动后编队速度估计值基本与真实值相同。
步骤(5):结合步骤(4)中速度估计值,运用反步设计法针对距离误差系统和方位角误差系统进行虚拟控制器设计,得到的虚拟控制器为:
其中,kdi>0,kψi>0为设计参数;α1i表示针对纵向线速度动态模型设计的虚拟控制器;α2i表示针对横向线速度动态模型设计的虚拟控制器;α3i表示针对方位角速度动态模型设计的虚拟控制器;di表示第i个水面无人艇与其领导者之间的距离;为第i个水面无人艇的领导者纵向线速度、横向线速度、方位角速度的估计值。在本实施例中,选取kdi=80,kθi=200。
步骤(6)中:运用动态面技术,将虚拟控制器通过一阶滤波器得到滤波虚拟控制器:
其中αfi=[αf1i,αf2i,αf3i]T为滤波虚拟控制器,αf1i表示针对纵向线速度动态模型设计的虚滤波拟控制器,αf2i表示针对横向线速度动态模型设计的滤波虚拟控制器;αf3i表示针对方位角速度动态模型设计的滤波虚拟控制器;αi=[α1i,α2i,α3i]T为虚拟控制器;μi=diag[μ1i,μ2i,μ3i]>0为滤波时间常数; 在本实施例中,选取μi=diag[0.01,0.005,0.005]。
步骤(7)中:基于步骤(3)到步骤(6)中的tan型障碍李雅普诺夫函数、RBF神经网络、反步设计法与动态面技术设计编队控制器,具体为:
其中,K4i>0为设计参数矩阵;μi为滤波时间常数;I3为三阶单位阵; 在本实施例中,选取K4i=diag[20,20,20]。
设计RBF神经网络估计器的更新率为:
其中,Γli为自适应增益;σli>0为权值修正参数;在本实施例中,选取Γ1i=6,Γ2i=4,Γ3i=10,σ1i=0.05,σ2i=0.02,σ3i=0.01。
表示第i个水面无人艇的速度估计值与滤波虚拟控制器αfi之差:
eαi表示第i个水面无人艇的滤波虚拟控制器αfi与虚拟控制器αi之差:
eαi=αfi-αi
如图11所示为编队控制器τui,图12所示为编队控制器τvi,图13所示为编队控制器τri。
本实施例的编队控制器为基于输出反馈的编队控制器,即在领导者-跟随者编队结构中每个水面无人艇利用通讯获取其领导者与跟随者的信息,具体为位置、估计的速度信息,而不需要测量水面无人艇速度、加速度等信息。
本发明设计了具有对称边界的tan型障碍李雅普诺夫函数和指数递减性能函数,可保证编队误差始终在性能函数规定的界内,这既能确保在领导者-跟随者编队结构中,每个水面无人艇都能始终利用通讯获取其领导者与跟随者的信息,并避免与其领导者发生碰撞,还保证了编队误差的暂态性能。
基于输出反馈的领导者-跟随者编队结构中每个水面无人艇利用通讯获取其领导者与跟随者的信息,而不需要测量水面无人艇速度、加速度等信息。当利用传统反步法针对第i个水面无人艇设计控制器时需要虚拟控制器的导数信息,其中包含有输出反馈不可获取的领导者的加速度信息,本方法中采用动态面技术避免控制器设计过程中对虚拟控制器求导。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以权利要求所述为准。
Claims (8)
1.一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,包含以下步骤:
步骤(1):建立领导者-跟随者编队结构中水面无人艇的动态模型;
步骤(2):定义领导者-跟随者编队结构中第i个水面无人艇与其领导者之间的角度和距离变量di,i=1,2,3...N,并确保距离变量di满足水面无人艇的通讯约束条件,即第i个水面无人艇能够利用通讯获取其领导者与跟随者的信息;
步骤(3):根据领导者-跟随者编队距离误差edi和方位角误差eψi的约束条件,设计指数递减的性能函数βji,采用tan型障碍李雅普诺夫函数确保编队距离误差edi和方位角误差eψi满足暂态性能的约束条件;
步骤(4):领导者-跟随者编队中第i个水面无人艇利用通讯获取其领导者与其跟随者的位置信息,并结合其自身信息采用RBF神经网络设计速度估计器;
步骤(5):利用步骤(4)第i个水面无人艇速度估计值,运用反步设计法针对第i个水面无人艇的距离误差系统和方位角误差系统进行虚拟控制器设计;
步骤(6):领导者-跟随者编队结构中每个水面无人艇利用通讯获取其领导者与其跟随者的信息,在控制器设计中运用动态面技术避免对虚拟控制器求导;
步骤(7):基于步骤(3)到步骤(6)中的tan型障碍李雅普诺夫函数、RBF神经网络技术、反步设计法与动态面技术设计编队控制器。
2.根据权利要求1所述的一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,步骤(1)中,第i个水面无人艇的动态模型为:
其中,ηi=[xi,yi,ψi]T为第i个水面无人艇相对于大地坐标的位置和航向角,其中xi为第i个水面无人艇在x轴的坐标,yi为第i个水面无人艇在y轴的坐标,ψi为第i个水面无人艇的航向角;vi=[ui,vi,ri]T为第i个水面无人艇的速度向量,其中ui为第i个水面无人艇的纵向速度,vi为第i个水面无人艇的横向速度,ri为第i个水面无人艇的航向角速度;τi=[τui,τvi,τri]T为第i个水面无人艇的控制输入向量,其中τui为第i个水面无人艇的纵向控制输入,τvi为第i个水面无人艇的横向控制输入,τri为第i个水面无人艇的航向控制输入;J(ηi)为第i个水面无人艇的旋转矩阵;Mi为第i个水面无人艇的质量矩阵;C(vi)为第i个水面无人艇的科氏力矩阵;D(vi)为第i个水面无人艇的阻尼矩阵;其中:
其中 c13i(vi,ri)=-m22ivi-m23iri,d22i(vi,ri)=-Yvi-Y|vi|vi|vi|-Y|ri|vi|ri|,d23i(vi,ri)=-Yri-Y|vi|ri|vi|-Y|ri|ri|ri|,d32i(vi,ri)=-Nvi-N|vi|vi|vi|-N|ri|vi|ri|,d33i(vi,ri)=-Nri-N|vi|ri|vi|-N|ri|ri|ri|;mi表示第i个水面无人艇的质量;xgi表示第i个水面无人艇的中心和重心之间的距离;Izi,Xui,X|ui|ui,Xuiuiui,Yvi,Y|vi|vi,Y|ri|vi,Yri,Y|vi|ri,Y|ri|ri,Nvi,N|vi|vi,N|ri|vi,Nri,N|vi|ri,N|ri|ri为第i个水面无人艇的动力参数,由海上试验得到。
3.根据权利要求2所述的一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,步骤(2)中,所述第i个水面无人艇与其领导者之间的距离变量di和角度具体由如下公式定义:
为了保证水面无人艇能够实时利用通讯获取其领导者与跟随者的信息,要求在整个编队的运动过程中距离变量di满足碰撞避免和通讯约束条件:
dcol,i<di(t)<dcon,i
其中,dcol,i、dcon,i分别为设计的第i个水面无人艇的碰撞距离、通讯距离;
为了保证水面无人艇编队满足碰撞避免和通讯约束条件以及保持领导者-跟随者编队形式,定义编队距离误差edi和方位角误差eψi:
edi=di-ddes,i
eψi=ψi-1-ψi
其中,ddes,i=(dcol,i+dcon,i)/2为设计的第i个水面无人艇与其领导者之间的期望距离,编队距离误差edi满足以下约束条件:
dcoi,i-ddes,i<edi(t)<dcon,i-ddes,i
进一步,要求编队距离误差edi和方位角误差eψi满足以下时变函数约束:
|edi|<βdi(t)
|eψi|<βψi(t)。
4.根据权利要求3所述的一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,步骤(3)中,所述指数递减的性能函数βji的具体形式为:
其中,βdi,0=dcon,i-ddes,i,βψi,0分别为距离、方位角性能函数的初始值,βji,∞为性能函数的稳态值,κji为性能函数的设计参数;
采用tan型障碍李雅普诺夫函数为:
当设计的编队控制器能保证tan型障碍李雅普诺夫函数Vdi,Vψi始终有界,则误差edi,eψi始终满足|edi|<βdi(t),|eψi|<βψi(t);则编队距离变量di始终满足暂态性能的约束条件:
-βdi<edi<βdi
约束条件表示编队误差eji的收敛速度始终大于性能函数βji的收敛速度,编队误差eji的超调量始终小于性能函数βji所构造的边界。
5.根据权利要求4所述的一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,步骤(4)中,针对第i个水面无人艇,设计其速度估计器为:
其中, 为第i个水面无人艇位置ηi的估计值;为第i个水面无人艇速度vi的估计值; K1i>0为设计参数矩阵,K2i>0为设计参数矩阵,K3i>0为设计参数矩阵;
设计RBF神经网络速度估计器的更新率为:
其中,Γl1i为自适应增益;σl1i>0为权值修正参数。
6.根据权利要求5所述的一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,步骤(5)中,结合步骤(4)中速度估计值,运用反步设计法针对距离误差系统和方位角误差系统进行虚拟控制器设计,得到的虚拟控制器为:
其中,α1i表示针对纵向线速度动态模型设计的虚拟控制器;α2i表示针对横向线速度动态模型设计的虚拟控制器;α3i表示针对方位角速度动态模型设计的虚拟控制器;kdi>0,kψi>0为设计参数。
7.根据权利要求6所述的一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,步骤(6)中,运用动态面技术,将虚拟控制器通过一阶滤波器得到滤波虚拟控制器:
其中,αfi=[αf1i,αf2i,αf3i]T为滤波虚拟控制器,αf1i表示针对纵向线速度动态模型设计的虚滤波拟控制器,αf2i表示针对横向线速度动态模型设计的滤波虚拟控制器,αf3i表示针对方位角速度动态模型设计的滤波虚拟控制器;αi=[α1i,α2i,α3i]T为虚拟控制器;μi=diag[μ1i,μ2i,μ3i]>0为滤波时间常数;
8.根据权利要求7所述的一种具有预设性能的无人艇输出反馈编队控制设计方法,其特征在于,步骤(7)中,基于步骤(3)到步骤(6)中的tan型障碍李雅普诺夫函数、RBF神经网络、反步设计法与动态面技术设计编队控制器,具体为:
其中,K4i>0为设计参数矩阵;μi为滤波时间常数;I3为三阶单位阵;
设计RBF神经网络估计器的更新率为:
其中,Γli为自适应增益;σli>0为权值修正参数;
表示第i个水面无人艇的速度估计值与滤波虚拟控制器αfi之差:
eαi表示第i个水面无人艇的滤波虚拟控制器αfi与虚拟控制器αi之差:
eαi=αfi-αi。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910560206.2A CN110362075B (zh) | 2019-06-26 | 2019-06-26 | 一种具有预设性能的无人艇输出反馈编队控制设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910560206.2A CN110362075B (zh) | 2019-06-26 | 2019-06-26 | 一种具有预设性能的无人艇输出反馈编队控制设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110362075A true CN110362075A (zh) | 2019-10-22 |
CN110362075B CN110362075B (zh) | 2020-09-22 |
Family
ID=68216878
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910560206.2A Active CN110362075B (zh) | 2019-06-26 | 2019-06-26 | 一种具有预设性能的无人艇输出反馈编队控制设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110362075B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111506114A (zh) * | 2020-05-25 | 2020-08-07 | 北京理工大学 | 一种飞行器编队控制方法 |
CN111650943A (zh) * | 2020-06-19 | 2020-09-11 | 哈尔滨理工大学 | 一种速度受限的静水下动力定位船轨迹跟踪预设性能控制方法 |
CN112363393A (zh) * | 2020-10-27 | 2021-02-12 | 华中科技大学 | 无人艇动力定位的无模型自适应预设性能控制方法 |
CN113359737A (zh) * | 2021-06-17 | 2021-09-07 | 大连海事大学 | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 |
CN113759973A (zh) * | 2021-09-13 | 2021-12-07 | 汕头大学 | 一种无人机集群的目标搜索控制方法及系统 |
CN113848710A (zh) * | 2021-09-21 | 2021-12-28 | 西北工业大学 | 一种针对无人机直流供电系统的反步有限时间控制方法 |
CN114355879A (zh) * | 2021-11-26 | 2022-04-15 | 珠海云洲智能科技股份有限公司 | 无人船及其编队的队形保持控制方法 |
CN115542904A (zh) * | 2022-09-27 | 2022-12-30 | 安徽对称轴智能安全科技有限公司 | 群组式协同消防机器人火场内编组队列行驶控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104133375A (zh) * | 2014-08-14 | 2014-11-05 | 大连海事大学 | 一种多auv同步控制器结构及设计方法 |
CN107085427A (zh) * | 2017-05-11 | 2017-08-22 | 华南理工大学 | 一种基于领导跟随结构的无人水面艇编队控制方法 |
CN108008628A (zh) * | 2017-11-17 | 2018-05-08 | 华南理工大学 | 一种不确定欠驱动无人艇系统的预设性能控制方法 |
CN108983786A (zh) * | 2018-08-08 | 2018-12-11 | 华南理工大学 | 一种通讯范围约束下移动机器人的编队控制方法 |
CN108983612A (zh) * | 2018-08-08 | 2018-12-11 | 华南理工大学 | 一种具有预设性能和连接保持的水下机器人编队控制方法 |
CN109857115A (zh) * | 2019-02-27 | 2019-06-07 | 华南理工大学 | 一种基于视觉反馈的移动机器人的有限时间编队控制方法 |
-
2019
- 2019-06-26 CN CN201910560206.2A patent/CN110362075B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104133375A (zh) * | 2014-08-14 | 2014-11-05 | 大连海事大学 | 一种多auv同步控制器结构及设计方法 |
CN107085427A (zh) * | 2017-05-11 | 2017-08-22 | 华南理工大学 | 一种基于领导跟随结构的无人水面艇编队控制方法 |
CN108008628A (zh) * | 2017-11-17 | 2018-05-08 | 华南理工大学 | 一种不确定欠驱动无人艇系统的预设性能控制方法 |
CN108983786A (zh) * | 2018-08-08 | 2018-12-11 | 华南理工大学 | 一种通讯范围约束下移动机器人的编队控制方法 |
CN108983612A (zh) * | 2018-08-08 | 2018-12-11 | 华南理工大学 | 一种具有预设性能和连接保持的水下机器人编队控制方法 |
CN109857115A (zh) * | 2019-02-27 | 2019-06-07 | 华南理工大学 | 一种基于视觉反馈的移动机器人的有限时间编队控制方法 |
Non-Patent Citations (9)
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111506114A (zh) * | 2020-05-25 | 2020-08-07 | 北京理工大学 | 一种飞行器编队控制方法 |
CN111650943A (zh) * | 2020-06-19 | 2020-09-11 | 哈尔滨理工大学 | 一种速度受限的静水下动力定位船轨迹跟踪预设性能控制方法 |
CN112363393A (zh) * | 2020-10-27 | 2021-02-12 | 华中科技大学 | 无人艇动力定位的无模型自适应预设性能控制方法 |
CN113359737A (zh) * | 2021-06-17 | 2021-09-07 | 大连海事大学 | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 |
CN113759973A (zh) * | 2021-09-13 | 2021-12-07 | 汕头大学 | 一种无人机集群的目标搜索控制方法及系统 |
CN113759973B (zh) * | 2021-09-13 | 2023-07-25 | 汕头大学 | 一种无人机集群的目标搜索控制方法及系统 |
CN113848710A (zh) * | 2021-09-21 | 2021-12-28 | 西北工业大学 | 一种针对无人机直流供电系统的反步有限时间控制方法 |
CN113848710B (zh) * | 2021-09-21 | 2023-02-17 | 西北工业大学 | 一种针对无人机直流供电系统的反步有限时间控制方法 |
CN114355879A (zh) * | 2021-11-26 | 2022-04-15 | 珠海云洲智能科技股份有限公司 | 无人船及其编队的队形保持控制方法 |
CN115542904A (zh) * | 2022-09-27 | 2022-12-30 | 安徽对称轴智能安全科技有限公司 | 群组式协同消防机器人火场内编组队列行驶控制方法 |
CN115542904B (zh) * | 2022-09-27 | 2023-09-05 | 安徽对称轴智能安全科技有限公司 | 群组式协同消防机器人火场内编组队列行驶控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110362075B (zh) | 2020-09-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110362075A (zh) | 一种具有预设性能的无人艇输出反馈编队控制设计方法 | |
CN107085427B (zh) | 一种基于领导跟随结构的无人水面艇编队控制方法 | |
CN113189979B (zh) | 一种无人船的分布式队列有限时间控制方法 | |
CN104950678B (zh) | 一种柔性机械臂系统的神经网络反演控制方法 | |
CN108983786A (zh) | 一种通讯范围约束下移动机器人的编队控制方法 | |
CN106502250B (zh) | 三维空间内多机器人编队的路径规划算法 | |
CN108073185A (zh) | 多无人机同时到达协同控制方法 | |
CN107160398B (zh) | 基于确定学习的全状态受限刚性机械臂安全可靠控制方法 | |
CN109857115A (zh) | 一种基于视觉反馈的移动机器人的有限时间编队控制方法 | |
CN107121986A (zh) | 一种基于行为的无人机编队队形保持的方法 | |
CN107454947A (zh) | 无人机控制方法、头戴式显示眼镜及系统 | |
CN109283934A (zh) | 基于旋转路径质量的航天器多约束姿态机动优化方法 | |
CN105242533A (zh) | 一种融合多信息的变导纳遥操作控制方法 | |
CN105843246A (zh) | 无人机跟踪方法、系统及无人机 | |
CN111496796B (zh) | 基于指令滤波器的机械臂轨迹跟踪控制方法及装置 | |
CN105549395B (zh) | 保证瞬态性能的机械臂伺服系统死区补偿控制方法 | |
CN112859596B (zh) | 一种考虑编队避障的非线性遥操作多边控制方法 | |
CN110262494A (zh) | 一种同构多无人艇系统的协同学习与编队控制方法 | |
CN105135611B (zh) | 一种空调控制方法及智能手表 | |
CN107861382A (zh) | 一种多执行水下机器人鲁棒自适应运动控制装置及其方法 | |
CN109933074A (zh) | 一种有领导者的多无人船群集运动控制器结构及设计方法 | |
CN109976150A (zh) | 一类欠驱动多输入多输出系统集中式自抗扰控制方法 | |
Li et al. | Multi-UUV formation coordination control based on combination of virtual structure and leader | |
CN114721275A (zh) | 一种基于预设性能的视觉伺服机器人自适应跟踪控制方法 | |
CN114265308A (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 |