一种AUV反演对接控制方法技术

本发明专利技术涉及一种AUV反演对接控制方法，属于水下航行器回收对接技术领域。其特征在于AUV的头部安装有USBL收发器，回收站的两侧安装两个USBL应答器B1和B2；在AUV靠近对接站的过程中，AUV通过USBL定位系统获取应答器在体坐标系中的位置,AUV应答器位置测量方程式对时间求导，在AUV体坐标系中定义对接误差。对接过程中AUV处于全驱动航行模式，针对对接误差，设计非线性反演控制器，使AUV沿着期望的直线航迹航行直至抵达对接站。该方法反演自适应速度跟踪在存在参数不确定性时具有良好的速度跟踪性能，对接效果良好。

【技术实现步骤摘要】

本专利技术属于水下航行器回收对接
，具体涉及一种AUV反演对接控制方法。
技术介绍
AUV(AutonomousUnderwaterVehicle)作为一种水下自主运载工具，依靠自身所携带的能源航行，可完成水下测量、物品投送等任务，在军事海洋侦察、海洋环境监测、油田勘测等领域有着重要的作用。AUV执行任务时携带的能源有限，对于长时间作业的AUV，必须在执行任务的区域通过作业母船对AUV进行布放和回收，以便完成补充能源、读取信息、维护保障等工作。为了提高作业效率，人们提出了AUV的水下自主回收系统，自主回收控制已经成为当前海洋工程领域的研究热点之一。目前，AUV回坞导引方法主要有：(1)基于横向跟踪控制的回坞导引方法。该方法首先需要定义一条AUV回收的中轴线，然后AUV根据当前位置与中轴线之间的距离偏差来控制AUV沿中轴线航行，最终实现AUV的回收。该方法的主要缺点是不适合初始位置在侧面或后面的情况，也不适用于AUV的动态回收。(2)基于人工势场的回坞导引方法。该方法采用传统的人工势场法，产生一条可到达回收站的无碰航路，然后控制AUV沿航路航行，从而实现AUV的回收。该方法的主要缺点是存在着局部极小点的问题，即AUV在靠近回收站时同时受到引力和斥力，合力可能为零，一旦AUV陷入局部极小点就会出现回收站不可达问题，且在狭窄区域易发生路径抖动等现象。(3)基于模糊理论的AUV回收运动方法。依据模糊控制理论的基础，并根据控制对象的特点，制定模糊控制规则，设计出模糊控制器，对AUV的回收运动过程进行控制。该方法的主要缺点是模糊控制规则的获取以及输入模糊变量论域和隶属函数的确定都是实验分析和操作人员经验的汇总，受人为主观因素的影响较大。
技术实现思路
要解决的技术问题为了避免现有技术的不足之处，本专利技术提出一种AUV反演对接控制方法，在AUV靠近对接站的过程中，AUV通过USBL定位系统获取应答器在体坐标系中的位置,AUV应答器位置测量方程式对时间求导，在AUV体坐标系中定义对接误差。对接过程中AUV处于全驱动航行模式，针对对接误差，设计非线性反演控制器，使AUV沿着期望的直线航迹航行直至抵达对接站。技术方案一种AUV反演对接控制方法，其特征在于：USBL收发器安装在AUV的头部，两个USBL应答器B1和B2安装在回收站的两侧，AUV通过USBL定位系统获取应答器在体坐标系中的位置；对接控制步骤如下：步骤1：AUV在回收坐标系xoy下从初始点X(0)[x0y0]T以初始航向角ψ(0)开始进行回坞导引，其中：x、y为AUV在回收坐标系下的位置坐标，(x(0),y(0))为AUV航行之前设定的初始值；所述回收坐标系xoy是：以回坞面对水面的侧边为y轴，侧边的中心为o点，与侧边垂直的回坞中心轴线为x轴；步骤2：当接收到AUV的USBL收发器的测量信息，从中提取AUV通过USBL定位系统获取应答器在体坐标系中的位置，表示为：xTiByTiB=x‾Tiy‾Yi+l0=cosψsinψ-sinψcosψ(xTiDyTiD-xy)i=1,2]]>其中：为获得的USBL应答器位置测量，l为收发器与体坐标系原点的距离；i＝1,2和i＝1,2分别为应答器在回收坐标系和体坐标系下的坐标；所述体坐标系是：以AUV的浮心为OB，AUV的纵轴为xB轴，与纵轴垂直的为yB；步骤3计算对接误差：AUV应答器位置测量方程式对时间求导：x·TiBy·TiB=cosψsinψ-sinψcosψ(x·TiDy·TiD-x·y·)+r-sinψcosψ-cosψ-sinψ(xTiDyTiD-xy)=-10yTiB0-1-xTiBuvri=1,2]]>在航行过程中需满足：xT1B-xT2B=0,yT1B+yT2B=0]]>在AUV体坐标系中的对接误差，e=xT1B-xT2ByT1B+yT2B;]]>其中：定义了AUV与对接路径平行，定义了AUV指向对接坐标系原点；步骤4计算L矩阵：对接误差矢量对时间求导：e·=x·T1B-x·T2By·T1B-y·T2B=r(yT1B-yT2B)-2v-r(xT1B+xT2B)=Lv]]>其中：v＝[v,r]T是AUV速度矢量，L为应答器位置测量和体坐标系速度矢量间的相互关系矩阵，并有：L=0yT1B-yT2B-2-(xT1B+xT2B);]]>步骤5计算速度指令：vd=vdrd=-L-1Γ1e]]>其中：Γ1＝diag(γ1,γ2)为常数正定增益矩阵，L-1为L的逆，并有：L-1=-xT1B+xT2B2(yT1B-yT2B)-121yT1B-yT2B0]]>步骤6：选择参考速度输入为：v·d=-L-1(Γ1Lv+L·vd)]]>其中为：L·=0r(xT2B-xT1B)02u-r(yT1B+yT2B);]]>步骤7：速度跟踪误差为：e1＝v-vd求导得：e·1=v·-v·d=-v·d-m11m22ur-d22m22v+1m22(Y+Yc)-r·d+m11-m22m33uv-d33m33r+1m33(N+Nc);]]>步骤8：计算控制力，采用PI控制τ＝[Y,N]为输入向量，考虑到θ矩阵部分未知，控制输入使得负定：τ＝-Γ2e1-LTe其中，Γ2＞0为常参数正定增益矩阵。有益效果本专利技术提出的一种AUV反演对接控制方法，在AUV靠近对接站的过程中，AUV通过USBL定位系统获取应答器在体坐标系中的位置,AUV应答器位置测量方程式对时间求导，在AUV体坐标系中定义对接误差。对接过程中AUV处于全驱动航行模式，针对对接误差，设计非线性反演控制器，使AUV沿着期望的直线航迹航行直至抵达对接站。该方法反演自适应速度跟踪在存在参数不确定性时具有良好的速度跟踪性能，对接效果良好。附图说明图1：AUV对接系统示意图图2：AUV航行轨迹图3：对接误差曲线图4：预测对接速度指令与实际速度曲线图5：对接控制输入曲线具体实施方本文档来自技高网...

