AUV三维空间轨迹跟踪控制方法的分析研究.pdf

AUV三维卒间轨迹跟踪控制方法研究 摘 要 AUV是典型的高度非线性、强耦合、运动模型不确定以及干扰严重的系统。从而 给AUV的运动控制带来了较大难度。在执行海底石油管道、海底电缆检测任务，地形、 地貌探测任务，海洋观测、海平面分析，以及军事应用等任务时都需要AUV能够高效、 精确的跟踪特定曲线。本文对AUV的轨迹跟踪控制问题进行了研究。 首先，根据牛顿力学和刚体动力学以及流体力学理论建立了AUV运动六自由度数 学模型。并对AUV在平面中的轨迹跟踪问题进行了研究，将AUV的运动分解为水平 面运动和纵平面运动，利用反步法分别设计水平面以及纵平面的轨迹跟踪控制器，并对 定常干扰进行了估计补偿，仿真结果显示控制器可以获得较好的控制效果。反步法通过 李亚普诺夫控制函数构建反馈控制律，思路简单，设计灵活。 其次，介绍了基于状态的黎卡提方程(SDRE)基本原理，解的存在性，稳定性以 及设计方法等内容，SDRE是一种非线性的设计方法，无需对模型进行线性化，这种方 法将非线性动态系统因式分解成状态向量表示的形式，最终形成基于自身状态的矩阵函 数，可在线求解得到次优的控制律。利用SDRE方法设计了AUV在三维空间的轨迹跟 踪控制器，并进行了仿真验证，结果显示SDRE控制器可以实现AUV在三维空间的轨 迹跟踪控制。在仿真过程中发现，SDRE控制器的权值Q和R对系统性能影响较大，因 此，考虑引入粒子群算法寻找更优的权值Q和R。 最后，对基本粒子群算法进行了部分改进，提出一种基于种群历史经验的粒子群算 法(GHEPSO)，粒子在受当前迭代时刻种群最优位置和自身历史最优位置影响的同时， 也受前几个迭代时刻种群最优位置的影响，相对于基本粒子群算法对群体经验信息的利 用更加充分。通过几个典型的测试函数对算法性能进行了分析，并与基本粒子群算法进 行了比较，结果表明GHEPSO算法相对于基本粒子群算法具有更好的优化效果，而将 器的权值Q和R进行寻优，利用寻优得到的Q和R参数重新对SDRE控制器进行了仿 真分析，结果显示，系统获得了更好的跟踪效果。 关键词： 无人水下航行器；轨迹跟踪；SDRE；粒子群 AUV二维宅间轨迹跟踪控制方法研究 i皇iiii；i；；宣m— 1 m m；mi宣昌暑；每昌；；；篁宣；暑葺暑ii暑i皇宣宣 ABSTRACT a with and model to AUVis ever-changingexposed complexsystemnon-linear,coupled controlisa issue．Inthetrack-line severeexternal survey disturbances，SO tough maneuvering cabledetection missions，submarine task，topography,exploration level AUV observations，seaanalysis，andmilitaryapplicationsrequire ofAUVisstudied· a carve．Inthis control tracking specific paper,trajectory tracking mo