基于Jacobi几何向量的多AUV编队控制方法

研究了多自主水下航行器(MAUV)系统的水平面动力学建模和系统编队控制问题。从单个自主水下航行器的动力学和运动学模型出发,通过引入Jacobi几何向量建立了MAUV系统的水平面动力学模型;结合典型水下航行器全方位智能导器(ODIN)的流体动力参数,将系统模型解耦为3个线性子系统——编队队形、编队运动(即编队中心点的运动)及航行器转向子系统,并采用线性状态反馈法设计了运动控制器和转向控制器。仿真结果表明,该算法可以控制MAUV系统在保持编队队形的基础上跟踪已知路径。