一种基于偶极势场的AUV回坞导引系统及导引方法技术方案

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

【技术实现步骤摘要】
一种基于偶极势场的AUV回坞导引系统及导引方法
本专利技术属于水下航行器回收对接
，具体涉及一种基于偶极势场的AUV回坞导引系统及导引方法。
技术介绍
AUV(AutonomousUnderwaterVehicle)作为一种水下自主运载工具，依靠自身所携带的能源航行，可完成水下测量、物品投送等任务，在军事海洋侦察、海洋环境监测、油田勘测等领域有着重要的作用。AUV执行任务时携带的能源有限，对于长时间作业的AUV，必须在执行任务的区域通过作业母船对AUV进行布放和回收，以便完成补充能源、读取信息、维护保障等工作。为了提高作业效率，人们提出了AUV的水下自主回收系统，自主回收控制已经成为当前海洋工程领域的研究热点之一。目前，AUV回坞导引方法主要有：(1)基于横向跟踪控制的回坞导引方法。该方法首先需要定义一条AUV回收的中轴线，然后AUV根据当前位置与中轴线之间的距离偏差来控制AUV沿中轴线航行，最终实现AUV的回收。该方法的主要缺点是不适合初始位置在侧面或后面的情况，也不适用于AUV的动态回收。(2)基于人工势场的回坞导引方法。该方法采用传统的人工势场法，产生一条可到达回收站的无本文档来自技高网...

【技术保护点】
一种基于偶极势场的AUV回坞导引系统，其特征在于包括USBL收发器和两个USBL应答器；USBL收发器设置于AUV的头部的中心轴线上吗，两个USBL应答器设置于回收站的两侧；所述两个USBL应答器为电偶极子。

【技术特征摘要】
2015.01.08 CN 201510009020X1.一种利用基于偶极势场的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：步骤4：根据电偶极子电场原理，定义电偶极矩矢量应答器中点的位置坐标为由于回收站的入口矢量与垂直，则o为回收坐标系xoy的原点，l为应答器B1和B2之间的距离；步骤5：计算出AUV机体坐标系xBoByB和AUV回收坐标系xoy之间的夹角：Bi(xTi,yTi)是应答器B1和B2在AUV机体坐标系xBoByB下的位置坐标，i＝1,2；步骤6：计算AUV在回收坐标系xoy下的位置坐标：步...

【专利技术属性】
技术研发人员：严卫生，齐贝贝，高剑，崔荣鑫，王银涛，李慧平，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西;61