1. 欠驱动AUV控制问题概述
欠驱动自主水下航行器(AUV)是指执行机构数量少于系统自由度的水下机器人系统。这类系统在海洋工程领域具有广泛应用价值,但同时也带来了独特的控制挑战。与全驱动系统不同,欠驱动AUV无法直接控制所有自由度,必须通过巧妙的控制策略实现轨迹跟踪和路径跟随。
在实际应用中,欠驱动特性主要体现为:
- 水平面运动通常只有推进器和舵两个控制输入
- 垂直面运动可能仅靠推进器和俯仰控制面
- 系统存在非完整约束(nonholonomic constraints)
这种特性使得传统控制方法难以直接应用,需要开发专门的非线性控制策略。本文研究的核心问题就是如何在欠驱动约束下,实现AUV对预定轨迹的高精度跟踪。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 系统建模与问题描述
2.1 AUV动力学模型
欠驱动AUV的水平面运动通常采用以下非线性模型:
code复制Mν̇ + C(ν)ν + D(ν)ν = τ + τ_env
η̇ = J(η)ν
其中:
- M ∈ R³ˣ³为惯性矩阵(包含附加质量)
- C(ν) ∈ R³ˣ³为科里奥利和向心力矩阵
- D(ν) ∈ R³ˣ³为阻尼矩阵
- ν = [u, v, r]ᵀ为体坐标系下的速度向量
- η = [x, y, ψ]ᵀ为地球坐标系下的位置和姿态
- J(η)为坐标转换矩阵
- τ为控制输入
- τ_env为环境干扰
2.2 控制问题定义
轨迹跟踪问题可表述为:设计控制律τ使得AUV的位置η(t)渐近跟踪参考轨迹η_d(t),即:
lim(t→∞) ||η(t) - η_d(t)|| = 0
路径跟随问题则要求AUV收敛到参考路径而不强调时间约束:
lim(t→∞) dist(η(t), P_d) = 0
其中P_d表示参考路径。
3. 控制策略设计与实现
3.1 全局积分滑模控制(GISMC)设计
3.1.1 运动学控制器设计
基于反步法的运动学控制器设计步骤如下:
-
定义位置误差:
e_x = x - x_d
e_y = y - y_d -
设计虚拟控制量:
u_d = ẋ_d cosψ + ẏ_d sinψ - k_x e_x
r_d = ( -ẋ_d sinψ + ẏ_d cosψ - k_y e_y ) /
