[发明专利]海流干扰下基于滑模自适应控制的AUV近距离对接方法

说明书

本发明涉及一种海流干扰下基于滑模自适应控制的AUV近距离对接方法，设计控制器时不再对AUV的运动进行解耦，同时在设计滑模自适应控制器的时候增加了积分环节，采用积分滑模自适应控制(Integral Sliding Mode Adaptive Control，ISMAC)的方法，尽量削弱对接AUV在趋近运动过程中的抖振。最终，在设计控制参数时，在牺牲调节时间的情况下，尽量减小超调量，使对接可以顺利完成。同时，对海流速度进行估计，使系统具有一定的抗干扰能力，也表明了系统的鲁棒性。

技术领域

本发明属于无人水下航行器技术领域，涉及一种海流干扰下基于滑模自适应控制的AUV近距离对接方法，具体涉及一种海流干扰下全驱动水下航行器对接控制系统及其控制方法。

背景技术

无人水下航行器在海洋研究、生态检测、军事侦察等领域有着重要且广泛的应用。航行器跟踪控制是水下航行器完成预设任务的基础，为了满足水下作业工况的需要，往往要求航行器控制系统可以从任意初始状态跟踪上期望的轨迹，且收敛速度具有快速性。

在较近距离水下航行器跟踪时，声学传感器的精度不足，而视觉传感器在短程探测方面具有明显的优势，识别精度可达到厘米级，而且体积小，便于携带和安装，更适用于近距离的水下跟踪。

水下航行器近距离跟踪时由于限制条件较多，无法将全驱动航行器运动解耦到水平和垂直面。对于滑模控制而言，在模型不准确与外界干扰的影响下，控制规律在穿过滑模面s＝0时必然是不连续的，这必然导致控制规律中抖振现象的产生。为了削弱抖振现象，第一步是考虑参数不确定性，通过自适应控制在线估计参数值，使参数估计误差收敛到零，依此来削弱参数不确定性对系统的影响；而第二步是想办法将控制输入进行适当的平滑，以此来得到控制带宽与跟踪精度之前的最佳权衡。

发明内容

要解决的技术问题

为了避免现有技术的不足之处，本发明提出一种海流干扰下基于滑模自适应控制的AUV近距离对接方法。旨在考虑海流干扰下，提供一种全驱动航行器跟踪控制系统及其控制方法。跟随航行器通过视觉传感器获得相对位姿信息，并通过设计滑模控制器实现跟随航行器的路径跟踪。

技术方案

一种海流干扰下基于滑模自适应控制的AUV近距离对接方法，其特征在于：用于多水下航行器协同系统中，多水下航行器协同系统至少包括一台母体AUV和一台跟随AUV；母体AUV后端设有对接机构，跟随AUV前端设有单目相机；母体AUV上搭载有光源信标与ArucoMarker码为跟随AUV提供视觉信息的视觉传感器用于感知二者相对位姿；对接步骤如下：

步骤1：建立AUV在海流干扰下的动力学模型；

其中，η＝[x y z ψ θ]^T为对接AUV的运动状态，也是运动学方程的系统输出，v_r＝[u_r v_r w_r q r]^T为运动学方程的控制输入，也是对接AUV相对于水流的速度，v_f＝[v_fx v_fyv_fz 0 0]^T为地面坐标系下的水流速度，n为AUV在水下受到的外界动态干扰。M为惯性矩阵；C(v)为哥氏力和向心力矩阵；D(v)为阻尼矩阵；J(ψ,θ)为转换矩阵且包含以下参数θ为俯仰角，ψ为航向角；τ_T为AUV在运动过程中所产生的控制力矩，g(η)为载体系下的恢复力矩。

步骤2：设计AUV在海流干扰下的动力学模型的滑模控制器，控制输入为：

输出为航行器推进器的力；

其中：L分别为对应推进器到AUV几何中心的直线距离且表示为：