水下自主航行器轨迹跟踪的全局积分滑模控制

1. 项目背景与核心挑战

水下自主航行器（AUV）在海洋勘探、管道巡检等领域具有重要应用价值。欠驱动系统指执行器数量少于自由度数的系统，这类AUV通常只有尾部推进器和方向舵，却需要同时控制位置和姿态。水平面轨迹跟踪的核心难点在于：

1. 强非线性特性：水动力系数随速度变化，流体阻尼与速度平方成正比
2. 模型不确定性：洋流扰动、参数摄动等未建模动态
3. 欠驱动耦合：横向位移无法直接控制，需通过艏向角间接调节

传统PID控制在动态环境下表现不佳，而滑模控制（SMC）因其强鲁棒性成为理想选择。全局积分滑模（GISMC）在传统SMC基础上引入积分项，能有效消除稳态误差。

实测数据表明：在2节流速扰动下，常规SMC的跟踪误差可达船长的10%，而GISMC能控制在3%以内

2. 控制系统架构设计

2.1 运动学与动力学模型

采用Serret-Frenet坐标系建立跟踪误差模型：

matlab复制% 位置误差微分方程
function derror = error_dynamics(t, error)
    psi = error(3); % 艏向角
    u = 1.0; % 前进速度(m/s)
    delta = 0.1; % 舵角(rad)
    
    derror = [
        u*sin(psi) - k1*error(1);
        u*cos(psi) - k2*error(2);
        r_desired - (u*tan(delta)/L)
    ];
end

动力学模型考虑科里奥利力、阻尼矩阵和恢复力：

code复制M*v_dot + C(v)*v + D(v)*v + g(η) = τ + τ_disturbance

2.2 全局积分滑模面设计

创新性地将积分项与跟踪误差结合：

code复制s = ė + λ1*e + λ2*∫e dt

其中λ1、λ2为设计参数，通过Lyapunov稳定性理论证明：

code复制V = 0.5*s^T*M*s ⇒ V_dot ≤ -η||s||

2.3 控制分配策略

针对欠驱动特性，采用虚拟控制量分解：

1. 计算总需推力 F_desired
2. 通过伪逆法分配推进器指令：