[发明专利]基于迭代的自主水下航行器三维曲线路径跟踪控制方法

说明书

技术领域

本发明涉及欠驱动自主水下航行器的三维空间运动控制技术领域。

背景技术

海底地形的勘探和测绘对深海资源的开发有着重要的意义，欠驱动自主水下航行器AUV（Autonomous Underwater Vehicle）由于具有良好的机动性和续航能力，在海洋勘探开发中扮演着重要的角色，随着AUV在海洋工程领域应用的不断深入，使得对AUV在水下三维空间的运动控制技术的研究提出了新的挑战，考虑到受到航行经济性或负载能力制约，通常执行机构配置为纵向尾部推进器、水平方向舵和垂直升降舵，AUV大多未配备横向和垂向辅助推进器，使得控制输入的维数远小于运动自由度数，为欠驱动系统，无法设计光滑时不变控制律实现反馈控制，同时由于受到复杂多变的海洋环境作用，使得AUV动力学模型具有较高的非线性、不确定性和模型自身存在的耦合性，这也成为欠驱动AUV三维空间跟踪控制器设计的难点。

目前，国内外针对欠驱动AUV的三维空间运动控制的研究较少，研究大多针对解耦的水平面运动子系统和垂直面深度控制子系统分别设计控制器，进而实现对欠驱动自主水下航行器在水下三维空间的运动控制，由于忽略了模型的耦合作用，设计的控制器无法实现欠驱动AUV对空间任意平滑曲线的跟踪控制。这里讨论的跟踪控制问题具体为水下三维空间的路径跟踪控制问题，水下三维空间路径的描述通过参数化方程进行描述，不同于三维轨迹跟踪控制问题中的轨迹方程以时间作为参数，克服了传统轨迹跟踪控制问题中由于引入具有同构动力学模型的“虚拟AUV”受到环境干扰作用引起闭环跟踪系统具有不稳定动态，本发明中通过设计期望路径上“虚拟向导”的移动速度作为跟踪系统额外的控制输入，由于“虚拟向导”只具有运动学特性而无具体动力学模型，因此状态不受外界扰动的影响，能够保证跟踪系统的稳定性和动态性能。

P.Encarnacao等在论文《3D Path Following for Autonomous Underwater Vehicle》（Proceedings of the 39th IEEE Conference on Decision and Control,IEEE Press,2000,Sydney.）利用正交投影的思想建立AUV在期望路径坐标系（Serret-Frenet）下的三维路径跟踪误差模型，由于存在奇异值点，对AUV的初始位置有约束，无法实现AUV跟踪的全局收敛，而本专利建立的AUV载体坐标系下的三维跟踪误差模型不存在奇异值问题，因此能够保证AUV跟踪误差的全局收敛性；《基于自适应Backstepping的欠驱动AUV三维航迹跟踪控制》（控制与决策，2012，第38卷第2期）依据视线法（line-of-sight,LOS）计算期望跟踪视线角,基于自适应反步法设计跟踪控制器，针对离散的航迹点的跟踪控制，并未给出三维航迹跟踪的误差方程，无法实现对三维空间光滑曲线的跟踪；且跟踪导引策略为视线法（Line of Sight,LOS）而本专利采用的为虚拟向导策略（Virtual Guidance），通过跟踪期望路径上的“虚拟向导”点实现AUV收敛于期望路径；文献《基于离散滑模预测的欠驱动AUV三维航迹跟踪控制》（控制与决策,2011,第26卷第10期）中给出了在期望路径上虚拟向导坐标系下的AUV三维路径跟踪误差方程的形式，将AUV假定为虚拟质点，假设运动方向与合速度矢量方向一致，获得的三维路径跟踪误差方程需要AUV运动的侧漂角和攻角精确可量测，这在实际应用中是存在困难，只能够通过对横向和垂向运动速度的测量，进而计算出侧漂角和攻角，而由于沿三轴线速度的测量较困难，导致最终的控制器解算存在潜在的中断可能。《基于非线性迭代滑模的欠驱动UUV三维航迹跟踪控制》（自动化学报，2012，第38卷第2期）基于工程控制器解耦的思想设计非线性迭代滑模航迹跟踪控制器，由于被控对象模型为六自由度耦合运动模型，因此针对纵向速度、艏向控制和纵倾控制分别设计的解耦控制器只能通过鲁棒项抑制模型中的耦合作用，当模型各自由度之间的耦合作用较明显时，控制器只能通过输出较高的控制器增益为代价消除耦合作用，引起控制器输出饱和信号，解耦的控制器只能够保证三个独立控制子系统的渐近稳定性，而无法保证整个控制系统的渐近稳定性，而本专利提出的三维航迹跟踪控制器能够保证整个系统全局渐近稳定性；《自主式水下航行器三维路径跟踪的神经网络H_∞鲁棒自适应控制方法》（控制理论与应用，2012，第29卷第3期）基于正交投影Serret-Frenet坐标系建立AUV三维路径跟踪误差方程，运用H_∞鲁棒控制思想设计控制器，同时引入神经网络补偿模型不确定性，但由于基于正交投影Serret-Frenet坐标系建立AUV三维路径跟踪误差模型存在奇异值点，使得对AUV的初始条件有约束，即AUV初始位置必须位于跟踪曲线最小曲率半径内，因此无法实现AUV跟踪的全局收敛性，而本专利建立在AUV载体坐标系下表示的三维跟踪误差模型不存在奇异值问题，因此能够保证AUV跟踪误差的全局收敛性，此外本专利采用迭代方法设计控制器不同于H_∞鲁棒控制设计思想。