多关节深海潜水器纵垂面建模与俯仰控制

摘要：

为实现深海纵向剖面探测,给出了一种多关节潜水器的设计方案,并对潜水器的纵垂面建模与俯仰姿态控制问题进行了研究.针对浮力和重力不平衡的情况,根据牛顿第二定律和力矩平衡原理建立了多关节潜水器在纵垂面上的运动学和动力学模型.考虑到多关节潜水器在纵倾运动控制过程中存在未知干扰和过驱动等问题,提出了一种线性二次型最优自抗扰控制方案.根据实验样机硬件设计要求,将关节摆动角度作为被控系统输入.将系统内力与外部扰动作为系统总扰动,采用线性扩张状态观测器对总扰动进行估计.针对系统过驱动问题,采用奇异值分解法求解控制系数矩阵的伪逆矩阵,实现总扰动补偿与输入合理分配.采用线性二次最优控制优化线性反馈控制增益,实现控制增益按照期望输入输出效果达到最优.在SIMULINK平台上,搭建模型仿真环境,在有、无输入扰动两种情况下,使用线性二次型最优自抗扰控制器实现俯仰控制仿真.结果表明,所设计的控制器具有低超调、抗干扰和精准度高的特性.

关键词：多关节潜水器、纵垂面建模、俯仰姿态控制、线性扩张状态观测器、总扰动补偿、线性二次型最优控制器

所属期刊栏目：39

分类号：U674.941

资助基金：国家重点研发计划2017YFC0306200

在线出版日期：2023-02-15（万方平台首次上网日期，不代表论文的发表时间）

页数：共9页

页码：357-365