水下机器人轨迹跟踪的全局积分滑模控制技术

1. 水下机器人轨迹跟踪控制概述

水下机器人（ROV/AUV）的轨迹跟踪控制一直是海洋工程领域的核心挑战。不同于陆地或空中机器人，水下环境存在水流扰动、模型参数不确定、执行器饱和等复杂干扰因素。传统PID控制在强干扰下容易失稳，而全局积分滑模控制（Global Integral Sliding Mode Control, GISMC）通过引入积分项和滑模面，能有效抑制系统不确定性带来的影响。

我在某型AUV的湖试项目中首次接触这种控制方法。当时遇到的最大问题是机器人在3-4级水流扰动下出现轨迹偏移，最大横向误差达到1.2米。改用GISMC方案后，跟踪误差稳定在±0.3米以内。这种控制策略的核心优势在于：

1. 积分项消除稳态误差
2. 滑模面对参数摄动和外部干扰具有强鲁棒性
3. 全局特性保证系统从初始时刻就处于滑模面上

2. 控制系统建模与问题描述

2.1 水下机器人水平面运动模型

采用标准的3自由度（surge, sway, yaw）水平面模型：

code复制Mν̇ + C(ν)ν + D(ν)ν = τ + τ_d

其中：

• M ∈ R³ˣ³ 为惯性矩阵（包含附加质量）
• C(ν) ∈ R³ˣ³ 为科里奥利向心力矩阵
• D(ν) ∈ R³ˣ³ 为阻尼矩阵
• ν = [u v r]ᵀ 为体坐标系下的速度向量
• τ ∈ R³ 为控制输入
• τ_d ∈ R³ 为外界干扰

注意：实际建模时需要在水池试验中通过系统辨识获取M、C、D矩阵的具体参数，我们团队采用最小二乘法辨识得到的参数误差在8%以内。

2.2 轨迹跟踪问题转化

定义惯性系下的位置误差：

code复制e = [x - x_d, y - y_d, ψ - ψ_d]ᵀ

通过坐标变换将误差方程转换到体坐标系：

code复制ė = R(ψ)ν - [ẋ_d, ẏ_d, ψ̇_d]ᵀ

其中R(ψ)为旋转矩阵。控制目标是设计τ使得lim(t→∞)e(t)=0。

3. 全局积分滑模控制器设计

3.1 滑模面设计

与传统滑模控制不同，GISMC的滑模面定义为：

code复制s = ė + K₁e + K₂∫e dt

其中K₁、K₂为对角正定矩阵。这个设计有三大特点：

1. 积分项∫e dt消除稳态误差
   2