一种在载荷布放强扰下的uuv自适应模糊滑模控制方法
【技术领域】
[0001 ]本发明涉及在载荷布放强扰下的UUV自适应模糊滑模控制方法。
【背景技术】
[0002] UUV隐蔽性好、突防能力强，如能携带可以完成某些特定任务的载荷(可以完成作 战任务的鱼雷、水雷，可以完成侦查任务的小型UUV、摄像机、声纳)并在特定区域完成布放， 定能够达到出其不意的目的，并且能够实现其他方式所不能够实现的任务。
[0003] UUV载荷布放强扰动下的控制属于非线性，且十分复杂，而滑模控制很适合该过程 的应用，但是单纯的滑模控制抖动比较大效果不太理想，容易对UUV产生物理上的损害。
【发明内容】
[0004] 本发明是为了解决目前UUV的控制方法中没有针对载荷布放强扰下的UUV控制的 研究问题，而提出的一种在载荷布放强扰下的UUV自适应模糊滑模控制方法。
[0005] -种在载荷布放强扰下的UUV自适应模糊滑模控制方法按以下步骤实现：
[0006] 步骤一 :UUV进行载荷布放，对UUV产生两种干扰，一种是载荷在栅状管内运动产生 的干扰，一种是补水舱进水产生的干扰；
[0007] 步骤二:获取UUV当前状态μ，构建UUV在载荷布放扰动下的动力学模型；
[0008] 步骤三:根据步骤二设计滑模面s，构造滑模控制器；
[0009] 步骤四：根据步骤三构造的滑模控制器设计模糊控制器，模糊控制器的输入是滑 模面S，输出是ΛΚ，所述ΛΚ是滑模控制器的开关控制律系数的增量值；
[0010] 步骤五:利用自适应算法优化ΛΚ，得到;
[0011] 步骤六:将步骤五得到的Δ皮输出给步骤三构造的滑模控制器，得到新的自适应模 糊滑模控制器τ;
[0012] 步骤七:利用步骤六得到的新的自适应模糊滑模控制器τ控制UUV，使UUV状态发生 改变；
[0013] 步骤八:重新执行步骤二至步骤七，直至UUV达到期望状态μ<!为止。
[0014] 发明效果：
[0015] 本发明采用自适应模糊控制来控制切换增益，具有外部干扰响应的快速性，外部 干扰以及内部参数的自适应性，并且该控制器能显著减小滑模控制器的抖振，避免了因抖 振问题对UUV造成损坏，使得UUV在完成载荷布放后能够迅速的恢复到指定期望状态。
【附图说明】
[0016] 图1为补水舱分布在载荷段两侧位置侧视示意图；图中的1是UUV，2是载荷，3是补 水舱位置；
[0017] 图2为基于自适应模糊滑模控制的控制器结构图；
[0018] 图3为UUV北向误差曲线仿真图；
[0019] 图4为UUV东向误差曲线仿真图；
[0020] 图5为UUV深度误差曲线仿真图；
[0021] 图6为UUV横倾误差曲线仿真图；
[0022] 图7为UUV纵倾误差曲线仿真图；
[0023]图8为UUV艏摇误差曲线仿真图。
【具体实施方式】
[0024]【具体实施方式】一：一种在载荷布放强扰下的UUV自适应模糊滑模控制方法包括以 下步骤：
[0025] 步骤一 :UUV进行载荷布放，对UUV产生两种干扰，一种是载荷在栅状管内运动产生 的干扰，一种是补水舱进水产生的干扰；
[0026] 步骤二:获取UUV当前状态μ，构建UUV在载荷布放扰动下的动力学模型；
[0027]步骤三:根据步骤二设计滑模面s，构造滑模控制器；
[0028] 步骤四：根据步骤三构造的滑模控制器设计模糊控制器，模糊控制器的输入是滑 模面s，输出是ΛΚ，所述ΛΚ是滑模控制器的开关控制律系数的增量值；
[0029] 步骤五:利用自适应算法优化ΛΚ，得到;
[0030] 步骤六:将步骤五得到的输出给步骤三构造的滑模控制器，得到新的自适应模 糊滑模控制器τ;
[0031 ]步骤七:利用步骤六得到的新的自适应模糊滑模控制器τ控制UUV，使UUV状态发生 改变；
[0032] 步骤八:重新执行步骤二至步骤七，直至UUV达到期望状态μ<!为止。
[0033]【具体实施方式】二:本实施方式与【具体实施方式】一不同的是:所述步骤一中UUV进行 载荷布放，对UUV产生两种干扰具体为：
[0034](一)载荷在栅状管内运动产生干扰；
[0035]载荷在栅状管中的运动方程为：
⑴
[0037] 其中所述mT为载荷质量，ντ为载荷在管内的运动速度，λη为载荷在管内运动方向 上的附加质量，Ft为载荷螺旋桨推力，R x为载荷所受流体阻力，Fm为载荷与发射管之间的机 械摩擦阻力；
[0038] 由公式(1)得到运动时间t和载荷行程1的关系式：
[(2) V J-
.丄 1 /
[0040] 由公式(2)得到载荷负浮力对UUV造成的纵倾力矩：
[0041] Txl = Fzi(h+l) (3)
[0042] 其中Fzl为载荷负浮力，1:为载荷布放前其质心与原点的距离；
[0043] UUV纵向受到载荷螺旋桨对自身的反作用力为：
[0044] Fxi = -FT+Rx+Fm (4)
[0045] (二)补水舱进水产生的干扰；
[0046] 设在tn时刻已经进入补水舱中水的质量是mo，进水速度是Vn，在tn+l时刻进入补水 舱中的水的(微小)质量是dmo,在进入补水舱之前，原质点系速度应当是外部流场速度vo,两 项合并后，整个质点系的速度是Vn+l，则tn时刻整个质点系的动能为：
[0048] tn+1时刻整个质点系的动能为：
[
[0050]在[tn，tn+1 ]内，整个质点系的动能为：
7)
[0052]其中dW为合外力对整个质点系所做的（微)功，dW为：
[0054]其中所述S为补水舱的等效截面积，P为tj寸刻补水舱内气体压强，P2*tn+1时刻补 水舱内气体压强，
卜水舱内原有气体对整个质点系所做的(微)功，
的具 体形式为：
[0056] 其中Ρ〇为进水前补水舱内气体的压强，一般情况下都是标准大气压;Ρη为进水后补 水舱内气体的压强，X为补水舱中等效水深，^为仏时刻的等效水深，L为在绝热压缩阶段补 水舱总长度，γ为气体的绝热指数，γ取值为1.4;
[0057] 由于补水舱进水速度很快，整个载荷布放过程在2s中就会完成所以补水舱进水工 作应该在两秒内完成，由公式(9)得到补水舱进水对UUV垂向产生的干扰力为：
(10)
[0059]补水舱补水过程对UUV造成的纵倾力矩为：
[0061]其中所述Ffu表示补水舱为空时的浮力，12为补水舱浮心距原心的距离；
[0062]根据公式(3)、（4)、（ 10)和(11)得到载荷布放期间因载荷布放对UUV产生的扰动：
(12)
[0064] 其中
[0070]其中Λ是运动坐标系向固定坐标系转换的转换矩阵，Λ:表示未知干扰力，Λ2表示 未知干扰力矩，τΡ，Tq，Tr为纵向、横向、垂向的干扰力矩。
[0071 ]【具体实施方式】三:本实施方式与【具体实施方式】一或二不同的是:所述步骤二中获 取UUV当前状态μ，构建UUV在载荷布放扰动下的动力学模型为：
[0072] 通过UUV自身的一系列传感器获取UUV当前状态为= 草以/丨1， #=[1办6 #,r]T描述UUV在大地坐标系下的位置以及姿态向量，其中ξ，η，ζ为固定坐标系下 的纵向、横向、垂向坐标，F为纵摇角、横摇角、艏摇角；
[0073] UUV动力学模型为：
[0075] 其中x = |>，v，w，p，q，r]T，其中u，v，w分别为运动坐标系下的纵向、横向和垂向速 度，P，q，r分别运动坐标系下为横摇角、纵摇角、艏摇角速度，Μ代表系统惯性矩阵，(Χμ)代表 系统哥氏力离心力矩阵，D(y)代表流体阻尼矩阵，L (μ)代表UUV所受的其他水动力、水动力 矩，G(y)代表由重力、浮力造成的恢复力以及恢复力矩，τ代表UUV推进系统提供的推进力以 及推进力矩，Td代表外部扰动力以及扰动力矩；
[0076] 因为UUV主要在布放载荷时航行在水下一定深度，受到的海风、海浪影响较小，所 以将海风、海浪的影响忽略，定义Td = Tdc;+Tdm，因此UUV在载荷布放扰动下的动力学模型为： Γ _
[0078]其中Tdm为布放载荷引起的扰动，Tdc为海流引起的环境干扰；分=;变换矩阵
，八为固定坐标系下的角度向运动坐标系下转换的转换矩阵；
LUUOOJ (J νμ；-J
\^)〇
【具体实施方式】 [0084] 四：本实施方式与一至三之一不同的是：所述步骤三 中设计滑模面S，构造滑模控制器的具体过程为：
[0085] UUV的状态误差为：
[0086] θ=μ<?-μ (25)
[0087] 其中所述W为UUV的期望状态；
[0088]滑模面为： ______
_ …一 (26)
[0090]其中所述矩阵Η是正定对角阵；
[0091 ]为达到抵消载荷布放产生的扰动的目的，设计滑模控制器为：
[0093]其中所述K(t)为对角阵，即：
[0094] K(t) =diag(ki，k2, · · ·，k6)，kj=max(adj)+Xj，j = 1，2,…，6 (28)
[0095] 其中所述a<y为载荷扰动引起的加速度向量if (μΓ1^-中的第j个元素，参数\>0。弓丨 入参数M>0来保证控制器的稳定性。引入切换增益K(t)的目的是为了补偿干扰项Td m、Tdc，以 确保滑模存在条件一定能满足。
【具体实施方式】 [0096] 五:本实施方式与一至四之一不同的是:所述步骤四 中设计模糊控制器的具体过程为：
[0097] 利用自适应控制和模糊控制调整滑模控制器的切换增益的不确定部分ΛΚ，以达 到降低系统抖振的目的。因为滑模变结构系统中的抖振现象主要是由滑模控制器的不连续 切换造成的，所以削弱系统抖振的有效途径就是确保补偿扰动的同时，减小切换项的增益。 因为干扰项T dm、id。是时变的而且有不确定因素在里面，所以必须使用具有自适