Huang Xiaoyu,Sun Yongzhi,Li Jinrong,et al.Trajectory Tracking Control of Mecanum Wheels Mobile Platform Based on MPC[J].Journal of Mechanical Transmission,2023,47(11):22-29.
Huang Xiaoyu,Sun Yongzhi,Li Jinrong,et al.Trajectory Tracking Control of Mecanum Wheels Mobile Platform Based on MPC[J].Journal of Mechanical Transmission,2023,47(11):22-29. DOI: 10.16578/j.issn.1004.2539.2023.11.004.
Trajectory Tracking Control of Mecanum Wheels Mobile Platform Based on MPC
针对麦克纳姆轮全向移动平台轨迹跟踪控制问题,提出了一种模型预测控制(Model Predictive Control,MPC)和微分先行比例-积分-微分(Proportional plus Integral plus Derivative,PID)协同的双闭环控制策略。基于麦克纳姆轮运动学特点,设计了位姿控制环和速度控制环;在位姿控制环建立麦克纳姆轮底盘的线性误差模型,设计二次型目标函数,将路径跟随问题转化为对非线性模型的预测控制;在速度控制环引入微分先行PID控制器,避免输入量频繁的阶跃变化对系统产生高频干扰,加快麦克纳姆轮的角速度收敛,增强了系统稳定性。仿真实验表明,设计的控制器在收敛速度、跟踪精度方面均高于常见的轨迹跟踪器,对麦克纳姆轮移动平台的控制具有良好的鲁棒性。
Abstract
For the trajectory tracking control problem of the omnidirectional mobile platform of Mecanum wheels
a strategy of double closed-loop control with model predictive control (MPC) and differential forward proportional plus integral plus derivative (PID) is proposed. The attitude control loop and velocity control loop are designed based on the kinematics characteristics of Mecanum wheels. The linear error model of the Mecanum wheels chassis is established by the attitude control loop
the quadratic objective function is designed
and the problem of path following is transformed into predictive control for the nonlinear model. In the velocity control loop
the differential forward PID controller is used to avoid the high-frequency disturbance to the system caused by frequent step changes of the input quantity
accelerate the convergence of the angular velocity of the Mecanum wheels
and enhance the stability of the system. Simulation experiments demonstrate that the controller designed in this study has better convergence speed and tracking accuracy than the commonly used trajectory algorithm
and it can provide good robustness to control the mobile platform of Mecanum wheels.
YIN Hesheng,ZHANG Qiuju,NING Meng,et al.Trajectory tracking control system of robot based on slip dynamics model[J].Journal of Mechanical Transmission,2018,42(4):1-6.
HUANG Lei,YU Feng.Research on robot end tracking control based on visual feedback[J].Instrument Technique and Sensor,2021(8):95-98.
ZHANG Y N,WANG S S,ZHANG J,et al.Research on motion characteristic of omnidirectional robot based on Mecanum wheel[C]//2010 International Conference on Digital Manufacturing & Automation.IEEE Computer Society,2010(2):237-241.
YADAV P S,AGRAWAL V,MOHANTA J C,et al.A robust sliding mode control of Mecanum wheel-chair for trajectory tracking[J].Materials Today:Proceedings,2022,56:623-630.
LUO X,AMIGHETTI A,ZHANG D.A human-robot interaction for a Mecanum wheeled mobile robot with real-time 3D two-hand gesture recognition[J].Journal of Physics:Conference Series,2019,1267(1):012056.
JIANG Menglin,ZHAO Dequan,SUN Yongfu,et al.Adaptive sliding mode controller design for Mecanum-wheeled mobile vehicle[J].Manufacturing Automation,2022,44(1):164-169.
SUN Z,XIE H,ZHENG J,et al.Path-following control of Mecanum-wheels omnidirectional mobile robots using nonsingular terminal sliding mode[J].Mechanical Systems and Signal Processing,2021,147:107128.
LU X,ZHANG X,ZHANG G,et al.Neural network adaptive sliding mode control for omnidirectional vehicle with uncertainties[J].ISA Transactions,2018,86:201-214.
ZHANG Peng,NIU Zijie,WANG Longning,et al.Research on fuzzy PI control of omnidirectional mobile robot[J].Computer Simulation,2021,38(10):353-360.
ZOU X,ZHAO T,DIAN S.Finite-time adaptive interval type-2 fuzzy tracking control for Mecanum-wheel mobile robots[J].International Journal of Fuzzy Systems,2022,24(3):1570-1585.
CAMACHO E F,ALBA C B.Model predictive control[M].Springer Science & Business Media,2013:13-30.
LU Chunlei.Path planning and target detection and localization of Mecanum robots in unknown environment[D].Dalian:Dalian Maritime University,2020:6-13.