[发明专利]一种基于偶极势场的AUV回坞导引系统及导引方法

摘要

本发明涉及一种基于偶极势场的AUV回坞导引系统及导引方法，其特征在于AUV的头部安装有USBL收发器，回收站的两侧安装两个USBL应答器；AUV利用收发器可测量应答器在AUV体坐标系xBoByB下的距离和方位；根据距离和方位计算出AUV在回收坐标系xoy下的坐标，并基于偶极势场原理，得到AUV回坞的期望航向角指令；AUV利用自适应非奇异终端滑模控制方法控制AUV以期望的航向角航行，实现回坞导引。该方法可直接计算出AUV在回收坐标系下的坐标。然后利用建立的偶极势场导引AUV沿回收站中轴线方向进入回收站，该方法简单，计算量较小，使得回坞过程中实际航向角和指令航向角之间的误差很小，回坞效果优于其它回坞算法。

主权项

一种利用基于偶极势场的AUV回坞导引系统导引AUV回坞的方法，所述的基于偶极势场的AUV回坞导引系统：包括USBL收发器和两个USBL应答器；USBL收发器设置于AUV的头部的中心轴线上，两个USBL应答器设置于回收站的两侧；所述两个USBL应答器为电偶极子，其特征在于步骤如下：步骤1：AUV在回收坐标系xoy下从初始点X(0)＝[x(0)y(0)]T以初始航向角ψ(0)开始进行回坞导引；其中：x、y为AUV在回收坐标系下的位置坐标，(x(0)y(0))在AUV航行之前进行设定；所述回收坐标系xoy是以回收站的两侧安装的两个USBL应答器B1和B2的中心为原点，两个USBL应答器B1和B2之间的连线为y轴，水平向上垂直于y轴且过原点的为x的正方向轴，B1位于B2的左边，B1指向B2的方向为y轴的正方向；步骤2：AUV上安装的USBL收发器与回收站两侧的应答器B1和B2进行通信，测量出应答器B1和B2在AUV机体坐标系xBoByB下的距离Li和方位μi，其中i＝1,2；步骤3：计算应答器B1和B2在AUV机体坐标系xBoByB下的位置坐标Bi(xTi,yTi)，i＝1,2：xTiyTi=cosμisinμi[Li]+l0]]>步骤4：根据电偶极子电场原理，定义电偶极矩矢量应答器中点的位置坐标为由于回收站的入口矢量与垂直，则o为回收坐标系xoy的原点，l为应答器B1和B2之间的距离；步骤5：计算出AUV机体坐标系xBoByB和AUV回收坐标系xoy之间的夹角：ψ=arctan(xT2-xT1yT2-yT1)]]>Bi(xTi,yTi)是应答器B1和B2在AUV机体坐标系xBoByB下的位置坐标，i＝1,2；步骤6：计算AUV在回收坐标系xoy下的位置坐标：xy=-cosψ-sinψsinψcosψ(xT1+xT22,yT1+yT22)T]]>步骤7：定义偶极势场F(n)＝λ(pTn)n‑p(nTn),是一个除了原点之外处处非零的二维的矢量场，其中，常量λ≥2，p＝[px py]Τ为偶极势场的电偶极矩，n为偶极势场的位置矢量，偶极势场最大的特点是在偶极势场空间中任意一点的运动都沿着势场线的切线方向；两个应答器在回收坐标系xoy下的位置坐标分别为p1＝(p1x,p1y)和p2＝(p2x,p2y)，则电偶极矩p＝(p2x‑p1x,p2y‑p1y)Τ；由于AUV在偶极势场中的位置矢量为n＝[x y]Τ，则偶极势场为Fnx＝(λ‑1)(p2x‑p1x)x2+λ(p2y‑p1y)xy‑(p2x‑p1x)y2Fny＝(λ‑1)(p2y‑p1y)y2+λ(p2x‑p1x)xy‑(p2y‑p1y)x2；步骤8：根据步骤7定义的偶极势场，确定AUV回收的航向角指令为：ψd=arctan(FnyFnx)-arctan(vu)]]>步骤9：根据步骤8的航向角指令ψd，采用自适应非奇异终端滑模控制方法对航向角进行跟踪控制，选择舵角为：δr=-α2(α0+α1ω+βqp′ω2-p′/q+(x^0+η)sgn(s))]]>δr1=-α2(α0+α1w+βqp′w2-p/q+(x^0+η)sgn(s))]]>其中，u、v、ω分别是机体坐标系下AUV的前向速度、侧向速度和航向角速度，m11、m22和m33为AUV包含附加质量的惯性系数，d11、d22和d33为AUV的流体动力阻尼系数，Nσ为AUV偏航力矩系数，β、η都为常量且η>0，β>0，p′>q>0且为奇数，x0是建模不确定项上界，是x0的估计值，q0>0是自适应增益，s为滑模控制量；步骤10：如果AUV与回收点的距离小于给定的可接受误差时，则转到下一步骤；否则返回到步骤2；步骤11：AUV已经到达回收点，回坞结束。