论文部分内容阅读
AUV是典型的高度非线性、强耦合、运动模型不确定以及干扰严重的系统。从而给AUV的运动控制带来了较大难度。在执行海底石油管道、海底电缆检测任务,地形、地貌探测任务,海洋观测、海平面分析,以及军事应用等任务时都需要AUV能够高效、精确的跟踪特定曲线。本文对AUV的轨迹跟踪控制问题进行了研究。首先,根据牛顿力学和刚体动力学以及流体力学理论建立了AUV运动六自由度数学模型。并对AUV在平面中的轨迹跟踪问题进行了研究,将AUV的运动分解为水平面运动和纵平面运动,利用反步法分别设计水平面以及纵平面的轨迹跟踪控制器,并对定常干扰进行了估计补偿,仿真结果显示控制器可以获得较好的控制效果。反步法通过李亚普诺夫控制函数构建反馈控制律,思路简单,设计灵活。其次,介绍了基于状态的黎卡提方程(SDRE)基本原理,解的存在性,稳定性以及设计方法等内容,SDRE是一种非线性的设计方法,无需对模型进行线性化,这种方法将非线性动态系统因式分解成状态向量表示的形式,最终形成基于自身状态的矩阵函数,可在线求解得到次优的控制律。利用SDRE方法设计了AUV在三维空间的轨迹跟踪控制器,并进行了仿真验证,结果显示SDRE控制器可以实现AUV在三维空间的轨迹跟踪控制。在仿真过程中发现,SDRE控制器的权值Q和R对系统性能影响较大,因此,考虑引入粒子群算法寻找更优的权值Q和R。最后,对基本粒子群算法进行了部分改进,提出一种基于种群历史经验的粒子群算法(GHEPSO),粒子在受当前迭代时刻种群最优位置和自身历史最优位置影响的同时,也受前几个迭代时刻种群最优位置的影响,相对于基本粒子群算法对群体经验信息的利用更加充分。通过几个典型的测试函数对算法性能进行了分析,并与基本粒子群算法进行了比较,结果表明GHEPSO算法相对于基本粒子群算法具有更好的优化效果,而将GHEPSO和时变加速系数(TVAC)以及带交叉的粒子群(MPSO)相结合使用可以进一步提高优化效果。利用GHEPSO、TVAC、MPSO相结合的粒子群算法对SDRE控制器的权值Q和R进行寻优,利用寻优得到的Q和R参数重新对SDRE控制器进行了仿真分析,结果显示,系统获得了更好的跟踪效果。