一种基于自适应滑模控制的UUV路径跟踪方法与流程

本发明涉及的是一种UUV路径跟踪方法，具体地说是一种欠驱动UUV在水平面内对期望路径的跟踪控制方法。
背景技术：
：无人水下航行器(UnmannedUnderwaterVehicle,UUV)的路径跟踪控制，是实现UUV各种用途的重要技术基础。深入研究UUV路径跟踪中存在的问题，对UUV控制理论和工程应用都具有重要的意义。目前，在欠驱动UUV路径跟踪控制方面，比较主流的一种思路是基于Serret-Frenet坐标系而建立运动学误差方程，再结合误差方程、动力学方程以及各种控制方法实现控制。其中，常见的控制算法包括反步法、模型预测控制、滑模变结构控制等。反步法对于镇定复杂的强非线性、高耦合度系统有着显而易见的优势。然而，对不确定性和外部干扰较差的抵抗能力、多次求导而产生的导数膨胀以及存在奇异值等问题，正在制约着这种方法的应用。模型预测控制具有对模型中参数误差滚动实时校正的能力，具有良好的鲁棒性。但该种算法主要用于线性系统，对于类似UUV这样复杂的非线性系统，仍然存在着非线性处理、实时性提升等问题的挑战。而滑模变结构控制是一种鲁棒性强、抗干扰能力强的控制算法，其抖振问题也可以通过使用合适的函数进行切换控制、设计参数自适应律等方法予以减弱。对于欠驱动UUV而言，由于横向推力的缺失，使得UUV在完成对任意路径的跟踪时，需要由主推进器与垂直舵之间的耦合来实现。因此，只依靠欠驱动UUV的水平面动力学模型设计可以使系统镇定的控制器将会很困难。哈尔滨工程大学的万磊等人在2013年2月《电机与控制学报》第12卷第2期中发表了《欠驱动水下机器人航迹跟踪控制》。本文章针对欠驱动水下机器人强非线性、模型不确定及存在外界干扰等特点，提出了一种自适应模糊滑模控制系统。通过设计反演控制器分别对水下机器人的纵向速度和航向角进行控制，实现水下机器人航迹跟踪。但是该方法构建复杂、实现速度慢、具有较多的局限性。技术实现要素：本发明的目的在于提供一种鲁棒性强、抗干扰能力强，可以减小抖振带来的影响的基于自适应滑模控制的UUV路径跟踪方法。本发明的目的是这样实现的：步骤一、初始化：为UUV的各种自适应参数ki,λi赋初值，其中,ki为滑模控制的切换增益参数，λi为滑模控制的边界层厚度参数，i＝1,2,3，并确定路径跟踪过程的理想速度为ud，定义更新次数t＝0；步骤二、获取UUV的当前状态：通过UUV自身的传感器得到当前时刻状态：u，v分别为纵向和横向速度，r为艏摇角速度，x,y分别为UUV重心在固定坐标系{I}下的纵向坐标和横向坐标，ψ为艏摇角，确定纵向速度误差eu＝u-ud；步骤三、基于Serret-Frenet坐标系，建立欠驱动UUV水平面误差方程，得到UUV重心在坐标{I}下的纵向位置偏差xe、横向位置误差ye以及航向偏差值ψe；步骤四、利用滑模控制方法，分别设计航速滑模控制律、位置滑模控制律以及艏相角滑模控制律，通过对推力Xprop，期望航速和转矩Nprop的控制，使ud→0,xe→0,ψe→0；步骤五、更新切换增益和边界层厚度的自适应律；步骤六、进行控制输入饱和补偿：电机和螺旋桨转速n与推力Xprop的关系由下式得出：Xprop＝Cnn|n|其中，Cn是固定系数，与所选电机型号有关；垂直舵所产生的转速N表示为：Nprop=N|r|δru|r|δr+Nδru2δr]]>其中，δr为垂直舵舵角，范围为[-35°,+35°]，N()为水动力系数；通过推力Xprop和转矩Nprop得到UUV转速n与δr为垂直舵舵角的大小，通过判断它们的值是否在指定区间内，实现对输入控制推力Xprop和转矩Nprop进行输入饱和补偿；步骤七、令t＝t+1，跳转回步骤二，进行下一次控制律与自适应律的更新，实现对UUV水平面路径跟踪精确控制。本发明是为了解决欠驱动UUV仅依靠水平面动力学模型设计使系统镇定的控制器比较困难的问题，提出的一种基于自适应滑模的路径跟踪方法。本发明具有以下效果：本发明采用的基于趋近率的滑模控制方法是一种鲁棒性强、抗干扰能力强的控制算法，可以减小抖振带来的影响，实现UUV水平面控制的平滑跟踪；通过设计切换增益以及边界层厚度的自适应律，可使UUV路径跟踪控制系统取得较小的抖振与较高的控制精度；根据实际情况，进行的控制输入饱和补偿可以使控制过程更加贴合实际，增加了其实际应用性。附图说明图1为UUV的水平面建模图；图2为欠驱动UUV水平面路径跟踪坐标系统；图3为自适应滑模控制方法的流程图；图4为UUV输入限制条件下的路径跟踪系统图；图5为欠驱动UUV位置跟踪仿真结果曲线图；图6为欠驱动UUV艏向角跟踪仿真结果曲线图；图7为欠驱动UUV的控制输入推力Xprop的大小变化；图8、图9、图10分别为艏相角误差ψe，横向位置误差xe以及纵向位置误差ye的大小变化。具体实施方式下面结合附图举例对本发明做更详细的描述。具体实施方式一：结合图4，本发明的基于自适应滑模的UUV路径跟踪方法，包括如下步骤：步骤一、初始化：为UUV的各种自适应参数ki,λi(i＝1,2,3)赋初值，并为路径跟踪过程确定其理想速度ud，定义更新次数t＝0；步骤二、获取UUV的当前状态：通过UUV自身的一系列传感器等得到当前时刻状态：u，v分别为纵向和横向速度(m/s)，r分别为艏摇角速度(rad/s)，x,y分别为UUV相对于固定坐标系的位置(m)，ψ为艏摇角(rad)，确定纵向速度误差eu＝u-ud；步骤三、基于Serret-Frenet坐标系，建立欠驱动UUV水平面误差方程，得到位置偏差xe,ye以及航向偏差值ψe；步骤四、利用滑模控制方法，分别设计航速滑模控制律，位置滑模控制律以及艏相角滑模控制律，通过对推力Xprop，期望航速和转矩Nprop的控制，使ud→0,xe→0,ψe→0：选取合适的滑模面函数，利用相应的趋近率得到控制律，这样实现比较简单，没有复杂的计算过程，也可适当减少经典滑模控制方法的抖振问题。步骤五、更新切换增益和边界层厚度的自适应律：通过Lyapunov稳定性理论以及控制输入与输出来设计切换增益以及边界层厚度的自适应律，使UUV路径跟踪控制系统取得较小的抖振与较高的控制精度。步骤六、根据实际情况，进行控制输入饱和补偿：在UUV的实际工程应用中，控制输入量直接关系着推进器、舵角等执行机构的动作，合适的控制输入大小对实现滑模控制算法在UUV路径跟踪中的应用具有重要的现实意义。推进器的推力直接收到电机转速的影响，对于某一特定的电机和螺旋桨，转速n与推力Xprop的关系可以由下式得出：Xprop＝Cnn|n|(1)其中，Cn是固定系数，与所选电机型号有关。舵面受到的水动力是由相关的实验测定的，垂直舵在一定航速下所产生的转速N可以表示为：Nprop=N|r|δru|r|δr+Nδru2δr---(2)]]>其中，δr为垂直舵舵角，范围为[-35°,+35°]，N()为水动力系数。由(1)和(2)可得通过推力Xprop和转矩Nprop可得到此刻UUV转速n与δr为垂直舵舵角的大小，通过判断它们的值是否在指定区间内，实现对输入控制推力Xprop和转矩Nprop进行输入饱和补偿。令k＝k+1，跳转回步骤二，进行下一次控制律与自适应律的更新，实现对UUV水平面路径跟踪精确控制。具体实施方式二：在具体实施方式一的基础上，步骤三所述的基于Serret-Frenet坐标系，建立欠驱动UUV水平面误差方程，得到位置偏差xe,ye以及航向偏差值ψe的具体过程如下：对于UUV在水平面内的运动，仅需建立三自由度模型即可，需要考虑的变量为：位置量x,y,艏向角ψ,以及纵向速度u,横向速度v,以及转艏角速度r。可得到UUV水平面运动学方程为：x·=ucosψ-vsinψy·=usinψ+vcosψψ·=r---(3)]]>令UUV的重心就在{B}的原点处，重力与浮力相等，UUV结构左右对称，并认为上下近似对称，经过一系列化简，可得UUV水平面动力学方程如下：u·=m11m22vr-d11m22u+1m22Xpropv·=m22m11ur-d22m11vr·=m22-m11m33uv-d33m33r+1m33Nprop---(4)]]>上式中，d11＝-Xu-Xu|u||u|,d22＝-Yv-Yv|v||v|,d33＝-Nr-Nr|r||r|，其中Xu，Yv，Nr，Xu|u|，Yv|v|，N为水动力系数。海流的流速都是在固定坐标系下测量得到的，海流的流速必须转换到{B}下，才可加入动力学模型。对于在{I}下的海流流速可以表示为：VI＝[uI,vI,0]T(5)那么在{B}下的海流流速可以表示为：ucvc=Shor-1uIvI---(6)]]>其中：Shor-1=ShorT=cosψsinψ-sinψcosψ---(7)]]>则带有海流干扰的水平面动力学模型可以表示为：u·=m11m22vr+m22-m11m22u·c-d11m22(u-uc)+1m22Xpropv·=m22m11ur+m22-m11m22u·c-d22m11(v-vc)r·=m22-m11m33(u-uc)(v-vc)-d33m33r+1m33Nprop---(8)]]>对式(4)两端求导并整理有：u·cv·c=-Shor-1S·horucvc---(9)]]>可解得：[u·c,v·c]T=[rvc,-ruc]T---(10)]]>给定一条在{I}坐标系下的期望路径：xd=xd(s)yd=yd(s)---(11)]]>式中，s-----期望路径的弧长，xd,yd------水平面期望路径在{I}下的坐标。对于UUV在{I}下的坐标x,y而言，位置误差xe,ye可以写为：xe=x-xdye=y-yd---(12)]]>在图2中，对于UUV的艏向角跟踪而言，UUV合速度U的方向与{I}中轴Eξ的夹角ψ+β需要跟踪到期望艏向角ψd(期望路径在某点切线的方向与{I}中轴Eξ的夹角)，因此UUV艏向角的跟踪误差ψe可以表示为：ψe＝ψ+β-ψd(13)选取期望路径上的切线速度(弧长参数的导数)作为期望速度ud，那么UUV的期望艏向角角速度rd就可以表示为：rd=kss·---(14)]]>其中，ks-------期望路径的曲率那么，在{I}下，UUV在水平面运动时的期望速度以及期望艏向角角速度向量就可以表示为：ud=[ud,0,0]Trd=[0,0,rd]T---(15)]]>在获取了期望路径中各个期望的状态变量之后，由图2可知，引入从{I}到{SF}坐标系的水平面旋转变换矩阵R：R=cosψd-sinψd0sinψdcosψd0001---(16)]]>从而可以建立UUV水平面路径跟踪的误差方程：x·e=-s·+kss·ye+Ucosψey·e=-kss·xe+Usinψeψ·e=r+β·-rd---(17)]]>具体实施方式三：在具体实施方式一或二的基础上，步骤四所述的利用滑模控制方法，分别设计航速滑模控制律，位置滑模控制律以及艏相角滑模控制律，通过对推力Xprop，期望航速和转矩Nprop的控制，使ud→0,xe→0,ψe→0具体过程如下：为了设计针对UUV路径跟踪设计的控制器，本发明作出了如下合理假设：假设一：UUV的航速U可以看做是UUV的纵向速度u；假设二：最小航速umin和最大航速umax，使得ud∈[umin,umax],umax＞umin＞0；在上述假设的基础上，首先来设计UUV的航速跟踪子系统的滑模控制律。针对(6)中的第一式，采用s=c1e+c2e·+...+cn-1e(n-2)+e(n-1),ci>0,i=1,2,...,n-1---(18)]]>类型的滑模面函数，则可以写成：s1＝eu＝u-ud(19)其中，ud为期望航速，对(17)式两端求导，可得：s·1=e·u=u·-u·d---(20)]]>为了获得良好的趋近过程，选取如下指数趋近律：s·1=-k1sgn(s1)-ϵ1s1---(21)]]>其中，k1>0-----航速滑模控制切换增益ε1>0-----航速滑模控制的指数趋近项系数将(6)中的第一式带入式(18)，并联立(18)与(19)式，可得：-k1sgn(s1)-ϵ1s1=m11m22vr+m22-m11m22u·c-d11m22(u-uc)+1m22Xprop-u·d---(22)]]>在上式中，由于期望航速一般都会人为的设定为某一定值，故整理(20)式可得UUV的航速滑模控制律：Xprop=-m22[k1sgn(s1)+ϵ1s1]-m11vr-(m22-m11)u·c+d11(u-uc)---(23)]]>令分别为a1,a2,a3,a4的实际测量值，是在实际应用中，经过多次实验测量得来，与精确值相比，具有5％的误差。则(23)式可转化为：Xprop=-1a~4[k1sgn(s1)+ϵ1s1+a~1vr+a~2u·c-a~3(u-uc)]---(24)]]>利用Lyapunov稳定性原理，取则可得：V·(s1)=s1s·1=s1[a1vr+a2u·c-a3(u-uc)+a4Xprop]=s1{a1vr+a2u·c-a3(u-uc)+a4{-1a~4[k1sgn(s1)+ϵ1s1+a~1vr+a~2u·c+a~2(u-uc)]}}=-a4a~4ϵ1s12-a4a~4k1|s1|+s1[(a1-a4a~4a~1)vr+(a2-a4a~4a~2)u·c+(a3-a4a~4a~2)(u-uc)]≤0---(25)]]>则可得ε1的大小并不影响控制器的稳定性，符号应与相同，而k1的取值范围如下：k1≥|(a~1-a~4a4a1)vr|+|(a~2-a~4a4a2)u·c|+|(a~3-a~4a4a3)(u-uc)|---(26)]]>在实际应用中，k1的取值范围可近似为：k1≥1.05a~1|vr|+1.05a~2|u·c|+1.05a~3|(u-uc)|---(27)]]>其次，同理利用(15)中的第一式且s2＝xe-0，选取幂次趋近律：s·2=-k2|s2|αsgn(s2)---(28)]]>其中，k2>0-----位置滑模控制切换增益0＜α＜1-----位置滑模控制的幂次数设计出位置滑模控制律如下：s·=[Ucosψe+ϵ2s2+k2sgn(s2)]11-ksye---(29)]]>然而，当ksye＝1时，虚拟控制输入会出现奇异值。当位置误差ye从较大的数值收敛时，必然会出现ksye＝1，这就使得位置控制始终与UUV的初始位置有关，在初始位置误差ye较大时路径位置跟踪控制将无法实现。为此，本发明提出如下位置跟踪控制器：s·={Ucosψe+k2|s2|αsgn(s2),ksye=1Ucosψe+k2|s2|αsgn(s2)1-ksye,ksye≠1---(30)]]>令b2＝cosψe，同理，为b1,b2的实际测量值，有5％的测量误差。(29)式可写为：s·=-b~1[b~2u+k2|s2|αsgn(s2)]---(31)]]>利用Lyapunov稳定性原理，取取ksye≠1则可得：V·(s2)=s2s·2=s2[(ksye-1)s·+Ucosψe]=s2{1b1{-b~1[b~2U+k2|s2|αsgn(s2)]}+b2U}=(b2-b~1b1b~2)U·s2-b~1b1k2|s2|α+1---(32)]]>则可得k2的取值范围如下：k2≥|(b~-b1b~1b2)U||s2|-α---(33)]]>在实际应用中，k1的取值范围可近似为：k3≥1.05b~2|U||s2|-α---(34)]]>最后，设计UUV艏向角跟踪子系统的滑模控制律。为了调整UUV艏向角在收敛过程中的行为，并使得UUV艏向角在收敛于期望艏向角之后只保持眼期望路径的前向运动，这里引入艏向角误差ψe的期望角---趋近角：W＝-arctan(uye)(35)趋近角W与位置误差ye有关。当位置误差ye较大时，趋近角W也较大，由此产生的控制输入力矩也较大，进而使得UUV艏向角ψ以较大的趋势收敛于期望的艏向角ψd；当ye→0时，会使得ψe→W→0，以达到艏向角跟踪控制的目的。基于上述分析，为了进一步改善滑模的趋近过程，采用无奇异值的终端滑模控制方法，采取如下滑模面函数：s3=eψ+c|e·ψ|(p/q)---(36)]]>式中，eψ＝ψe-W-----艏向角滑模控制律中的误差项；c＞0,p＞q＞0----c为设计系数，p、q都是奇数。对(36)式两端求导，可得：s·3=e·ψ+cpq|e·ψ|(p/q-1)e··ψ=r+β·-ψ·d-W·+cpq|+β·-ψ·d-W·|(p/q-1)(r·+β··-ψ··d-W··)---(37)]]>同样选取指数趋近律：s·3=-k3sgn(s3)-ϵ3s3---(38)]]>其中，k3>0-----航向角滑模控制切换增益ε3>0-----航向角滑模控制的指数趋近项系数针对(6)中的第三式代入(27)式，同时联立(27)与(28)式，那么UUV艏向角跟踪子系统的滑模控制律可以表示为：Npeop=-m33[qcp|e·ψ|(1-p/q)(e·ψ+ϵ3s3+k3sgn(s3))+β··-ψ··d-W··]-(m22-m11)(u-uc)(v-vc)+d33r---(39)]]>令同理，为c1,c2,c3的实际测量值，有5％的测量误差。则(39)式可写为：Nprop=-1c~3[1A(e·ψ+ϵ3s3+k3sgn(s3))+B]-c~1c~3(u-uc)(v-vc)-c~2c~3r---(40)]]>利用Lyapunov稳定性原理，取则可得：V·(s3)=s3s·3=s3[e·ψ+cpq|e·ψ|(p/q-1)(r·+B)]=s3[e·ψ+cpq|e·ψ|(p/q-1)((c1(u-uc)(v-vc)+c2r+c3Nprop)+B)]=s3[e·ψ+A((c1(u-uc)(v-vc)+c2r+c3-1c~3[1A(e·ψ+ϵ3s3+k3sgn(s3))+β··-ψ··d-W··]-c~1c~3(u-uc)(v-vc)-c~2c~3r)+B)]=-c3c~3ϵ3s32+s3{(1-c3c~3)(e·ψ+B)+A[(c1-c~1c3c~3)(u-uc)(v-vc)+(c2-c~2c3c~3)r]}-c3c~3k3|s3|---(41)]]>则可得ε3的大小并不影响控制器的稳定性，符号应与相同，而k3的取值范围如下：k3≥|(1-c~3c3)(e·ψ+B)|+A|(c~1-c1c~3c3)(u-uc)(v-vc)|+A|(c~2-c2c~3c3)r|---(42)]]>在实际应用中，k1的取值范围可近似为：k3≥1.05|e·ψ+B|+1.05A|(u-uc)(v-vc)|+1.05A|r|---(43)]]>至此，带有海流干扰的水平面UUV路径跟踪滑模控制器可以表示为：Xprop=-1a~4[k1sgn(s1)+ϵ1s1+a~1vr+a~2u·c-a~3(u-uc)]s·=-b~1[b~2u+k2|s2|αsgn(s2)],ksye≠1b~2u+k2|s2|αsgn(s2),ksye=1Nprop=-1c~3[1A(e·ψ+ϵ3s3+k3sgn(s3))+B]-c~1c~3(u-uc)(v-vc)-c~2c~3r---(44)]]>利用Lyapunov稳定性理论，可以得出本发明设计的三个子系统路径跟踪控制器均是稳定的。具体实施方式四：在上述任何一种实施方式的基础上，步骤五所述的更新切换增益和边界层厚度的自适应律的具体过程如下：首先，将Sigmod函数引入到滑模控制律(32)式中来替换一般的符号函数：Xprop=-1a~4[k1Φ(λ1,s1)+ϵ1s1+a~1vr+a~2u·c-a~3(u-uc)]s·=-b~1[b~2u+k2|s2|αΦ(λ2,s2)],ksye≠1b~2u+k2|s2|αΦ(λ2,s2),ksye=1Nprop=-1c~3[1A(e·ψ+ϵ3s3+k3Φ(λ3,s3))+B]-c~1c~3(u-uc)(v-vc)-c~2c~3r---(45)]]>Sigmod函数的表达式形式可以写为：Φ(λi,si)=1-exp(-λisi)1+exp(-λisi)---(46)]]>其中，λi,i＝1,2,3------表示边界层厚参数选取Lyapunov函数：V~i=12ei2---(47)]]>其中，i＝1，2，3，e1＝eu,e2＝xe,e3＝eψ-----UUV路径跟踪中的误差记系统控制输出pi(i＝1,2,3)，其中p1＝u,p2＝xe,p3＝ψe；系统控制输入Ui(i＝1,2,3)，其中，U1＝Xprop,U3＝Nprop。在(47)式中两段对切换增益ki以及边界层厚度λi分别求导，可得：V·1i=∂V~i∂ei∂ei∂pi∂pi∂Ui∂Ui∂ki∂ki∂t---(48)]]>V·2i=∂V~i∂ei∂ei∂pi∂pi∂Ui∂Ui∂λi∂λi∂t---(49)]]>将控制输入量Ui(i＝1,2,3)代入(34)和(35)式中：V·1i=ei∂pi∂Ui∂Ui∂kik·i=-ei∂pi∂Ui1g(pi)1-exp(-λisi)1+exp(-λisi)k·i---(50)]]>V·2i=ei∂pi∂Ui∂Ui∂λiλ·i=-ei∂pi∂Uikig(pi)2siexp(-λisi)(1+exp(-λisi))2λ·i---(51)]]>其中：g(p1)=1m22,g(P2)=1-ksye,g(p3)=-cpqm33eψ(p/q-1)---(52)]]>观察(50)和(51)式，选取如下切换增益和边界层厚度的自适应律：k^·=ηig(pi)eisgn(∂pi∂Ui)(1-exp(-λisi)1+exp(-λisi))λ^·=μig(pi)eisgn(∂pi∂Ui)si---(53)]]>其中，ηi,μi＞0是设计参数。将(39)式代入(31)式中，即可得到基于自适应滑模的欠驱动UUV水平面路径跟踪控制系统：Xprop=-1a~4[k^1Φ(λ^1,s1)+ϵ1s1+a~1vr+a~2u·c-a~3(u-uc)]s·=-b~1[b~2+ϵ2s2+k^2Φ(λ^2,s2)],ksye≠1b~2u+ϵ2s2+k^2Φ(λ^2,s2),ksye=1Nprop=-1c~3[1A(e·ψ+ϵ3s3+k^3Φ(λ^3,s3))+B]-c~1c~3(u-uc)(v-vc)-c~2c~3r---(54)]]>从上述的设计过程可以看出，以及是基于Lyapunov函数来设计的，可实现控制律的局部稳定，同时，若i＝1,2,3分别满足式(27)、(34)和(43)，如果不满足，则不采用该循环的i＝1,2,3值，而是选取(27)、(34)和(43)式等号成立时的ki,i＝1,2,3值，即可保证控制律(54)可以确保UUV路径跟踪系统的全局稳定性。具体实施方式五：在上述任何一种实施方式的基础上，步骤六所述的根据实际情况，进行控制输入饱和补偿的具体过程如下：图3是滑模变结构控制MATLAB仿真(第2版)书中提出的一种辅助系统，将饱和误差作为该系统的输入，转换为自适应控制参数的输出，进而将自适应参数反馈到带有该自适应参数的控制器中，从而实现饱和误差的补偿，使得系统在保持渐近稳定的同时，将控制输入限制在约束的范围内。将(2)式代入第(42)式的第三式并整理成关于控制输入舵角δr的形式：δr=-(1N|r|δru|r|+1Nδru2){1c~3[1A(e·ψ+ϵ3s3+k^3Φ(λ^3,s3))+B]+c~1c~3(u-uc)(v-vc)+c~2c~3r}---(55)]]>选用饱和函数的形式来限制控制输入舵角δr，从而获得限制条件下的艏航角控制输入δra：δra=δrmax,δr>δrmaxδr,|δr|≤δrmax-δrmax,δr<-δrmax---(56)]]>其中，δrmax＝35°。选取饱和误差为Δδr＝δra-δr那么艏向角饱和补偿的辅助系统可以设计为：γ·1=-c1γ1+γ2γ·2=-c2γ2+1m33Δδr---(57)]]>其中，常系数c1＞0,c2＞0。由式(45)可知，饱和误差Δδr通过γ1和γ2的自适应律转换成的控制器的补偿量。选取艏向角跟踪误差：ψe＝ψ+β-ψd-γ1(58)仍选取式(28)的滑模面函数和式(30)的趋近律，那么(55)式可以重写为：δr=-(1N|r|δru|r|+1Nδru2)1c~3[1A(e·ψ+ϵ3s3+k^3Φ(λ^3,s3))+B+c1(-c1γ1+γ2)+c2γ2]+c~1c~3(u-uc)(v-vc)+c~2c~3r---(59)]]>类似的，在UUV水平面航速跟踪控制中，推进器推力也应该被限制在合理的范围内。推进器只可以使UUV前进，故只考虑推进器右旋的情形(既转速为正)。将(1)代入(54)式的第一式，并整理：nr2=-1a~4Cn[k^1Φ(λ^1,s1)+ϵ1s1+a~1vr+a~2u·c-a~3(u-uc)]---(60)]]>其中，nr为指令转速。选取最大推力为250N的推进器，最大转速为4500转/分，推力-转速系数Cn＝1.171×10-3，那么被限制的转速nra以及饱和补偿系统可以表示为：nra={nrmax,nr>nrmaxnr,0≤nr≤nrmax,γ·3=-c3γ3+γ4γ·4=-c4γ4+1m22(nra-nr)---(61)]]>其中，nrmax＝4500转/分，常系数c3>0，c4>0。考虑(47)式，那么带有饱和补偿的UUV水平面航速控制律可以表示为：nr2=-1a~4Cn[k^1Φ(λ^1,s1)+ϵ1s1-(-c3γ3+γ4)+a~1vr+a~2u·c-a~3(u-uc)]---(62)]]>验证实施例：进行仿真实验，仿真结果如图5-图10所示：选取路径y＝15sin(0.15x)作为期望路径，UUV的初始变量切换增益和边界厚度的自适应律初始值指数趋近项系数ε1＝ε3＝1,α＝0.8,c＝1,μ1＝50,μ2＝15,μ3＝100,η1＝5000,η2＝300,η3＝1。选取固定坐标系{I}下的海流干扰uI＝0.6m/s,vI＝0.6m/s，选取饱和补偿控制参数c1＝c2＝100，c3＝c4＝10，补偿量初始值γ10＝γ20＝γ30＝γ40＝0，图5至图10展示了欠驱动UUV在水平面中利用自适应滑模控制(ASMC)方法实现路径跟踪的效果。实验证明，本发明针对欠驱动UUV的水平面运动提出的自适应滑模控制器拥有较好的控制性能。在实际应用中，可以通过调节控制参数来满足控制要求。当前第1页1 2 3