CN112650257B - 一种无人艇区域保持控制方法及装置 - Google Patents
一种无人艇区域保持控制方法及装置 Download PDFInfo
- Publication number
- CN112650257B CN112650257B CN202011613185.5A CN202011613185A CN112650257B CN 112650257 B CN112650257 B CN 112650257B CN 202011613185 A CN202011613185 A CN 202011613185A CN 112650257 B CN112650257 B CN 112650257B
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- sliding mode
- speed
- mode controller
- 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.)
- Active
Links
- 238000012423 maintenance Methods 0.000 title claims abstract description 29
- 238000000034 method Methods 0.000 title claims abstract description 23
- 230000004888 barrier function Effects 0.000 claims abstract description 18
- 230000006870 function Effects 0.000 claims description 23
- 230000001960 triggered effect Effects 0.000 claims description 13
- 238000013459 approach Methods 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 230000007613 environmental effect Effects 0.000 claims description 5
- 230000008859 change Effects 0.000 claims description 3
- 230000009471 action Effects 0.000 abstract description 4
- 230000007246 mechanism Effects 0.000 abstract description 4
- 238000011217 control strategy Methods 0.000 abstract description 3
- 230000002035 prolonged effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 3
- 238000004873 anchoring Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000003189 isokinetic effect Effects 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012544 monitoring process 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)
- Feedback Control In General (AREA)
Abstract
本申请公开了一种无人艇区域保持控制方法及装置,所述方法包括,先确定所述无人艇的虚拟控制律;再确定所述无人艇的速度跟踪的非线性滑模面;再结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器;最后根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件,并当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。本申请通过引入对称障碍李雅普诺夫函数将区域保持问题转化为具有输出状态变量约束系统的控制问题,简化了区域保持控制策略,并进一步通过设置事件触发机制,在完成区域保持的同时降低了推进器动作频率,延长了推进器使用寿命。
Description
技术领域
本申请涉及无人艇控制技术,尤其涉及一种无人艇区域保持控制方法及装置。
背景技术
近年来无人艇在军用和民用领域的应用日益广泛。无人艇可搭载多种任务载荷代替有人驾驶船舶在危险特殊水域执行任务,诸如对指定区域进行水样气象监测,在特殊条件下提供中继通信支持,或对不明海域进行情报搜集环境探测以及配合水下潜器执行区域作业等。上述任务都要求无人艇在作业的同时保持在规定区域内,即具备区域保持能力。
现有的区域保持控制技术主要包括:一锚泊控制,即依靠沉于海底的锚抓力来抵抗外界环境干扰;二采用船舶自身动力或动力定位系统进行控制,即利用船舶上的推进装置产生推力来抵抗外界环境干扰,使船舶保持在规定区域内。
无人艇由于体型小、结构简单,受空间等因素限制、缺少横向驱动装置,也无法安装锚泊或动力定位系统,所以不同于全驱动动力定位船或者大型海洋工作平台,无法采用锚泊或动力定位系统实现区域保持。同时,无人艇具有欠驱动性、高度非线性、强耦合性,易受外界环境干扰影响,因此无人艇区域保持的实现也比较困难。此外,区域保持控制不同于跟踪控制,它只需在外界环境干扰下保证无人艇保持在规定作业区域内不超出区域边界即可,对于无人艇的运动方式、控制精度和收敛速度不作要求。所以,如何通过较低的代价,来获得接近于时间触发的控制效果,避免推进器频繁动作,是欠动力无人艇在区域保持技术方面亟待解决的现实问题。
发明内容
(一)发明目的
针对现有技术的上述缺陷,本申请提出了一种无人艇区域保持控制方法,所述方法通过引入障碍李雅普诺夫函数将区域保持问题转化为具有输出状态变量约束系统的控制问题,简化了区域保持控制策略,并进一步通过设置事件触发机制,在完成区域保持的同时降低了推进器动作频率,延长了推进器使用寿命。
(二)技术方案
为解决上述问题,本申请实施例的第一方面提供了一种无人艇区域保持控制方法,包括:
根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律;
根据所述虚拟控制律确定所述无人艇当前时点的期望纵、横向速度;
根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度跟踪的非线性滑模面;
在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,所述鲁棒滑模控制器用于向所述无人艇的推进器发出区域保持的控制信号;
根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件;
当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。
一些实施例中,所述方法还包括:
当所述触发条件不满足时,通过零阶保持器使所述推进器接收到的所述控制信号保持不变。
一些实施例中,所述三自由度运动方程为:
其中,η=[x,y,ψ]T、υ=[u,v,r]T、τ=[τu,0,τr]T分别表示北东坐标系下所述无人艇的位置、速度和推进力,x,y,ψ分别表示北向、东向位置和艏向角,u,v,r分别表示纵向速度、横向速度和艏摇角速度,τu,τr分别表示纵向力和转艏力矩,表示其一阶导数,/>du=-Xu-Xu|u||u|,dv=-Yv-Yv|v||v|,dr=-Nr-Nr|r||r|。/>Yv,Xu,Nr,Xu|u|,Yv|v|,Nr|r|均表示水动力参数,表示外界环境干扰在纵向、横向和艏向上的力和力矩。
一些实施例中,根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律,包括:
设定所述无人艇初始位置和速度跟踪误差xe,ye,ue,ve,对时间求导并代入式(1)得式(2)如下:
由式(2)确定所述无人艇纵、横向期望速度的虚拟控制律式如式(3):
其中,xd,yd和αu,αv分别表示期望位置和期望速度,k1,k2>0和h1,h2>0表示待定参数,h1,h2根据无人艇最大速度的物理限制进行设定,k1,k2为收敛系数。
一些实施例中,根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度跟踪的非线性滑模面,包括:
将所述无人艇的规定区域的中心作为圆心O(0,0),r作为区域半径,期望航迹半径为ra,且ra<r;
设定区域保持误差变量且de满足de<kd,0<|kd|<r-ra;
将所述无人艇的运动航迹设定在所述规定区域内;
为使所述无人艇跟踪期望速度αu与αv,确定非线性滑模面如下式:
其中,待确定参数ξ1,ξ2,ξ3,ξ4>0。
一些实施例中,在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,包括:
对式(9)(9)和(10)(10)求导,并将式(1)和(2)代入得:
选取等速趋近律如式(13)、(14):
其中,C1,C2>0表示待确定控制参数;
取引入障碍李雅普诺夫函数得到鲁棒滑模控制器如下式:
其中,中间变量形式如下:
一些实施例中,根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件,包括:
定义tj(j=0,1,2…)表示每次所述控制信号更新的时间序列,变量和/>则事件触发的区域保持鲁棒滑模控制器如下式:
τ*(t)=τ*(ζ*(tj)),t∈[tj,tj+1) (20)
定义跟踪误差阈值如下:
根据跟踪误差阈值的定义,事件触发的区域保持鲁棒滑模控制器(20)重写为式(23);
τ*(t)=τ*(ζ*(t)+e*(t)),t∈[tj,tj+1) (23)
为了采用时间触发鲁棒滑模控制器的稳定性分析方法,将上述控制器连续化表示如下:
τ*(ζ*(tj))=τ*(ζ*(t))+τ*(ζ*(t)+e*(t))-τ*(ζ*(t)) (24)
设定初始跟踪误差的范数满足||[xe(0),ye(0)]||≤kd,kd>0,假设控制输入τ*=τ*(ζ*(t))的Lipschitz常数是θi,可知:
其中,紧集Su={ζu:||s1||≤a1,||xe,ye||≤ku},a1,a2,a3>0,ku>0;
为了使区域保持误差变量de始终保持在约束区域内,构造如下带有对称障碍李雅普诺夫的函数V2:
对式(26)求导,并结合式(24)、(25)可知:
得出初始事件触发条件如下:
t0=min{t≥0:||xe,ye||≥ku,ku≤kd} (28)
进一步确定鲁棒滑模控制器的触发条件可表示如下:
tj=min{t≥tj-1:||e||≥W(s1,s2)&||xe,ye||≥ku>0},||e||=min(||eu||,||er||) (29)
其中,0<σ<1,(s1,s2)≠0,θu>0,θr>0。
本申请实施例的第二方面提供了一种无人艇区域保持控制装置,包括:
虚拟控制律确定模块,用于根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律;
期望速度确定模块,用于根据所述虚拟控制律确定所述无人艇当前时点的期望纵、横向速度;
非线性滑模面确定模块,用于根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度变化的非线性滑模面;
鲁棒滑模控制器确定模块,用于在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,所述鲁棒滑模控制器用于向所述无人艇的推进器发出区域保持的控制信号;
事件触发条件设置模块,用于依据预设的所述无人艇的跟踪误差阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件,所述跟踪误差阈值包括所述无人艇的位置误差,速度误和/或区域保持误差;
控制信号发送模块,用于当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。
本申请实施例的第三方面提供了一种电子设备,包括存储器和处理器;所述存储器,用于存储计算机程序;所述处理器,用于当执行所述计算机程序时,实现上述任一项所述的方法
本申请实施例的第四方面提供了一种无人艇,所述无人艇采用了上述的区域保持控制装置。
(三)有益效果
本申请的上述技术方案具有如下有益的技术效果:
本申请实施例根据未知时变外界环境干扰下无人艇的三自由度运动方程确定无人艇的虚拟控制律,根据虚拟控制律确定所述无人艇当前时点的期望纵、横向速度;通过无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度跟踪的非线性滑模面;进而在非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器。并根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件;当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。其通过引入障碍李雅普诺夫函数将区域保持问题转化为具有输出状态变量约束系统的控制问题,简化了区域保持控制策略,并进一步通过设置事件触发机制,在完成区域保持的同时降低了推进器动作频率,延长了推进器使用寿命。
附图说明
图1是本申请实施例控制方法的流程示意图;
图2是本申请实施例中无人艇在北东坐标系和船体坐标系下的示意图;
图3是本申请实施例中鲁棒滑模控制器的事件触发原理框图,其中,u(t),y(t)表示闭环控制系统的输入和输出,x(t)表示系统状态。
图4是本申请实施例中无人艇区域保护控制的控制原理框图;
图5是本申请实施例控制装置的结构框图。
具体实施方式
为使本申请的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本申请进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本申请的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本申请的概念。
图1是本申请实施例控制方法的流程示意图。
如图1所示,本申请第一方面提供了一种无人艇区域保持控制方法,包括:
步骤110:根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律;
步骤120:根据所述虚拟控制律确定所述无人艇当前时点的期望纵、横向速度;
步骤130:根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度跟踪的非线性滑模面;
步骤140:在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,所述鲁棒滑模控制器用于向所述无人艇的推进器发出区域保持的控制信号;
步骤150:根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件;
步骤160:当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。
一些实施例中,所述方法还包括:
步骤170:当所述触发条件不满足时,通过零阶保持器使所述推进器接收到的所述控制信号保持不变。
图2是本申请实施例中无人艇在北东坐标系和船体坐标系下的示意图。
如图2所示,步骤110中无人艇在北东坐标系下的三自由度运动方程为:
其中,η=[x,y,ψ]T、υ=[u,v,r]T、τ=[τu,0,τr]T分别表示北东坐标系下所述无人艇的位置、速度和推进力,x,y,ψ分别表示北向、东向位置和艏向角,u,v,r分别表示纵向速度、横向速度和艏摇角速度,τu,τr分别表示纵向力和转艏力矩,表示其一阶导数,/>du=-Xu-Xu|u||u|,dv=-Yv-Yv|v||v|,dr=-Nr-Nr|r||r|。/>Yv,Xu,Nr,Xu|u|,Yv|v|,Nr|r|均表示水动力参数,表示外界环境干扰在纵向、横向和艏向上的力和力矩。
步骤110中根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律,包括:
设定所述无人艇初始位置和速度跟踪误差xe,ye,ue,ve,对时间求导并代入式(1)得式(2)如下:
由式(2)确定所述无人艇纵、横向期望速度的虚拟控制律式如式(3):
其中,xd,yd和αu,αv分别表示期望位置和期望速度,k1,k2>0和h1,h2>0表示待定参数,h1,h2根据无人艇最大速度的物理限制进行设定,k1,k2为收敛系数。
步骤130中根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度跟踪的非线性滑模面,包括:
将所述无人艇的规定区域的中心作为圆心O(0,0),r作为区域半径,期望航迹半径为ra,且ra<r;
设定区域保持误差变量且de满足de<kd,0<|kd|<r-ra;
将所述无人艇的运动航迹设定在所述规定区域内;
为使所述无人艇跟踪期望速度αu与αv,确定非线性滑模面如下式:
其中,待确定参数ξ1,ξ2,ξ3,ξ4>0。
图3是本申请实施例中鲁棒滑模控制器的事件触发原理框图,其中,u(t),y(t)表示闭环控制系统的输入和输出,x(t)表示系统状态。
如图3所示,步骤140中在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,包括:
对式(9)(9)和(10)(10)求导,并将式(1)和(2)代入得:
选取等速趋近律如式(13)、(14):
其中,C1,C2>0表示待确定控制参数;
取引入障碍李雅普诺夫函数得到鲁棒滑模控制器如下式:
其中,中间变量形式如下:
步骤150根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件,包括:
定义tj(j=0,1,2…)表示每次所述控制信号更新的时间序列,变量和/>则事件触发的区域保持鲁棒滑模控制器如下式:
τ*(t)=τ*(ζ*(tj)),t∈[tj,tj+1) (20)
定义跟踪误差的阈值如下:
根据跟踪误差阈值的定义,事件触发的区域保持鲁棒滑模控制器(20)重写为式(23);
τ*(t)=τ*(ζ*(t)+e*(t)),t∈[tj,tj+1) (23)
为了采用时间触发鲁棒滑模控制器的稳定性分析方法,将上述控制器连续化表示如下:
τ*(ζ*(tj))=τ*(ζ*(t))+τ*(ζ*(t)+e*(t))-τ*(ζ*(t)) (24)
设定初始跟踪误差的范数满足||[xe(0),ye(0)]||≤kd,kd>0,假设控制输入τ*=τ*(ζ*(t))的Lipschitz常数是θi,可知:
其中,紧集Su={ζu:||s1||≤a1,||xe,ye||≤ku},a1,a2,a3>0,ku>0;
为了使区域保持误差变量de始终保持在约束区域内,构造如下带有对称障碍李雅普诺夫的函数V2:
对式(26)求导,并结合式(24)、(25)可知:
得出初始事件触发条件如下:
t0=min{t≥0:||xe,ye||≥ku,ku≤kd} (28)
进一步确定鲁棒滑模控制器的触发条件可表示如下:
tj=min{t≥tj-1:||e||≥W(s1,s2)&||xe,ye||≥ku>0},||e||=min(||eu||,||er||) (29)
其中,0<σ<1,(s1,s2)≠0,θu>0,θr>0。
图4是本申请实施例中无人艇区域保护控制的控制原理框图。
一些实施例中,如图4所示,本申请无人艇区域保护控制方法包括:
步骤1:先确定未知时变外界环境干扰下的无人艇三自由度运动方程如下:
其中,η=[x,y,ψ]T、υ=[u,v,r]T、τ=[τu,0,τr]T分别表示北东坐标系下的位置、速度和推进力,x,y,ψ分别表示北向、东向位置和艏向角,u,v,r分别表示纵向速度、横向速度和艏摇角速度,τu,τr分别表示纵向力和转艏力矩,表示其一阶导数,/>du=-Xu-Xu|u||u|,dv=-Yv-Yv|v||v|,dr=-Nr-Nr|r||r|。/>Yv,Xu,Nr,Xu|u|,Yv|v|,Nr|r|均表示水动力参数,表示外界环境干扰在纵向、横向和艏向上的力和力矩。
定义无人艇位置和速度跟踪误差xe,ye,ue,ve,对时间求导并代入式(1)可得:
为避免虚拟控制律的设计缺陷结合注释1,设计期望纵向和横向速度即虚拟控制律如下:
其中,xd,yd和αu,αv分别表示期望位置和期望速度,k1,k2>0和h1,h2>0表示待设计参数,h1,h2根据无人艇最大速度的物理限制合理选择,k1,k2会影响系统收敛速度。
根据式(1)和(3)可得(4)如下:
将式(3)和(4)代入式(2)得式(5)如下:
其中,矩阵非奇异且模值为1,则当ue,ve趋近于零时,由式(5)知/>和/>也均趋近于零,可得:/>
然后,构造如下李雅普诺夫函数V1:
将V1求导并代入式(6)可得:
已知k1,k2>0和h1,h2>0,显然对满足/>所以当无人艇纵向和横向速度跟踪期望速度(3)时,可得无人艇位置跟踪误差xe,ye是渐近收敛于任意小零值邻域的。
步骤2:假定无人艇的规定区域是以O(0,0)为圆心,r为半径的圆形区域,期望航迹半径为ra,且ra<r。首先定义区域保持误差变量且de满足de<kd,0<|kd|<r-ra。区域保持任务即可描述为始终保持无人艇的运动航迹在圆内且不超出圆形区域边界。为使无人艇跟踪期望速度αu与αv,设计如下非线性滑模面:
其中,待设计参数ξ1,ξ2,ξ3,ξ4>0。
对式(9)和(10)求导,并将式(9)和(10)分别代入(1)和(2)得:
选取等速趋近律如下:
其中,C1,C2>0表示待设计控制参数。
然后,取引入障碍李雅普诺夫函数设计如下鲁棒滑模控制律:
其中,中间变量形式如下:
步骤3:为了得到无人艇事件触发区域保持鲁棒滑模控制器,定义和/>因此控制输入(15)和(16)变为τ*=τ*(ζ*),*=u,r,定义tj(j=0,1,2…)表示每次控制输入更新的时间序列,则事件触发区域保持鲁棒滑模饱和控制器的表达式如下:
τ*(t)=τ*(ζ*(tj)),t∈[tj,tj+1) (20)
为了便于进一步分析,定义跟踪误差阈值如下:
对于每个j,e*(tj)=0,即显然当t=tj时e*是不连续的。根据跟踪误差阈值的定义,事件触发区域保持鲁棒滑模控制器(20)重写为:/>
τ*(t)=τ*(ζ*(t)+e*(t)),t∈[tj,tj+1) (23)
为了采用时间触发鲁棒滑模控制器的稳定性分析方法,将上述控制器连续化表示如下:
τ*(ζ*(tj))=τ*(ζ*(t))+τ*(ζ*(t)+e*(t))-τ*(ζ*(t)) (24)
由于事件触发机制的时间序列是由事件触发条件动态确定的,下面将推导事件触发条件以便确定控制律(20)的更新时间。
从实际应用看,初始跟踪误差的范数满足||[xe(0),ye(0)]||≤kd,kd>0,假设控制输入τ*=τ*(ζ*(t))的Lipschitz常数是θi,可知:
其中,紧集Su={ζu:||s1||≤a1,||xe,ye||≤ku},a1,a2,a3>0,ku>0。
为了使区域保持误差变量de始终保持在约束区域内,构造如下带有障碍李雅普诺夫函数的函数V2:
对式(26)求导,并结合式(24)(25)可知:
由于事件触发区域保持鲁棒滑模饱和控制器更新时间tj的计算取决于上一次的更新时间tj-1,所以初始更新时间t0需要单独给出,且初始更新时间不一定从t=0时刻开始。则初始事件触发条件可描述如下:
t0=min{t≥0:||xe,ye||≥ku,ku≤kd} (28)
这里假设初始更新时间触发之前推进器不工作,即τ*=0,0≤t<t0。
最终,事件触发区域保持鲁棒滑模控制器的触发条件可表示如下:
tj=min{t≥tj-1:||e||≥W(s1,s2)&||xe,ye||≥ku>0},||e||=min(||eu||,||er||) (29)
其中,0<σ<1,(s1,s2)≠0,θu>0,θr>0。
图5是本申请实施例控制装置的结构框图。
如图5所示,本申请第二方面提供了一种无人艇区域保持控制装置,包括:
虚拟控制律确定模块001,用于根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律;
期望速度确定模块002,用于根据所述虚拟控制律确定所述无人艇当前时点的期望纵、横向速度;
非线性滑模面确定模块003,用于根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度变化的非线性滑模面;
鲁棒滑模控制器确定模块004,用于在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,所述鲁棒滑模控制器用于向所述无人艇的推进器发出区域保持的控制信号;
事件触发条件设置模块005,用于依据预设的所述无人艇的跟踪误差阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件,所述跟踪误差阈值包括所述无人艇的位置误差,速度误和/或区域保持误差;
控制信号发送模块006,用于当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。
一些实施例中,所述控制装置还包括:
控制信号保持模块007,用于当所述触发条件不满足时,通过零阶保持器使所述推进器接收到的所述控制信号保持不变。
本申请第三方面提供了一种电子设备,包括存储器和处理器;所述存储器,用于存储计算机程序;所述处理器,用于当执行所述计算机程序时,实现上述任一方法实施例述的控制方法。
本申请第四方面提供了一种无人艇,该无人艇采用了上述装置实施例所述的区域保持控制装置。
应当理解的是,本申请的上述具体实施方式仅仅用于示例性说明或解释本申请的原理,而不构成对本申请的限制。因此,在不偏离本申请的精神和范围的情况下所做的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。此外,本申请所附权利要求旨在涵盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内的全部变化和修改例。
Claims (6)
1.一种无人艇区域保持控制方法,其特征在于,包括:
根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律;
其中,所述三自由度运动方程为:
其中,η=[x,y,ψ]Τ、υ=[u,v,r]Τ、τ=[τu,0,τr]Τ分别表示北东坐标系下所述无人艇的位置、速度和推进力,x,y,ψ分别表示北向、东向位置和艏向角,u,v,r分别表示纵向速度、横向速度和艏摇角速度,τu,τr分别表示纵向力和转艏力矩,表示其一阶导数,/> du=-Xu-Xu|u||u|,dv=-Yv-Yv|v||v|,dr=-Nr-Nr|r||r|,/>Yv,Xu,Nr,Xu|u|,Yv|v|,Nr|r|均表示水动力参数,表示外界环境干扰在纵向、横向和艏向上的力和力矩;
所述无人艇的虚拟控制律,包括:
设定所述无人艇初始位置和速度跟踪误差xe,ye,ue,ve,对时间求导并代入式(1)得式(2)如下:
由式(2)确定所述无人艇纵、横向期望速度的虚拟控制律式如式(3):
其中,xd,yd和αu,αv分别表示期望位置和期望速度,k1,k2>0和h1,h2>0表示待定参数,h1,h2根据无人艇最大速度的物理限制进行设定,k1,k2为收敛系数;
根据所述虚拟控制律确定所述无人艇当前时点的期望纵、横向速度;
根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度跟踪的非线性滑模面,包括:
将所述无人艇的规定区域的中心作为圆心O(0,0),r作为区域半径,期望航迹半径为ra,且ra<r;
设定区域保持误差变量且de满足de<kd,0<|kd|<r-ra;
将所述无人艇的运动航迹设定在所述规定区域内;
为使所述无人艇跟踪期望速度αu与αv,确定非线性滑模面如下式:
其中,待确定参数ξ1,ξ2,ξ3,ξ4>0;
在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,所述鲁棒滑模控制器用于向所述无人艇的推进器发出区域保持的控制信号,包括:
对式(9)和(10)求导,并将式(1)和(2)代入得:
选取等速趋近律如式(13)、(14):
其中,C1,C2>0表示待确定控制参数;
取η1≥τwumax,η2≥τwrmax,引入障碍李雅普诺夫函数得到鲁棒滑模控制器如下式:
其中,中间变量形式如下:
根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件;
当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。
2.根据权利要求1所述的控制方法,其特征在于,所述方法还包括:
当所述触发条件不满足时,通过零阶保持器使所述推进器接收到的所述控制信号保持不变。
3.根据权利要求2所述的控制方法,其特征在于,根据预设的所述跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件,包括:
定义tj表示每次所述控制信号更新的时间序列,j=0,1,2,变量和/>则事件触发的区域保持鲁棒滑模控制器如下式:
τ*(t)=τ*(ζ*(tj)),t∈[tj,tj+1) (20)
定义跟踪误差阈值如下:
根据跟踪误差阈值定义,事件触发的区域保持鲁棒滑模控制器(20)重写为式(23);
τ*(t)=τ*(ζ*(t)+e*(t)),t∈[tj,tj+1) (23)
为了采用时间触发鲁棒滑模控制器的稳定性分析方法,将上述控制器连续化表示如下:
τ*(ζ*(tj))=τ*(ζ*(t))+τ*(ζ*(t)+e*(t))-τ*(ζ*(t)) (24)
设定初始跟踪误差的范数满足||[xe(0),ye(0)]||≤kd,kd>0,假设控制输入τ*=τ*(ζ*(t))的Lipschitz常数是θi,可知:
其中,紧集Su={ζu:||s1||≤a1,||xe,ye||≤ku},a1,a2,a3>0,ku>0;
为了使区域保持误差变量de始终保持在约束区域内,构造如下带有对称障碍李雅普诺夫的函数V2:
对式(26)求导,并结合式(24)、(25)可知:
得出初始事件触发条件如下:
t0=min{t≥0:||xe,ye||≥ku,ku≤kd} (28)
进一步确定鲁棒滑模控制器的触发条件可表示如下:
tj=min{t≥tj-1:||e||≥W(s1,s2)&||xe,ye||≥ku>0},||e||=min(||eu||,||er||) (29)
其中,0<σ<1,(s1,s2)≠0,θu>0,θr>0。
4.一种无人艇区域保持控制装置,其特征在于,包括:
虚拟控制律确定模块,用于根据未知时变外界环境干扰下无人艇的三自由度运动方程确定所述无人艇的虚拟控制律;
其中,所述三自由度运动方程为:
其中,η=[x,y,ψ]Τ、υ=[u,v,r]Τ、τ=[τu,0,τr]Τ分别表示北东坐标系下所述无人艇的位置、速度和推进力,x,y,ψ分别表示北向、东向位置和艏向角,u,v,r分别表示纵向速度、横向速度和艏摇角速度,τu,τr分别表示纵向力和转艏力矩,表示其一阶导数,/> du=-Xu-Xu|u||u|,dv=-Yv-Yv|v||v|,dr=-Nr-Nr|r||r|,/>Yv,Xu,Nr,Xu|u|,Yv|v|,Nr|r|均表示水动力参数,表示外界环境干扰在纵向、横向和艏向上的力和力矩;
所述无人艇的虚拟控制律,包括:
设定所述无人艇初始位置和速度跟踪误差xe,ye,ue,ve,对时间求导并代入式(1)得式(2)如下:
由式(2)确定所述无人艇纵、横向期望速度的虚拟控制律式如式(3):
其中,xd,yd和αu,αv分别表示期望位置和期望速度,k1,k2>0和h1,h2>0表示待定参数,h1,h2根据无人艇最大速度的物理限制进行设定,k1,k2为收敛系数;
期望速度确定模块,用于根据所述虚拟控制律确定所述无人艇当前时点的期望纵、横向速度;
非线性滑模面确定模块,用于根据未知时变外界环境干扰下所述无人艇的实际纵、横向速度与所述期望纵、横向速度的跟踪误差确定所述无人艇的速度变化的非线性滑模面,包括:
将所述无人艇的规定区域的中心作为圆心O(0,0),r作为区域半径,期望航迹半径为ra,且ra<r;
设定区域保持误差变量且de满足de<kd,0<|kd|<r-ra;
将所述无人艇的运动航迹设定在所述规定区域内;
为使所述无人艇跟踪期望速度αu与αv,确定非线性滑模面如下式:
其中,待确定参数ξ1,ξ2,ξ3,ξ4>0;
鲁棒滑模控制器确定模块,用于在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,所述鲁棒滑模控制器用于向所述无人艇的推进器发出区域保持的控制信号;在所述非线性滑模面中引入对称障碍李雅普诺夫函数,结合所述虚拟控制律获得所述无人艇的鲁棒滑模控制器,包括:
对式(9)和(10)求导,并将式(1)和(2)代入得:
选取等速趋近律如式(13)、(14):
其中,C1,C2>0表示待确定控制参数;
取η1≥τwumax,η2≥τwrmax,引入障碍李雅普诺夫函数得到鲁棒滑模控制器如下式:
其中,中间变量形式如下:
事件触发条件设置模块,用于依据预设的所述无人艇跟踪误差的阈值,设置所述鲁棒滑模控制器发出所述控制信号的事件触发条件,所述跟踪误差阈值包括所述无人艇的位置误差,速度误和/或区域保持误差;
控制信号发送模块,用于当所述事件触发条件满足时,所述鲁棒滑模控制器发送所述控制信号给所述无人艇的推进器,实现所述无人艇的区域保持控制。
5.一种电子设备,包括存储器和处理器;所述存储器,用于存储计算机程序;所述处理器,用于当执行所述计算机程序时,实现如权利要求1-3任一项所述的方法。
6.一种无人艇,其特征在于,所述无人艇采用了权利要求4所述的区域保持控制装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011613185.5A CN112650257B (zh) | 2020-12-30 | 2020-12-30 | 一种无人艇区域保持控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011613185.5A CN112650257B (zh) | 2020-12-30 | 2020-12-30 | 一种无人艇区域保持控制方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112650257A CN112650257A (zh) | 2021-04-13 |
CN112650257B true CN112650257B (zh) | 2024-02-02 |
Family
ID=75364491
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011613185.5A Active CN112650257B (zh) | 2020-12-30 | 2020-12-30 | 一种无人艇区域保持控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112650257B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113485377B (zh) * | 2021-08-16 | 2023-11-17 | 大连海事大学 | 双层虚拟引导机制的无人帆船自适应路径跟踪控制方法 |
CN114578819B (zh) * | 2022-03-01 | 2024-05-17 | 大连海事大学 | 一种基于人工势场法的多水面船分布式编队的控制方法 |
CN117111481B (zh) * | 2023-10-24 | 2024-01-26 | 哈尔滨工程大学三亚南海创新发展基地 | 一种多船舶协同跟踪控制系统及控制方法 |
CN117312726B (zh) * | 2023-11-29 | 2024-02-06 | 中国船舶集团有限公司第七〇七研究所 | 锚泊辅助动力定位作业时的能力评估方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444359A (zh) * | 2016-12-21 | 2017-02-22 | 哈尔滨工程大学 | 一种喷水推进无人艇自主区域保持的仿人智能控制方法 |
JP2017088111A (ja) * | 2015-11-17 | 2017-05-25 | ヤマハ発動機株式会社 | 船舶の操船制御方法および船舶の操船制御システム |
US9694892B1 (en) * | 2015-12-29 | 2017-07-04 | Brunswick Corporation | System and method for trimming trimmable marine devices with respect to a marine vessel |
CN110377034A (zh) * | 2019-07-09 | 2019-10-25 | 哈尔滨工程大学 | 一种基于蜻蜓算法优化的水面船轨迹跟踪全局鲁棒滑模控制方法 |
CN111309029A (zh) * | 2020-03-24 | 2020-06-19 | 山东科技大学 | 基于事件触发的无人艇路径跟踪方法、无人艇控制平台 |
-
2020
- 2020-12-30 CN CN202011613185.5A patent/CN112650257B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017088111A (ja) * | 2015-11-17 | 2017-05-25 | ヤマハ発動機株式会社 | 船舶の操船制御方法および船舶の操船制御システム |
US9694892B1 (en) * | 2015-12-29 | 2017-07-04 | Brunswick Corporation | System and method for trimming trimmable marine devices with respect to a marine vessel |
CN106444359A (zh) * | 2016-12-21 | 2017-02-22 | 哈尔滨工程大学 | 一种喷水推进无人艇自主区域保持的仿人智能控制方法 |
CN110377034A (zh) * | 2019-07-09 | 2019-10-25 | 哈尔滨工程大学 | 一种基于蜻蜓算法优化的水面船轨迹跟踪全局鲁棒滑模控制方法 |
CN111309029A (zh) * | 2020-03-24 | 2020-06-19 | 山东科技大学 | 基于事件触发的无人艇路径跟踪方法、无人艇控制平台 |
Non-Patent Citations (2)
Title |
---|
无人艇区域保持控制方法研究;魏红艳;《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》(第1期);正文第19-43页 * |
欠驱动水面船区域保持鲁棒滑模控制;付明玉;王莎莎;王元慧;魏红艳;;哈尔滨工程大学学报;第41卷(第05期);第684-690页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112650257A (zh) | 2021-04-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112650257B (zh) | 一种无人艇区域保持控制方法及装置 | |
CN108445892B (zh) | 一种欠驱动无人船编队控制器结构及设计方法 | |
Skjetne et al. | Modeling, identification, and adaptive maneuvering of Cybership II: A complete design with experiments | |
CN108073175B (zh) | 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 | |
Dukan et al. | Dynamic positioning system for a small size ROV with experimental results | |
Hegrenas et al. | Model-aided inertial navigation for underwater vehicles | |
CN108045531A (zh) | 用于海底电缆巡检的水下机器人控制系统及方法 | |
WO2021230356A1 (ja) | 船舶の自動誘導方法、船舶の自動誘導プログラム、船舶の自動誘導システム、及び船舶 | |
CN111026135B (zh) | 一种无人艇高性能航行前馈控制系统及其控制方法 | |
CN109814392A (zh) | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 | |
CN109213159A (zh) | 一种运用无人机进行海上态势感知监测船舶路径的方法 | |
Zhuang et al. | Navigating high‐speed unmanned surface vehicles: System approach and validations | |
CN113126492B (zh) | 动力定位船舶自动路径跟踪方法 | |
Abrougui et al. | Backstepping control of an autonomous catamaran sailboat | |
Damian et al. | Autonomous Underwater Vehicles-achievements and current trends. | |
CN116974278A (zh) | 基于改进los的滑模无人船路径跟踪控制系统及方法 | |
CN108287538A (zh) | 一种基于rtk技术无人驾驶船系统 | |
CN116540717A (zh) | 一种基于改进dwa的auv局部路径规划方法 | |
CN113110458B (zh) | 一种无人船虚拟目标跟踪控制系统 | |
CN110928278A (zh) | 一种用于无人艇的自主安全航行方法和无人艇 | |
CN106843208A (zh) | 一种无人驾驶测深船 | |
Shetty et al. | An Economical Approach Towards Bathymetric Mapping of Shallow Water Basins Using Unmanned Surface Vessel | |
Ma et al. | An improved adaptive dynamic window algorithm for target tracking of unmanned surface vehicles | |
Watanabe et al. | Development of track control system utilizing heading control system for ocean observation sailing | |
WO2019203335A1 (ja) | 船舶用自動操舵装置 |
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 |