【技术保护点】
一种AUV反演对接控制方法，其特征在于：USBL收发器安装在AUV的头部，两个USBL应答器B1和B2安装在回收站的两侧，AUV通过USBL定位系统获取应答器在体坐标系中的位置；对接控制步骤如下：步骤1：AUV在回收坐标系xoy下从初始点X(0)＝[x 0 y 0T以初始航向角ψ(0)开始进行回坞导引，其中：x、y为AUV在回收坐标系下的位置坐标，(x(0),y(0))为AUV航行之前设定的初始值；所述回收坐标系xoy是：以回坞面对水面的侧边为y轴，侧边的中心为o点，与侧边垂直的回坞中心轴线为x轴；步骤2：当接收到AUV的USBL收发器的测量信息，从中提取AUV通过USBL定位系统获取应答器在体坐标系中的位置，表示为：xTiByTiB=x‾Tiy‾Yi+l0=cosψsinψ-sinψcosψ(xTiDyTiD-xy),i=1,2]]>其中：为获得的USBL应答器位置测量，l为收发器与体坐标系原点的距离；和分别为应答器在回收坐标系和体坐标系下的坐标；所述体坐标系是：以AUV的浮心为OB，AUV的纵轴为xB轴，与纵轴垂直的为yB；步骤3计算对接误差：AUV应答器位置测量方程式对时间求导：x·TiBy·TiB=cosψsinψ-sinψcosψ(x·TiDy·TiD-x·y·)+r-sinψcosψ-cosψ-sinψ(xTiDyTiD-xy)=-10yTiB0-1-xTiBuvri=1,2]]>在航行过程中需满足：xT1B-xT2B=0,yT1B+yT2B=0]]>在AUV体坐标系中的对接误差，e=xT1B-xT2ByT1B+yT2B;]]>其中：定义了AUV与对接路径平行，定义了AUV指向对接坐标系原点；步骤4计算L矩阵：对接误差矢量对时间求导：e·=x·T1B-x·T2By·T1B+y·T2B=r(yT1B-yT2B)-2v-r(xT1B+xT2B)=Lv]]>其中：v＝[v,r]T是AUV速度矢量，L为应答器位置测量和体坐标系速度矢量间的相互关系矩阵，并有：L=0yT1B-yT2B-2-(xT1B+xT2B);]]>步骤5计算速度指令：vd=vdrd=-L-1Γ1e]]>其中：Γ1＝diag(γ1,γ2)为常数正定增益矩阵，L‑1为L的逆，并有：L-1=-xT1B+xT2B2(yT1B-yT2B)-121yT1B-yT2B0]]>步骤6：选择参考速度输入为：v·d=-L-1(Γ1Lv+L·vd)]]>其中为：L·=0r(xT2B-xT1B)02u-r(yT1B+yT2B);]]>步骤7：速度跟踪误差为：e1＝v‑vd求导得：e·1=v·-v·d=-v·d-m11m22ur-d22m22v+1m22(Y+Yc)-r·d+m11-m22m33uv-d33m33r+1m33(N+Nc);]]>步骤8：计算控制力，采用PI控制τ＝[Y,N]为输入向量，考虑到θ矩阵部分未知，控制输入使得负定：τ＝‑Γ2e1‑LTe其中，Γ2＞0为常参数正定增益矩阵。...

