摘要：水下游动机械臂（underwater swimming manipulator， USM）作为一种新型的水下机器人，其镇定控制对于水下观测和作业任务的顺利完成具有重要意义。本文针对USM六自由度镇定控制时，其模型难以准确建立、水流等外部扰动难以观测和六个维度的控制器参数整定困难等问题，提出了一种基于模糊反馈线性化和自适应扩张状态观测器的控制方法。首先建立了USM的动力学模型；其次，考虑到USM强非线性和强耦合性的特点，对动力学模型反馈线性化后设计了PD控制器，并引入了模糊控制逻辑调整控制器的参数；同时为减少建模误差和实际水下环境存在各种不确定干扰对控制效果的影响，设计了一种自适应扩张状态观测器来实时补偿模型的不准确性和外扰。最终，在湖中实验测得：本文方案六维均方根误差为RMSE=（0.4252，0.1668，0.1685，0.2674，0.1174，1.0033），较之传统方案有明显的提升，证明了所提方案的有效性。
文章目录
0 引 言
1 USM动力学模型
1.1 模型坐标系建立
1.2 动力学模型
1.3 矢量推进系统
2 控制器设计
3 扰动观测器设计
4 稳定性证明
5 实验验证
6 结论
