基于PSO优化的LADRC水下机器人深度控制
唐军,洪枝敏,罗瑞智,王子梦
(江西理工大学机电工程学院,江西赣州341000)
摘 要: 针对传统PID在ROV定深运动中控制效果不佳的问题,提出一种基于PSO优化的LADRC控制方法
对ROV定深运动进行控制。对八推进器ROV进行了动力学与运动学分析,得到定深运动数学模型。在Matlab中使
用基于PSO优化的LADRC控制器对ROV的定深运动进行仿真,与传统PID控制方法、基于经验法调参LADRC控
制方法进行对比分析,并搭建定深测试平台,读取深度航行数据。仿真结果表明:相较于串级PID,串级LAD-
RC超调量减少了37%,调节时间减少了6.25%;PSO优化后的串级LADRC和串级LADRC相比,超调量减少了
60%。使用PSO算法优化后的LADRC控制方法超调量小,控制效率更高。
关键词:水下机器人;LADRC;PSO
中图分类号:TP183文献标识码:A
文章编号:1672–7649(2022)13–0111–06doi:10.3404/j.issn.1672–7649.2022.13.025
Depth control of LADRC underwater robot based on PSO optimization
TANGJun,HONGZhi-min,LUORui-zhi,WANGZi-meng
(CollegeofMechanicalEngineering,JiangxiUniversityofScienceandTechnology,Ganzhou341000,China)
Abstract:FortheproblemoftheproblemofpoorcontroleffectoftraditionalPIDinROVdepth-keeping,thispaper
presentsaLADRCmethodbasedonPSOoptimizationtocontrolROVfixeddepthmotion.toobtainthemathematicalmodel
oftheconstantdepthmotion,thedynamicsandkinematicsofeight-thrusterROVareanalyzed.Then,theLADRCcontroller
basedonPSOoptimizationisdesignedandthedepth-fixedmotionofROVissimulatedinthesimulinkmoduleofMatlab,
which is compared with the traditional PID control method and the LADRC control method based on empirical method.
TheresultsshowthatcomparedwithcascadePID,cascadeLADRCovershootisreducedby37%andregulationtimeisre-
ducedby6.25%.TheovershootofcascadeLADRCoptimizedbyPSOisreducedby60%comparedwithcascadeLADRC.
TheLADRCcontrolmethodoptimizedbyPSOhassmallerovershootandhighercontrolefficiency.
Key words:ROV;LADRC;PSO
0引 言
遥控无人潜水器(ROV)由于具有携带方便,操作
简单的特点,被广泛应用于水下资源勘探与开采。保
持ROV的深度不受干扰是保证ROV观察与作业的关
键。传统的非线性自抗扰控制器(ADRC)存在待整定
参数过多的问题,不利于工程实践
[1–4]
。线性自抗扰控
制(LADRC)保留了ADRC的状态扩张观测器(ESO),
减少了待整定参数
[5]
。本文构建ROV定深运动的数学
模型,结合LADRC控制方法的优点,提出了基于粒
子群算法(PSO)优化的LADRC控制方法,提高参数
整定效率和系统响应性。
1ROV定深运动数学模型
本文以八推进器水下机器人(ROV)为研究对象,主要
考虑水下机器人的重力与浮力,ROV三维模型如图1
所示。
1.1 推进器推力方程
ROV的水平面推进器分布如图2所示。
每个推进器可以产生2种推力,分别对应推进器
的正转和反转,为坐标原点到推进器的距离,设ROV
定深时不做其他运动,可得ROV定深时受到力矩作用为:
第44卷第13期 舰船科学技术
Vol.44,No.13
2022年7月 SHIPSCIENCEANDTECHNOLOGY Jul.,2022
收稿日期: 2021–06–19
基金项目: 国家自然科学基金资助项目(51864015)
作者简介: 唐军(1978−),男,硕士,副教授,主要从事水下机器人、流体机械等研究。