【技术特征摘要】
1.一种AUV反演对接控制方法，其特征在于：USBL收发器安装在AUV的头部，
两个USBL应答器B1和B2安装在回收站的两侧，AUV通过USBL定位系统获取应
答器在体坐标系中的位置；对接控制步骤如下：
步骤1：AUV在回收坐标系xoy下从初始点X(0)＝[x0y0T以初始航向角ψ(0)开
始进行回坞导引，其中：x、y为AUV在回收坐标系下的位置坐标，(x(0),y(0))为AUV
航行之前设定的初始值；
所述回收坐标系xoy是：以回坞面对水面的侧边为y轴，侧边的中心为o点，与侧
边垂直的回坞中心轴线为x轴；
步骤2：当接收到AUV的USBL收发器的测量信息，从中提取AUV通过USBL
定位系统获取应答器在体坐标系中的位置，表示为：
xTiByTiB=x‾Tiy‾Yi+l0=cosψsinψ-sinψcosψ(xTiDyTiD-xy),i=1,2]]>其中：为获得的USBL应答器位置测量，l为收发器与体坐标系原点的距
离；
和分别为应答器在回收坐标系和体坐标系下
的坐标；
所述体坐标系是：以AUV的浮心为OB，AUV的纵轴为xB轴，与纵轴垂直的为yB；
步骤3计算对接误差：
AUV应答器位置测量方程式对时间求导：
x·TiBy·TiB=cosψsinψ-sinψcosψ(x·TiDy·TiD-x·y·)+r-sinψcosψ-cosψ-sinψ(xTiDyTiD-xy)=-10yTiB0-1-xTiBuvri=1,2]]>在航行过程中需满足：xT1B-...

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