考虑状态约束与执行器饱和的水下机器人轨迹跟踪控制
Trajectory tracking control of underwater vehicle considering state constraint and actuator saturation
王宇梁 1李一平 2李良1
作者信息
- 1. 中国科学院沈阳自动化研究所机器人学国家重点实验室,沈阳 110016;中国科学院机器人与智能制造创新研究院,沈阳 110016;辽宁省水下机器人重点实验室,沈阳 110016;中国科学院大学,北京 100049
- 2. 中国科学院沈阳自动化研究所机器人学国家重点实验室,沈阳 110016;中国科学院机器人与智能制造创新研究院,沈阳 110016;辽宁省水下机器人重点实验室,沈阳 110016
- 折叠
摘要
针对执行器饱和、模型参数不确定以及海流干扰等因素影响下的水下机器人,提出一种考虑状态约束以及执行器饱和的轨迹跟踪控制器.首先,构建水下机器人水平面轨迹跟踪误差方程;然后,对载体模型参数不确定性产生的模型误差以及海流干扰,设计一个非线性观测器进行估计并用于对控制器进行扰动补偿;接着,引入执行器饱和补偿系统、二阶滤波器以及滤波器误差补偿系统,设计命令滤波反步滑模控制器来控制水下机器人的水平面轨迹跟踪;最后,严格验证命令滤波反步滑模控制器的稳定性并进行数值仿真,验证所提出控制器的有效性.
Abstract
For an underwater vehicle affected by actuator saturation,hydrodynamic parameters uncertainty and ocean current interference,a controller considering actuator saturation compensation and state constraint used trajectory tracking is proposed.Firstly,the horizontal trajectory tracking error equation of the underwater vehicle is constructed.Secondly,a non-linear observer is designed to estimate and compensate for model error resulting from uncertain hydrodynamic parameters and disturbances.Then,an actuator saturation compensation system,a second-order filter and a filter error compensation system are introduced and the command filtering backstepping sliding mode controller is designed to control the trajectory tracking of the underwater vehicle on the horizontal plane.Finally,the stability of the command-filtered backstepping sliding mode controller is strictly proved and the effectiveness of the controller is verified by numerical simulation.
关键词
状态约束/执行器饱和/水下机器人/反步滑模法/轨迹跟踪Key words
state constraint/actuator saturation/underwater vehicle/backstepping sliding mode control/trajectory tracking引用本文复制引用
基金项目
国家重点研发计划(2022YFB4602404)
国家重点研发计划(2021YFC2801101)
出版年
2024