欠驱动AUV轨迹跟踪与路径跟随控制算法对比

1. 项目背景与核心挑战

欠驱动自主水下航行器（AUV）是海洋探测、资源开发等领域的关键装备。与全驱动系统不同，欠驱动AUV的推进器数量少于自由度数量（通常只有主推进器和垂直/水平舵），这种结构在提升续航能力的同时，也带来了控制上的特殊挑战——无法直接控制所有方向的运动状态。

轨迹跟踪（Trajectory Tracking）要求AUV严格遵循时间-空间参数化的路径，而路径跟随（Path Following）则只关注几何路径的收敛，对时间参数不敏感。这两种控制目标在实际应用中各有优劣：前者适合时间敏感任务（如协同作业），后者更适应节能巡航等场景。

关键区别：轨迹跟踪是时变系统控制问题，路径跟随可视为时不变系统控制问题。这个根本差异导致两者在控制器设计时面临不同的稳定性分析框架。

2. 控制算法分析框架比较

2.1 基于李雅普诺夫直接法的设计

在Matlab仿真中，我们首先构建AUV的六自由度非线性动力学模型。考虑流体动力阻尼矩阵D(v)的对称正定性，采用如下能量型李雅普诺夫函数：

matlab复制% 李雅普诺夫函数示例（路径跟随）
V = 0.5*(xe'*Q*xe + psi_e^2); 
dV = xe'*Q*dxe + psi_e*dpsi_e;

其中xe为位置误差，psi_e为航向角误差。通过反步法（Backstepping）逐步处理子系统误差，最终得到推力τ和舵角δ的控制律。仿真显示该方法对参数摄动具有鲁棒性，但需要精确的动力学模型。

2.2 模型预测控制(MPC)实现

在Simulink中搭建预测控制器，核心是以下优化问题的实时求解：

matlab复制function [U_opt, cost] = MPC_Solver(X0, ref_traj)
    cvx_begin
        variable U(Nc,2) % 控制量序列
        minimize (sum_square(X(:,1:3)-ref_traj) + 0.1*sum_square(U))
        subject to
            X = predictDynamics(X0,U); % 动力学预测
            abs(U) <= [F_max; delta_max]';