MPC Based Trajectory Tracking for An Automonous Deep-Sea Tracked Mining Vehicle
Keywords:Deep-sea tracked mining vehicle, Trajectory tracking, Model predictive control, Kalman filter, Path planning
Model predictive control (MPC) has been successfully used in trajectory tracking for autonomous vehicles based on certain kinematic model under low external disturbance conditions, but when there are model uncertainties and external disturbances, autonomous vehicles will fail to follow the pre-set trajectory. This paper studies trajectory tracking control based on MPC for an autonomous deep-sea tracked mining vehicle in polymetallic nodule mines with model uncertainty and external disturbances. A MPC algorithm is designed for trajectory tracking. To address model uncertainties caused by vehicle body subsidence and track slippage, a drive wheel speed correction controller is designed by experimental data fitting, and Kalman filtering (KF) and adaptive Kalman filtering (AKF) are introduced to improve tracking performance by rejecting external disturbances especially during curve tracking. To handle dead zones and obstacles during actual operation, an obstacle avoidance strategy is proposed that uses the tri-circular arc obstacle avoidance trajectory with an equal curvature for path re-planning. Finally, Simulink&Recurdyn co-simulations validate the performance of the proposed MPC controller through a comparison with nonlinear MPC(NMPC).
M. Lesage, C. Juliani, S. L. Ellefmo, “Economic Block Model Development for Mining Seafloor Massive Sulfides,” Minerals, vol. 8, no. 10, 2018.
S. E. Volkmann, T. Kuhn, F. Lehnen, “A comprehensive approach for a techno-economic assessment of nodule mining in the deep sea,” Mineral Economics, vol. 31, no. 3, pp. 319-336, 2018.
Y. Dai, S.-j. Liu, “An integrated dynamic model of ocean mining system and fast simulation of its longitudinal reciprocating motion,” China Ocean Engineering, vol. 27, no. 2, pp. 231-244, 2013.
Y. Dai, S.-j. Liu, “Theoretical design and dynamic simulation of new mining paths of tracked miner on deep seafloor,” Journal of Central South University, vol. 20, no. 4, pp. 918-923, 2013.
Y. Dai, S.-j. Liu, L. Li, “Dynamic Analysis of the Seafloor Pilot Miner Based on Single-Body Vehicle Model and Discretized Track-Terrain Interaction Model,” China Ocean Engineering, vol. 24, no. 1, pp. 145-160, 2010.
J. Li, S. Liu, Y. Dai, “Effect of grouser height on tractive performance of tracked mining vehicle,” Journal of the Brazilian Society of Mechanical Sciences and Engineering, vol. 39, no. 7, pp. 2459-2466, 2017.
Q.-J. Han, S.-j. Liu, “ Theoretical design and dynamic simulation of new mining paths of tracked miner on deep seafloor,” Journal of Central South University, vol. 46, no. 02, pp. 472-478, 2015.
L.Li, Z.Zheng, M.Chen, “ Point stabilization of seabed mining vehicle based on Lyapunov theory,” Journal of Central South University, vol. 45, no. 08, pp. 2624-2628, 2014.
L.Li, Y.-H. Zou, “ Tracking moving path of seabed mining vehicle based on theory of variable universe fuzzy control,” Journal of Central South University, vol. 43, no. 02, pp. 489-496, 2012.
W. Gan, D. Zhu, Z. Hu, et al., “Model Predictive Adaptive Constraint Tracking Control for Underwater Vehicles,” Ieee Transactions on Industrial Electronics, vol. 67, no. 9, pp. 7829-7840, 2020.
C. Shen, Y. Shi, B. Buckham, “Trajectory Tracking Control of an Autonomous Underwater Vehicle Using Lyapunov-Based Model Predictive Control,” Ieee Transactions on Industrial Electronics, vol. 65, no. 7, pp. 5796-5805, 2018.
Y. Chen, X. Xie, T. Zhang, et al., “A deep residual compensation extreme learning machine and applications,” Journal of Forecasting, vol. 39, no. 6, pp. 986-999, 2020.
Y. Chen, C. Yi, X. Xie, et al., “Solution of Ruin Probability for Continuous Time Model Based on Block Trigonometric Exponential Neural Network,” Symmetry-Basel, vol. 12, no. 6, 2020.
R. M. Saback, A. G. Scolari Conceicao, T. L. Maia Santos, et al., “Nonlinear Model Predictive Control Applied to an Autonomous Underwater Vehicle,” Ieee Journal of Oceanic Engineering, vol. 45, no. 3, pp. 799-812, 2020.
B. Zhang, X. Sun, S. Liu, et al., “Adaptive model predictive control with extended state observer formulti-UAVformation flight,” International Journal of Adaptive Control and Signal Processing, vol. 34, no. 10, pp. 1341-1358, 2020.
X. Song, Y. Shao and Z. Qu, "A Vehicle Trajectory Tracking Method With a Time-Varying Model Based on the Model Predictive Control," in IEEE Access, vol. 8, pp. 16573-16583, 2020. doi: 10.1109/ACCESS.2019.2963291.
H. Wu, Z. Si and Z. Li, "Trajectory Tracking Control for Four-Wheel Independent Drive Intelligent Vehicle Based on Model Predictive Control," in IEEE Access, vol. 8, pp. 73071-73081, 2020. doi: 10.1109/ACCESS.2020.2987812.
S. Li, Z. Li, Z. Yu, B. Zhang and N. Zhang, "Dynamic Trajectory Planning and Tracking for Autonomous Vehicle With Obstacle Avoidance Based on Model Predictive Control," in IEEE Access, vol. 7, pp. 132074-132086, 2019.doi: 10.1109/ACCESS.2019.2940758
A. Al-Mayyahi, A. A. Aldair, A. T. Rashid, “Intelligent Control of Mobile Robot Via Waypoints Using Nonlinear Model Predictive Controller and Quadratic Bezier Curves Algorithm,” Journal of Electrical Engineering & Technology, vol. 15, no. 4, pp. 1857-1870, 2020.
E. Kim, J. Kim, M. Sunwoo, “model predictive control strategy for smooth path tracking of autonomous vehicles with steering actuator dynamics,” International Journal of Automotive Technology, vol. 15, no. 7, pp. 1155-1164, 2014.
A. Britzelmeier, M. Gerdts, “A Nonsmooth Newton Method for Linear Model-Predictive Control in Tracking Tasks for a Mobile Robot With Obstacle Avoidance,” Ieee Control Systems Letters, vol. 4, no. 4, pp. 886-891, 2020.
Z. Yao, B. Zhao, T. Yuan, et al., “Reducing gasoline consumption in mixed connected automated vehicles environment: A joint optimization framework for traffic signals and vehicle trajectory,” Journal of cleaner production, vol. 265, 2020.
X. Yang, R. Seethaler, C. Zhan, et al., “A Model Predictive Contouring Error Precompensation Method,” Ieee Transactions on Industrial Electronics, vol. 67, no. 5, pp. 4036-4045, 2020.
C. Hide, T. Moore, M. Smith, et al., "Adaptive Kalman filtering algorithms for integrating GPS and low cost INS," in Plans 2004: Position Location and Navigation Symposium, pp. 227-233, 2004.
G. Bai, L. Liu, Y. Meng, et al., “Path Tracking of Wheeled Mobile Robots Based on Dynamic Predicition Model,” IEEE Access, vol. 7, pp. 39690-39701, 2019.
G. Bai, Y. Meng, L. Liu, et al., “A New Path Tracking Method Based on Multilayer Model Predictive Control,” Applied Sciences-Basel, vol. 9, no. 13, 2019.
P. Hang, S. Huang, X. Chen, et al., “Path planning of collision avoidance for unmanned ground vehicles: A nonlinear model predictive control approach,” Proceedings of the Institution of Mechanical Engineers Part I-Journal of Systems and Control Engineering, 2020.
L. Phan Gia, T. Nguyen Truong, “Real-Time Hybrid Navigation System-Based Path Planning and Obstacle Avoidance for Mobile Robots,” Applied Sciences-Basel, vol. 10, no. 10, 2020.
C. Hong, Model Predictive control, Science Publishing House, Beijing, 2013.
Z. Yan, P. Gong, W. Zhang, and W. Wu, "Model predictive control of autonomous underwater vehicles for trajectory tracking with external disturbances," Ocean Engineering, vol. 217, Dec 1 2020.
Howard, S. , Ko, H. L. and Alexan De R, W. E. . "Parallel processing and stability analysis of the Kalman filter,"IEEE Fifteenth International Phoenix Conference on Computers & Communications. IEEE,1996.
OYELERE S S. “The application of model predictive control (MPC) to fast systems such as autonomous ground vehicles (AGV), ” IOSR Journal of Computer Engineering, vol.3, no. 3,pp. 27-37, 2014.
Y. Ephraim, N. Merhav, “Hidden Markov processes,” Ieee Transactions on Information Theory, vol. 48, no. 6, pp. 1518-1569, 2002.