面向水下搜救的自主水下航行器路径跟踪控制

对自主水下航行器（AUV）在执行水下搜救任务过程中遇到的三维路径跟踪控制和定点驻停问题进行研究。在固定坐标系和机体坐标系下建立AUV的运动学模型，引入流体坐标系，设计适宜进行运动控制的三维路径跟踪控制器，并在Serret-Frenet坐标系下建立AUV的路径跟踪误差模型；基于三维视距制导律控制设计AUV的三维路径跟踪控制器，在此基础上提出一种适于水下搜救工况的AUV路径跟踪控制方法，使AUV能完成对参数化路径的跟踪和在预设目标点的驻停；同时，基于李雅普诺夫稳定性原理证明该控制器的稳定性。仿真试验结果表明，设计的控制器有效，能实现对面向水下搜救的AUV路径跟踪控制。