CN114527772A - 一种auv轨迹跟踪控制器设计方法与系统 - Google Patents
一种auv轨迹跟踪控制器设计方法与系统 Download PDFInfo
- Publication number
- CN114527772A CN114527772A CN202210120931.XA CN202210120931A CN114527772A CN 114527772 A CN114527772 A CN 114527772A CN 202210120931 A CN202210120931 A CN 202210120931A CN 114527772 A CN114527772 A CN 114527772A
- Authority
- CN
- China
- Prior art keywords
- auv
- error
- heading
- velocity
- representing
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000013178 mathematical model Methods 0.000 claims abstract description 22
- 238000013528 artificial neural network Methods 0.000 claims description 28
- 239000013598 vector Substances 0.000 claims description 25
- 230000006870 function Effects 0.000 claims description 17
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 16
- 238000004590 computer program Methods 0.000 claims description 11
- 238000009795 derivation Methods 0.000 claims description 7
- 239000012530 fluid Substances 0.000 claims description 7
- 230000005484 gravity Effects 0.000 claims description 6
- 238000001914 filtration Methods 0.000 claims description 5
- 230000003044 adaptive effect Effects 0.000 claims description 4
- 238000013016 damping Methods 0.000 claims description 3
- 230000006641 stabilisation Effects 0.000 claims description 3
- 238000011105 stabilization Methods 0.000 claims description 3
- 230000000087 stabilizing effect Effects 0.000 claims description 3
- 210000001258 synovial membrane Anatomy 0.000 claims 1
- 239000011159 matrix material Substances 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003908 quality control method Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
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/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-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)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种AUV轨迹跟踪控制器设计方法与系统,包括步骤:(1)构建全驱动自主水下机器人的运动学数学模型、动力学数学模型;(2)采集AUV设备信息,针对运动学数学模型进行自适应的虚拟向导设计,获得AUV轨迹误差方程;(3)设计运动学控制器;(4)设计动力学控制器。本发明能够消除自主水下机器人在拐点控制量输入过大,容易超调的问题并且消除内部扰动和输入饱和对控制性能的影响。
Description
技术领域
本发明涉及控制技术领域,具体是涉及一种AUV轨迹跟踪控制器设计方法与系统。
背景技术
蒋云彪硕士名称为“欠驱动AUV自适应轨迹跟踪控制研究”中提出的利用RBF神经网络与积分滑模相结合来实现欠驱动AUV的轨迹跟踪控制。首先构建常规欠驱动AUV的运动建模,包括运动学模型、动力学模型、干扰参数等,随后采用动态面技术、积分滑模来设计轨迹跟踪控制器,并引入RBF神经网络对AUV本体建模未知参数以及外界不确定干扰进行实时补偿。本方案对本身不确定参数变化和外部环境的适应能力强,但在控制量幅度输出过大,容易出现自主水下机器人拐点的超调,以及对扰动输入饱和没有进一步的处理和优化,在消除抖振方面只是引入外部约束函数,导致该算法过于复杂,不容易应用于实际工程。
发明内容
发明目的:针对以上缺点,本发明提供一种AUV轨迹跟踪控制器设计方法,能够消除自主水下机器人在拐点控制量输入过大,容易超调的问题并且消除内部扰动和输入饱和对控制性能的影响。本发明还提供一种AUV轨迹跟踪控制器系统,能够提升自主水下机器人的轨迹跟踪能力。
技术方案:为解决上述问题,本发明采用一种AUV轨迹跟踪控制器设计方法,包括以下步骤:
(1)构建全驱动自主水下机器人的运动学数学模型、动力学数学模型;
(2)针对运动学数学模型采集相关的AUV设备信息,包括AUV设备的纵向线速度、横向线速度、垂向线速度、俯仰角速度、艏向角速度;进行自适应的虚拟向导设计,获得AUV轨迹误差方程;
(3)设计运动学控制器,具体包括:根据AUV轨迹误差获得期望纵倾角θed和期望艏向角ψed;将艏向角θ和纵倾角ψ作为虚拟控制量输入,设计俯仰角速度qed和艏向角速度控制律red为:
式中,k2和k3为正定常数,θ表示俯仰角,ψ表示艏向角;
(4)设计动力学控制器,具体包括:
(4.1)将运动学控制器输出通过一阶滤波器进行滤波,引入二阶非线性微分跟踪器并根据二阶非线性微分跟踪器的输出定义误差跟踪速度为:
[ue,qe,re]T=[u-v1,q-qed,r-red]T
式中,ue表示镇定纵向速度误差,qe表示俯仰控制力,re表示艏向控制力;u表示纵向线速度,q表示俯仰角速度,r表示艏向角速度;v1和v2为二阶微分跟踪器的输出信号;
(4.2)设计纵向线速度、俯仰角速度、艏向角速度的误差积分滑模面,并对误差积分滑模面进行求导;引入指数趋近律对误差积分滑模面进行补偿并采用径向基神经网络对AUV中未知的不确定项进行估计逼近,最终获得AUV的动力学控制律,通过AUV的动力学控制律将当前AUV设备的纵向线速度、俯仰角速度、艏向角速度反馈至AUV设备,循环步骤(2)至步骤(4)直至AUV轨迹误差为0。
进一步的,步骤(4.3)中AUV的动力学控制律为:
式中,τu表示纵向动力学控制律,τq表示俯仰角动力学控制律,τr表示艏向动力学控制律;fu表示外界水流扰动产生的纵向力矩,fq表示外界水流扰动产生的俯仰角力矩,fr表示外界水流扰动产生的艏向力矩;mii(1,2,3,4,5)表示为AUV的惯性水动力为水下机器人在加速过程中受到周围水流惯性产生的力;为qed通过一阶滤波器获得的值,为red通过一阶滤波器获得的值;S1为镇定纵向速度的误差积分滑模面,S2为俯仰角速度的误差积分滑模面,S3为艏向角速度的误差积分滑模面;均为AUV中未知的不确定项通过神经网络得到的逼近值;
Fu=m22vr-m33wq-Xuu-Xμμ∣u|u|
Fw=m11uq-m22vp-Zww-Zw|w|w|w|
Fr=(m11-m22)uv+(m44-m55)pq-Nrr-Nr|r|r|r|
式中,u,v,w,q,r分别表示为纵向线速度、横向线速度、垂向线速度、俯仰角速度、艏向角速度;Xu|u|,Yv|v|,Zw|w|,Mq|q|,Nr|r|为流体黏性引起的非线性阻尼项,向量为重心与浮心之间的距离。
进一步的,还包括步骤(4.3):设计辅助动态系统降低系统饱和对控制性能有较大影响,辅助系统为:
式中,χi(i=u,q,r)是设计的辅助系统状态值;bi>0(i=u,q,r)表示系数;gi(i=u,q,r),gu=1/m11,gq=1/m44,gr=1/m55;Δτi为系统饱和值;Δτi=τi-sat(τi)(i=u,q,r);li(i=u,q,r)是正定常数;
实际动力学控制器输出可设计为:
式中,a1、a2、a3为常数,l1=lu,l2=lq,l3=lr。
通过该辅助系统的设计减少内部扰动和输入饱和对AUV的影响。
对V1求导得到:
根据李雅普诺夫稳定理论获得虚拟向导和自适应控制律为:
其中,xe表示AUV路径跟踪误差在单位向量上T的投影;θe表示纵倾角误差;ψe表示艏向角误差;k为常数;k1表示可调参数;f为慢时变信号,为f的估计值。对于运动学控制器的设计进一步增加了一个虚拟向导和自适应控制律,能够更好的控制虚拟向导的运动速度
进一步的,步骤(3)中根据AUV轨迹误差获得期望纵倾角θed和期望艏向角ψed包括:
(3.1)根据AUV路径跟踪误差获取更新前的期望纵倾角θl、期望艏向角ψl:
式中,ye表示AUV路径跟踪误差在单位向量上N的投影,ze表示AUV路径跟踪误差在单位向量上B的投影;Δθ表示纵倾角变化的常数,Δψ表示艏向角的变化的常数;
(3.2)结合实际纵倾角和艏向角;获得更新后期望纵倾角θed和期望艏向角ψed为:
式中,θF为AUV实际纵倾角,ψF为AUV实际艏向角。
进一步的,步骤(4.2)中所述的趋近律为:
式中,ε为滑模控制切换增益,l为指数趋近律,且ε>0,l>0。
进一步的,步骤(4.2)中神经网络的函数为:
此外,本发明采用一种AUV轨迹跟踪控制器系统,包括:
模型构建模块,用于构建全驱动自主水下机器人的运动学数学模型、动力学数学模型;
AUV轨迹误差获取模块,用于针对运动学数学模型采集相关的AUV设备信息,包括AUV设备的纵向线速度、横向线速度、垂向线速度、俯仰角速度、艏向角速度;进行自适应的虚拟向导设计,获得AUV轨迹误差方程;;
运动学控制器设计模块,用于设计运动学控制器,具体包括:根据AUV轨迹误差获得期望纵倾角θed和期望艏向角ψed;将艏向角θ和纵倾角ψ作为虚拟控制量输入,设计俯仰角速度qed和艏向角速度控制律red为:
式中,k2和k3为正定常数,θ表示俯仰角,ψ表示艏向角;
动力学控制器设计模块,用于设计动力学控制器,具体包括:将运动学控制器输出通过一阶滤波器进行滤波,引入二阶非线性微分跟踪器并根据二阶非线性微分跟踪器的输出定义误差跟踪速度为:
[ue,qe,re]T=[u-v1,q-qed,r-red]T
式中,ue表示镇定纵向速度误差,qe表示俯仰控制力,re表示艏向控制力;u表示纵向线速度,q表示俯仰角速度,r表示艏向角速度;v1和v2为二阶微分跟踪器的输出信号;设计纵向线速度、俯仰角速度、艏向角速度的误差积分滑模面,并对误差积分滑模面进行求导;引入指数趋近律误差积分滑模面进行补偿并采用径向基神经网络对AUV中未知的不确定项进行估计逼近,最终获得AUV的动力学控制律,通过AUV的动力学控制律将当前AUV设备的纵向线速度、俯仰角速度、艏向角速度反馈至AUV设备;
循环操作模块,用于循环操作AUV轨迹误差获取模块、动力学控制器设计模块、动力学控制器设计模块直至AUV轨迹误差获取模块中获取的轨迹误差为0。
此外,本发明提供一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述方法的步骤。此外,本发明提供一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现上述方法的步骤。
有益效果:本发明所述方法相对于现有技术,其显著优点是:1、引入二阶微分器,通过二阶微分器输出信号定义误差跟踪速度,进而设计误差积分滑模面克服了在拐点容易出现控制器超调的问题。2、设计辅助动态系统,通过辅助饱和在线函数的设计减少内部扰动和输入饱和对AUV的影响。本发明所述系统相对于现有技术,其显著优点是:自主水下机器人具有更好的轨迹跟踪能力。
附图说明
图1所示为本发明所述AUV轨迹跟踪控制器设计方法与系统的原理图;
图2所示为本发明所述AUV轨迹跟踪控制器设计方法中虚拟向导轨迹示意图;
具体实施方式
下面结合附图对本发明所述的技术方案作进一步的说明。
如图1所示,本发明采用一种AUV轨迹跟踪控制器设计方法,包括以下步骤:
一、构建全驱动自主水下机器人的运动学数学模型、动力学数学模型;
(1)AUV水下机器人运动学模型表示为:
(2)AUV水下机器人动力学模型表示为:
式中,mii(1,2,3,4,5)表示为AUV的惯性水动力为水下机器人在加速过程中受到周围水流惯性产生的力,具体为 其中 m表示水下机器人的重量;G表示速度和加速度多元矩阵函数,Ix,Iy,Iz分别是绕载体坐标系X轴、Y轴和Z轴的惯性矩;Xu,Yu,Zw,Kp,Mq和Nr是线性水动力系数,W,B分比为AUV的重力和浮力;Xu|u|,Yv|v|,Zw|w|,Mq|q|,Nr|r|为流体黏性引起的非线性阻尼项;
二、采集AUV设备信息,针对运动学数学模型进行自适应的虚拟向导设计,获得AUV轨迹误差方程;
如图2所示,为AUV空间曲线轨迹跟踪示意图,其中:I、B、F为分别为固定坐标系、载体坐标系、serret—Frenet坐标系,O表示AUV的重心,AUV的重心与载体坐标系原点O重合,F坐标系原点为AUV期望轨迹中的任意一个虚拟参考点,相对于AUV的速度为Vp,原点P为水下机器人期望轨迹上的“虚拟向导”。
(1)坐标系的换算
将固定坐标系{I}绕η轴旋转ψ度,在绕ζ轴旋转θ度,然后平移固定坐标系中点E与运动坐标系P相重合,Serret-Frenet坐标系框架相对于固定坐标系ψ、θ旋转的角度为:
假设AUV在水下航行时,纵向速度u恒不为0,考虑冲角α和漂角β的影响,其中α=arctan(w/u)。流体坐标系{W}定义为将坐标系{B}分别沿y轴方向旋转角度β,接下来在沿着z轴方向旋转角度α,且坐标系{W}的x轴方向与合成向量U方向一致;所以AUV运动方程在坐标系{I}下可以重新表示为:
(2)获取Serret-Frenet坐标系下的轨迹跟踪误差模型
AUV质心O到{F}坐标系点P的位移ε为AUV路径跟踪误差,在向量T、N、B上的投影由xe,ye,ze来表示,记为ε=[xe,ye,ze]T,相对于期望路径上的任何虚拟向导,沿期望路径上的切线方向的单位向量T和沿期望路径的法线方向单位法向向量N,且一定存在B=T*N;则流体坐标系{W}与坐标系{F}之间P点和O的相对速度可以表示为流体坐标系{W}与坐标系{F}的旋转矩阵定义为E(γα,γβ),可以表示为:
流体坐标系{W}与Serret—Frenet坐标系{F}之间旋转的矩阵为D(γα,γβ),根据向量合成公式,可得出:点O在Serret—Frenet坐标系{F}的速度向量(D(γα,γβ)(dq/dt)w为:(dp/dt)F+WF×ε+(dε/dt)F
根据旋转矩阵和速度向量可以得到轨迹跟踪误差模型,表示为:
式中,参数s描述期望路径的曲线,又因为Serret—Frenet坐标系上原点瞬时速度的对应关系,其虚拟向导上的运动速度可表示为:c1(s)和c2(s)分别表示为期望路径上的曲率及挠率,其设定的期望路径参数s是连续且可导的。
三、三维轨迹跟踪控制器设计
(1)运动学控制器设计
对V1求导得到:
根据李雅普诺夫稳定理论获得虚拟向导和自适应控制律为:
(1.2)俯仰角速度和艏向角速度控制律设设计
(1.2.1)设计AUV轨迹跟踪制导律,引入LOS曲线路径跟踪法,引入如下导引律为:
式中,ye表示AUV路径跟踪误差在单位向量上N的投影,ze表示AUV路径跟踪误差在单位向量上B的投影;Δθ表示纵倾角变化的常数,Δψ表示艏向角的变化的常数;
(1.2.2)结合实际纵倾角和艏向角;获得更新后期望纵倾角ed和期望艏向角ψed为:
式中,θF为AUV实际纵倾角,ψF为AUV实际艏向角。
(1.2.3)将艏向角和纵倾角ψ作为虚拟控制量输入,设计俯仰角速度qed和艏向角速度控制律red为:
式中,k2和k3为正定常数,表示俯仰角,ψ表示艏向角。
四、设计动力学控制器
由于在水下轨迹跟踪时横滚角及横滚角速度对AUV的影响效果不大可以忽略不计,简化为六自由度数学模型,六自由度动力学方程可简化为:
Fu=m22vr-m33wq-Xuu-Xμμ∣u|u|
Fw=m11uq-m22vp-Zww-Zw|w|w|w|
Fr=(m11-m22)uv+(m44-m55)pq-Nrr-Nr|r|r|r|
(1)采用动态面的思想简化控制器,来提高跟踪响应效率和高质量的控制输入,将运动学控制器输出通过一阶滤波器进行滤波。构造的数学表达式为:
(2)引入二阶非线性微分跟踪器
式中,ud为被跟踪信号,即为AUV期望的纵向速度期望输入值,R为跟踪参数,v1和v2为二阶微分跟踪器的输出信号。
根据二阶非线性微分跟踪器的输出定义误差跟踪速度为:
[ue,qe,re]T=[u-v1,q-qed,r-red]T
式中,ue表示镇定纵向速度误差,qe表示俯仰控制力,re表示艏向控制力;u表示纵向线速度,q表示俯仰角速度,r表示艏向角速度;
(3)设计纵向线速度S1、俯仰角速度S2、艏向角速度S3的误差积分滑模面,表示为:
其中,λi(i=u,q,r)为控制器相关的参数;对误差积分滑模面进行求导;
(4)由于AUV本身存在参数摄动项和外界洋流的干扰下,等效控制的控制效果并不能收敛逼近,故引入指数趋近律进行补偿,有效抑制滑模带来的抖振问题,使其AUV在大角度转弯时会产生的连续输出信号,进而提高AUV的运动效果,进一步提高了系统的鲁棒性。选取如下趋近律:
式中,ε为滑模控制切换增益,l为指数趋近律,且ε>0,l>0。
(5)采用径向基神经网络对AUV中未知的不确定项进行估计逼近;
(5.1)神经网络的函数为:
(5.2)选取李雅普诺夫函数为:
式中,εu为纵向推力神经网络逼近误差。
式中,k4大于零。
参考纵向控制控制律可推出俯仰动力学控制器和艏向动力学控制器,选取李雅普诺夫函数为:
式中,εq为俯仰推力神经网络逼近误差,εr为艏向推力神经网络逼近误差;
式中,k5、k6大于零。
(6)获得AUV的动力学控制律为:
式中,τu表示纵向动力学控制律,τq表示俯仰角动力学控制律,τr表示艏向动力学控制律;fu表示外界水流扰动产生的纵向力矩,fq表示外界水流扰动产生的俯仰角力矩,fr表示外界水流扰动产生的艏向力矩;mii(i=1,2,3,4,5)表示为AUV的惯性水动力为水下机器人在加速过程中受到周围水流惯性产生的力;为qed通过一阶滤波器获得的值,为red通过一阶滤波器获得的值;S1为镇定纵向速度的误差积分滑模面,S2为俯仰角速度的误差积分滑模面,S3为艏向角速度的误差积分滑模面;均为AUV中未知的不确定项通过神经网络得到的逼近值。
(7)设计辅助动态系统降低系统饱和对控制性能有较大影响,辅助系统为:
式中,χi(i=u,q,r)是设计的辅助系统状态值;bi>0(i=u,q,r)表示系数;gi(i=u,q,r),gu=1/m11,gq=1/m44,gr=1/m55;Δτi为系统饱和值;Δτi=τi-sat(τi)(i=u,q,r);li(i=u,q,r)是正定常数;
实际最终动力学控制器输出可设计为:
式中,a1、a2、a3为常数。
(8)最终获得AUV的动力学控制律τu、τq、τr反馈至AUV设备,循环步骤二至步骤四直至轨迹误差为0。
此外,本发明采用一种AUV轨迹跟踪控制器系统,包括:
模型构建模块,用于构建全驱动自主水下机器人的运动学数学模型、动力学数学模型;
AUV轨迹误差获取模块,用于针对运动学数学模型采集相关的AUV设备信息,包括AUV设备的纵向线速度、横向线速度、垂向线速度、俯仰角速度、艏向角速度;进行自适应的虚拟向导设计,获得AUV轨迹误差方程;;
运动学控制器设计模块,用于设计运动学控制器,具体包括:根据AUV轨迹误差获得期望纵倾角θed和期望艏向角ψed;将艏向角θ和纵倾角ψ作为虚拟控制量输入,设计俯仰角速度qed和艏向角速度控制律red为:
式中,k2和k3为正定常数,θ表示俯仰角,ψ表示艏向角;
动力学控制器设计模块,用于设计动力学控制器,具体包括:将运动学控制器输出通过一阶滤波器进行滤波,引入二阶非线性微分跟踪器并根据二阶非线性微分跟踪器的输出定义误差跟踪速度为:
[ue,qe,re]T=[u-v1,q-qed,r-red]T
式中,ue表示镇定纵向速度误差,qe表示俯仰控制力,re表示艏向控制力;u表示纵向线速度,q表示俯仰角速度,r表示艏向角速度;v1和v2为二阶微分跟踪器的输出信号;设计纵向线速度、俯仰角速度、艏向角速度的误差积分滑模面,并对误差积分滑模面进行求导;引入指数趋近律误差积分滑模面进行补偿并采用径向基神经网络对AUV中未知的不确定项进行估计逼近,最终获得AUV的动力学控制律,通过AUV的动力学控制律将当前AUV设备的纵向线速度、俯仰角速度、艏向角速度反馈至AUV设备;
循环操作模块,用于循环操作AUV轨迹误差获取模块、动力学控制器设计模块、动力学控制器设计模块直至AUV轨迹误差获取模块中获取的轨迹误差为0。
此外,本发明提供一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述方法的步骤。此外,本发明提供一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现上述方法的步骤。
Claims (10)
1.一种AUV轨迹跟踪控制器设计方法,其特征在于,包括以下步骤:
(1)构建全驱动自主水下机器人的运动学数学模型、动力学数学模型;
(2)针对运动学数学模型采集相关的AUV设备信息,包括AUV设备的纵向线速度、横向线速度、垂向线速度、俯仰角速度、艏向角速度;进行自适应的虚拟向导设计,获得AUV轨迹误差方程;
(3)设计运动学控制器,具体包括:根据AUV轨迹误差获得期望纵倾角θed和期望艏向角ψed;将艏向角θ和纵倾角ψ作为虚拟控制量输入,设计俯仰角速度qed和艏向角速度控制律red为:
式中,k2和k3为正定常数,θ表示俯仰角,ψ表示艏向角;
(4)设计动力学控制器,具体包括:
(4.1)将运动学控制器输出通过一阶滤波器进行滤波,引入二阶非线性微分跟踪器并根据二阶非线性微分跟踪器的输出定义误差跟踪速度为:
[ue,qe,re]T=[u-v1,q-qed,r-red]T
式中,ue表示镇定纵向速度误差,qe表示俯仰控制力,re表示艏向控制力;u表示纵向线速度,q表示俯仰角速度,r表示艏向角速度;v1和v2为二阶微分跟踪器的输出信号;
(4.2)设计纵向线速度、俯仰角速度、艏向角速度的误差积分滑模面,并对误差积分滑模面进行求导;引入指数趋近律对误差积分滑模面进行补偿并采用径向基神经网络对AUV中未知的不确定项进行估计逼近,最终获得AUV的动力学控制律,通过AUV的动力学控制律将当前AUV设备的纵向线速度、俯仰角速度、艏向角速度反馈至AUV设备,循环步骤(2)至步骤(4)直至AUV轨迹误差为0。
2.根据权利要求1所述的AUV轨迹跟踪控制器设计方法,其特征在于,步骤(4.2)中AUV的动力学控制律为:
式中,τu表示纵向动力学控制律,τq表示俯仰角动力学控制律,τr表示艏向动力学控制律;fu表示外界水流扰动产生的纵向力矩,fq表示外界水流扰动产生的俯仰角力矩,fr表示外界水流扰动产生的艏向力矩;mii(1,2,3,4,5)表示为AUV的惯性水动力为水下机器人在加速过程中受到周围水流惯性产生的力;为qed通过一阶滤波器获得的值,为red通过一阶滤波器获得的值;S1为镇定纵向速度的误差积分滑模面,S2为俯仰角速度的误差积分滑模面,S3为艏向角速度的误差积分滑模面;均为AUV中未知的不确定项通过神经网络得到的逼近值;
Fu=m22vr-m33wq-Xuu-Xμμ|u|u|
Fw=m11uq-m22vp-Zww-Zw|w|w|w|
Fr=(m11-m22)uv+(m44-m55)pq-Nrr-Nr|r|r|r|
8.一种AUV轨迹跟踪控制器系统,其特征在于,包括:
模型构建模块,用于构建全驱动自主水下机器人的运动学数学模型、动力学数学模型;
AUV轨迹误差获取模块,用于针对运动学数学模型采集相关的AUV设备信息,包括AUV设备的纵向线速度、横向线速度、垂向线速度、俯仰角速度、艏向角速度;进行自适应的虚拟向导设计,获得AUV轨迹误差方程;
运动学控制器设计模块,用于设计运动学控制器,具体包括:根据AUV轨迹误差获得期望纵倾角θed和期望艏向角ψed;将艏向角θ和纵倾角ψ作为虚拟控制量输入,设计俯仰角速度qed和艏向角速度控制律red为:
式中,k2和k3为正定常数,θ表示俯仰角,ψ表示艏向角;
动力学控制器设计模块,用于设计动力学控制器,具体包括:将运动学控制器输出通过一阶滤波器进行滤波,引入二阶非线性微分跟踪器并根据二阶非线性微分跟踪器的输出定义误差跟踪速度为:
[ue,qe,re]T=[u-v1,q-qed,r-red]T
式中,ue表示镇定纵向速度误差,qe表示俯仰控制力,re表示艏向控制力;u表示纵向线速度,q表示俯仰角速度,r表示艏向角速度;v1和v2为二阶微分跟踪器的输出信号;设计纵向线速度、俯仰角速度、艏向角速度的误差积分滑模面,并对误差积分滑模面进行求导;引入指数趋近律误差积分滑模面进行补偿并采用径向基神经网络对AUV中未知的不确定项进行估计逼近,最终获得AUV的动力学控制律,通过AUV的动力学控制律将当前AUV设备的纵向线速度、俯仰角速度、艏向角速度反馈至AUV设备;
循环操作模块,用于循环操作AUV轨迹误差获取模块、动力学控制器设计模块、动力学控制器设计模块直至AUV轨迹误差获取模块中获取的轨迹误差为0。
9.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至权利要求7所述方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至权利要求7所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210120931.XA CN114527772A (zh) | 2022-02-09 | 2022-02-09 | 一种auv轨迹跟踪控制器设计方法与系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210120931.XA CN114527772A (zh) | 2022-02-09 | 2022-02-09 | 一种auv轨迹跟踪控制器设计方法与系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114527772A true CN114527772A (zh) | 2022-05-24 |
Family
ID=81622774
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210120931.XA Pending CN114527772A (zh) | 2022-02-09 | 2022-02-09 | 一种auv轨迹跟踪控制器设计方法与系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114527772A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115185273A (zh) * | 2022-07-06 | 2022-10-14 | 天津大学 | 一种空地异构多机器人轨迹跟踪平台 |
-
2022
- 2022-02-09 CN CN202210120931.XA patent/CN114527772A/zh active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115185273A (zh) * | 2022-07-06 | 2022-10-14 | 天津大学 | 一种空地异构多机器人轨迹跟踪平台 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111580523B (zh) | 一种基于侧滑角补偿的无人艇路径跟踪自抗扰控制方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
CN106444806B (zh) | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 | |
CN110308735B (zh) | 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法 | |
CN107024863B (zh) | 一种避免微分爆炸的uuv轨迹跟踪控制方法 | |
CN105929842B (zh) | 一种基于动态速度调节的欠驱动uuv平面轨迹跟踪控制方法 | |
CN109814392B (zh) | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 | |
CN110716566B (zh) | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 | |
CN112462773B (zh) | 一种欠驱动水面船的路径跟踪抗饱和鲁棒控制方法 | |
CN112527018B (zh) | 一种欠驱动自主水下航行器的三维镇定控制方法 | |
CN110618611A (zh) | 一种基于回转率约束的无人艇轨迹跟踪安全控制方法 | |
CN112346465A (zh) | 基于ialos导引律的欠驱无人船自适应模糊控制方法 | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN109901402B (zh) | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 | |
CN112327892B (zh) | 一种auv误差受限的抗扰控制方法 | |
CN113467231A (zh) | 基于侧滑补偿ilos制导律的无人艇路径跟踪方法 | |
CN111798702B (zh) | 无人艇路径跟踪控制方法、系统、存储介质及终端 | |
CN113608534A (zh) | 一种无人艇跟踪控制方法及系统 | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及系统 | |
Dai et al. | Dual closed loop AUV trajectory tracking control based on finite time and state observer | |
CN113110512B (zh) | 一种减弱未知干扰与抖振影响的可底栖式auv自适应轨迹跟踪控制方法 | |
CN114527772A (zh) | 一种auv轨迹跟踪控制器设计方法与系统 | |
CN113110527B (zh) | 一种自主水下航行器有限时间路径跟踪的级联控制方法 | |
CN117389312B (zh) | 一种基于模型的水下航行器抗横滚三维跟踪控制方法 | |
CN115686034B (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 |