NMPC Based-Trajectory Tracking and Obstacle Avoidance for Mobile Robots
(1) * Mohammed Salim Qasim Mail (Ninevah University, Iraq)
(2) Abdurahman Basil Ayoub Mail (Ninevah University, Iraq)
(3) Abdulla Ibrahim Abdulla Mail (Ninevah University, Iraq)
*corresponding author

Abstract


This paper presents the design of a Nonlinear Model Predictive Controller (NMPC) for a wheeled Omnidirectional Mobile Robot (OMR) in order to track a desired trajectory in the presence of previously unknown static and dynamic obstacles in the environment around the robot. A laser rangefinder sensor is used to detect the obstacles where each obstacle occupies numerous points of every sensor reading. The points that belong to each obstacle are then clustered together using the Density-Based Spatial Clustering of Applications with Noise (DBSCAN) algorithm. This research introduces a novel approach to represent obstacles as multiple rotated ellipses, enabling a more accurate representation of complex obstacle shapes without overestimating their boundaries, thereby allowing the robot to navigate through narrow passages. CoppeliaSim robotic simulator is utilized to create the virtual simulation environment as well as simulate the OMR dynamics. MATLAB with the help of the CasADi toolbox is used for the process of the laser rangefinder readings and the implementation of NMPC, respectively.  To validate the effectiveness and robustness of the proposed approach, three simulation scenarios are conducted, each involving distinct trajectories and varying densities of static and/or dynamic obstacles. The proposed control architecture exhibits remarkable performance, enabling the OMR to effectively navigate through narrow passages and avoid multiple static and dynamic obstacles while closely adhering to the desired trajectory.

Keywords


NMPC; Mobile Robot; Trajectory Tracking; Obstacle Avoidance; CoppeliaSim

   

DOI

https://doi.org/10.31763/ijrcs.v4i4.1605 		      

Article metrics

10.31763/ijrcs.v4i4.1605 Abstract views : 266 | PDF views : 52

   

Cite

How to cite item
   

Full Text

Download

References


[1] L. Fiorini et al., “Assistive robots to improve the independent living of older persons: results from a needs study,†Disability and Rehabilitation: Assistive Technology, vol. 16, no. 1, pp. 92–102, 2019, https://doi.org/10.1080/17483107.2019.1642392.

[2] D. P. Losey et al., “Learning latent actions to control assistive robots,†Autonomous Robots, vol. 46, no. 1, pp. 115–147, 2021, https://doi.org/10.1007/s10514-021-10005-w.

[3] M. Qasim and O. Y. Ismael, “Shared Control of a Robot Arm Using BCI and Computer Vision,†Journal Européen des Systèmes Automatisés, vol. 55, no. 1, pp. 139-146, 2022, https://doi.org/10.18280/jesa.550115.

[4] X. Kan, H. Teng and K. Karydis, "Online Exploration and Coverage Planning in Unknown Obstacle-Cluttered Environments," IEEE Robotics and Automation Letters, vol. 5, no. 4, pp. 5969-5976, 2020, https://doi.org/10.1109/LRA.2020.3010455.

[5] F. Niroui, K. Zhang, Z. Kashino and G. Nejat, "Deep Reinforcement Learning Robot for Search and Rescue Applications: Exploration in Unknown Cluttered Environments," IEEE Robotics and Automation Letters, vol. 4, no. 2, pp. 610-617, 2019, https://doi.org/10.1109/LRA.2019.2891991.

[6] M. Perez-Jimenez, M. A. Montes-Grova, P. Ramon-Soria, B. C. Arrue and A. Ollero, "POSITRON: lightweight active positioning compliant joints robotic arm in power lines inspection," 2020 International Conference on Unmanned Aircraft Systems (ICUAS), pp. 729-736, 2020, https://doi.org/10.1109/ICUAS48674.2020.9214022.

[7] A. B. Alhassan, X. Zhang, H. Shen, and H. Xu, “Power transmission line inspection robots: A review, trends and challenges for future research,†International Journal of Electrical Power & Energy Systems, vol. 118, p. 105862, 2020, https://doi.org/10.1016/j.ijepes.2020.105862.

[8] Z. Li, J. Deng, R. Lu, Y. Xu, J. Bai and C. -Y. Su, "Trajectory-Tracking Control of Mobile Robot Systems Incorporating Neural-Dynamic Optimized Model Predictive Approach," IEEE Transactions on Systems, Man, and Cybernetics: Systems, vol. 46, no. 6, pp. 740-749, 2016, https://doi.org/10.1109/TSMC.2015.2465352.

[9] D. Wang, W. Wei, Y. Yeboah, Y. Li, and Y. Gao, “A Robust Model Predictive Control Strategy for Trajectory Tracking of Omni-directional Mobile Robots,†Journal of Intelligent & Robotic Systems, vol. 98, no. 2, pp. 439-453, 2019, https://doi.org/10.1007/s10846-019-01083-1.

[10] M. N. Alghanim, M. Qasim, K. P. Valavanis, M. J. Rutherford and M. Stefanovic, "Comparison of Controller Performance for UGV-Landing Platform Self-Leveling," 2020 28th Mediterranean Conference on Control and Automation (MED), pp. 471-478, 2020, https://doi.org/10.1109/MED48518.2020.9182837.

[11] O. Y. Ismael, M. Almaged, and A. I. Abdulla, "Nonlinear Model Predictive Control-based Collision Avoidance for Mobile Robot," Journal of Robotics and Control (JRC), vol. 5, no. 1, pp. 142-151, 2024, https://doi.org/10.18196/jrc.v5i1.20615.

[12] M. N. Noaman, M. Qasim, and O. Y. Ismael, "Landmarks exploration algorithm for mobile robot indoor localization using VISION sensor," Journal of Engineering Science & Technology, vol. 16, no. 4, pp. 3165-3184, 2021, https://jestec.taylors.edu.my/Vol%2016%20Issue%204%20August%202021/16_4_29.pdf.

[13] M. N. Alghanim, M. Qasim, K. P. Valavanis, M. J. Rutherford and M. Stefanovic, "Passivity-Based Adaptive Controller for Dynamic Self-Leveling of a Custom-Built Landing Platform on Top of a UGV," 2020 28th Mediterranean Conference on Control and Automation (MED), pp. 458-464, 2020, https://doi.org/10.1109/MED48518.2020.9182807.

[14] B. Wang, Y. Zhang, and W. Zhang, “Integrated path planning and trajectory tracking control for quadrotor UAVs with obstacle avoidance in the presence of environmental and systematic uncertainties: Theory and experiment,†Aerospace Science and Technology, vol. 120, p. 107277, 2022, https://doi.org/10.1016/j.ast.2021.107277.

[15] O. Y. Ismael, M. Qasim, and M. N. Noaman, “Equilibrium Optimizer-Based Robust Sliding Mode Control of Magnetic Levitation System,†Journal Européen des Systèmes Automatisés, vol. 54, no. 1, pp. 131–138, 2021, https://doi.org/10.18280/jesa.540115.

[16] O. Y. Ismael, M. Qasim, M. N. Noaman, and A. Kurniawan, “Salp Swarm Algorithm-Based Nonlinear Robust Control of Magnetic Levitation System Using Feedback Linearization Approach,†Proceedings of the 3rd International Conference on Electronics, Communications and Control Engineering, pp. 58-64, 2020, https://doi.org/10.1145/3396730.3396734.

[17] S. Karaman and E. Frazzoli, “Sampling-based algorithms for optimal motion planning,†The International Journal of Robotics Research, vol. 30, no. 7, pp. 846–894, 2011, https://doi.org/10.1177/0278364911406761.

[18] A. Orthey and M. Toussaint, "Sparse Multilevel Roadmaps for High-Dimensional Robotic Motion Planning," 2021 IEEE International Conference on Robotics and Automation (ICRA), pp. 7851-7857, 2021, https://doi.org/10.1109/ICRA48506.2021.9562053.

[19] A. A. Ravankar, A. Ravankar, T. Emaru and Y. Kobayashi, "HPPRM: Hybrid Potential Based Probabilistic Roadmap Algorithm for Improved Dynamic Path Planning of Mobile Robots," IEEE Access, vol. 8, pp. 221743-221766, 2020, https://doi.org/10.1109/ACCESS.2020.3043333.

[20] O. Y. Ismael, M. N. Noaman, I. Kh. Abdullah, "Fick’s Law Algorithm Based-Nonlinear Model Predictive Control of Twin Rotor MIMO System," Journal of Robotics and Control (JRC), vol. 5, no. 3, pp. 694-705, 2024, https://doi.org/10.18196/jrc.v5i3.21725.

[21] C. E. Luis, M. Vukosavljev and A. P. Schoellig, "Online Trajectory Generation With Distributed Model Predictive Control for Multi-Robot Motion Planning," IEEE Robotics and Automation Letters, vol. 5, no. 2, pp. 604-611, 2020, https://doi.org/10.1109/LRA.2020.2964159.

[22] M. Schwenzer, M. Ay, T. Bergs, and D. Abel, “Review on model predictive control: an engineering perspective,†The International Journal of Advanced Manufacturing Technology, vol. 117, no. 5–6, pp. 1327–1349, 2021, https://doi.org/10.1007/s00170-021-07682-3.

[23] N. Guo, B. Lenzo, X. Zhang, Y. Zou, R. Zhai and T. Zhang, "A Real-Time Nonlinear Model Predictive Controller for Yaw Motion Optimization of Distributed Drive Electric Vehicles," IEEE Transactions on Vehicular Technology, vol. 69, no. 5, pp. 4935-4946, 2020, https://doi.org/10.1109/TVT.2020.2980169.

[24] R. Dempster, M. Al-Sharman, D. Rayside and W. Melek, "Real-Time Unified Trajectory Planning and Optimal Control for Urban Autonomous Driving Under Static and Dynamic Obstacle Constraints," 2023 IEEE International Conference on Robotics and Automation (ICRA), pp. 10139-10145, 2023, https://doi.org/10.1109/ICRA48891.2023.10160577.

[25] A. Salimi Lafmejani and S. Berman, “Nonlinear MPC for collision-free and deadlock-free navigation of multiple nonholonomic mobile robots,†Robotics and Autonomous Systems, vol. 141, p. 103774, 2021, https://doi.org/10.1016/j.robot.2021.103774.

[26] M. R. Azizi, A. Rastegarpanah, and R. Stolkin, “Motion Planning and Control of an Omnidirectional Mobile Robot in Dynamic Environments,†Robotics, vol. 10, no. 1, p. 48, 2021, https://doi.org/10.3390/robotics10010048.

[27] M. A. Daoud, M. W. Mehrez, D. Rayside and W. W. Melek, "Simultaneous Feasible Local Planning and Path-Following Control for Autonomous Driving," IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 9, pp. 16358-16370, 2022, https://doi.org/10.1109/TITS.2022.3149986.

[28] A. N. A. Rafai, N. Adzhar, and N. I. Jaini, “A Review on Path Planning and Obstacle Avoidance Algorithms for Autonomous Mobile Robots,†Journal of Robotics, vol. 2022, no. 1, pp. 1–14, 2022, https://doi.org/10.1155/2022/2538220.

[29] L. Liu, X. Wang, X. Yang, H. Liu, J. Li, and P. Wang, “Path planning techniques for mobile robots: Review and prospect,†Expert Systems with Applications, vol. 227, p. 120254, 2023, https://doi.org/10.1016/j.eswa.2023.120254.

[30] A. Britzelmeier and 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, https://doi.org/10.1109/LCSYS.2020.2996959.

[31] I. Sánchez, A. D’Jorge, G. V. Raffo, A. H. González, and A. Ferramosca, “Nonlinear Model Predictive Path Following Controller with Obstacle Avoidance,†Journal of Intelligent & Robotic Systems, vol. 102, no. 16, 2021, https://doi.org/10.1007/s10846-021-01373-7.

[32] M. A. Santos, A. Ferramosca, and G. V. Raffo, “Nonlinear Model Predictive Control Schemes for Obstacle Avoidance,†Journal of Control, Automation and Electrical Systems, vol. 34, no. 5, pp. 891-906, 2023, https://doi.org/10.1007/s40313-023-01024-2.

[33] Z. Jian et al., "Dynamic Control Barrier Function-based Model Predictive Control to Safety-Critical Obstacle-Avoidance of Mobile Robot," 2023 IEEE International Conference on Robotics and Automation (ICRA), pp. 3679-3685, 2023, https://doi.org/10.1109/ICRA48891.2023.10160857.

[34] R. Zheng and S. Li, "MCCA: A Decentralized Method for Collision and Deadlock Avoidance With Nonholonomic Robots," IEEE Robotics and Automation Letters, vol. 9, no. 3, pp. 2710-2717, 2024, https://doi.org/10.1109/LRA.2024.3358623.

[35] L.-L. Wang and L.-X. Pan, “Research on SBMPC Algorithm for Path Planning of Rescue and Detection Robot,†Discrete Dynamics in Nature and Society, vol. 2020, no. 1, pp. 1–11, 2020, https://doi.org/10.1155/2020/7821942.

[36] Z. Zuo et al., "MPC-Based Cooperative Control Strategy of Path Planning and Trajectory Tracking for Intelligent Vehicles," IEEE Transactions on Intelligent Vehicles, vol. 6, no. 3, pp. 513-522, 2021, https://doi.org/10.1109/TIV.2020.3045837.

[37] M. Ammour, R. Orjuela and M. Basset, "A MPC Combined Decision Making and Trajectory Planning for Autonomous Vehicle Collision Avoidance," IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 12, pp. 24805-24817, 2022, https://doi.org/10.1109/TITS.2022.3210276.

[38] D. Huo, L. Dai, R. Chai, R. Xue and Y. Xia, "Collision-Free Model Predictive Trajectory Tracking Control for UAVs in Obstacle Environment," IEEE Transactions on Aerospace and Electronic Systems, vol. 59, no. 3, pp. 2920-2932, 2023, https://doi.org/10.1109/TAES.2022.3221702.

[39] Q. Shi, J. Zhao, A. E. Kamel and I. Lopez-Juarez, "MPC Based Vehicular Trajectory Planning in Structured Environment," IEEE Access, vol. 9, pp. 21998-22013, 2021, https://doi.org/10.1109/ACCESS.2021.3052720.

[40] M. B. Alatise and G. P. Hancke, "A Review on Challenges of Autonomous Mobile Robot and Sensor Fusion Methods," IEEE Access, vol. 8, pp. 39830-39846, 2020, https://doi.org/10.1109/ACCESS.2020.2975643.

[41] J. Li, R. Li, J. Li, J. Wang, Q. Wu, and X. Liu, “Dual-view 3D object recognition and detection via Lidar point cloud and camera image,†Robotics and Autonomous Systems, vol. 150, p. 103999, 2022, https://doi.org/10.1016/j.robot.2021.103999.

[42] M. Ilyas, H. Y. Khaw, N. M. Selvaraj, Y. Jin, X. Zhao and C. C. Cheah, "Robot-Assisted Object Detection for Construction Automation: Data and Information-Driven Approach," IEEE/ASME Transactions on Mechatronics, vol. 26, no. 6, pp. 2845-2856, 2021, https://doi.org/10.1109/TMECH.2021.3100306.

[43] Y. Wu, Y. Wang, S. Zhang and H. Ogai, "Deep 3D Object Detection Networks Using LiDAR Data: A Review," IEEE Sensors Journal, vol. 21, no. 2, pp. 1152-1171, 2021, https://doi.org/10.1109/JSEN.2020.3020626.

[44] B. Brito, B. Floor, L. Ferranti and J. Alonso-Mora, "Model Predictive Contouring Control for Collision Avoidance in Unstructured Dynamic Environments," IEEE Robotics and Automation Letters, vol. 4, no. 4, pp. 4459-4466, 2019, https://doi.org/10.1109/LRA.2019.2929976.

[45] J. A. E. Andersson, J. Gillis, G. Horn, J. B. Rawlings, and M. Diehl, “CasADi: a software framework for nonlinear optimization and optimal control,†Mathematical Programming Computation, vol. 11, no. 1, pp. 1–36, 2018, https://doi.org/10.1007/s12532-018-0139-4.

[46] A. Wächter and L. T. Biegler, “Line Search Filter Methods for Nonlinear Programming: Motivation and Global Convergence,†SIAM Journal on Optimization, vol. 16, no. 1, pp. 1-31, 2005, https://doi.org/10.1137/S1052623403426556.

[47] J. C. L. Barreto S., A. G. S. Conceição, C. E. T. Dórea, L. Martinez and E. R. de Pieri, "Design and Implementation of Model-Predictive Control With Friction Compensation on an Omnidirectional Mobile Robot," IEEE/ASME Transactions on Mechatronics, vol. 19, no. 2, pp. 467-476, 2014, https://doi.org/10.1109/TMECH.2013.2243161.

[48] R. Siegwart, I. R. Nourbakhsh, and D. Scaramuzza, “Introduction to autonomous mobile robots,†MIT press, 2011, https://mitpress.mit.edu/9780262015356/introduction-to-autonomous-mobile-robots/.

[49] L. Grüne and J. Pannek, “Nonlinear Model Predictive Control,†Communications and Control Engineering, 2017, https://doi.org/10.1007/978-3-319-46024-6.

[50] E. F. Camacho and C. Bordons, “Model Predictive control,†Springer London, 2007, https://doi.org/10.1007/978-0-85729-398-5.

[51] J. B. Rawlings and K. R. Muske, "The stability of constrained receding horizon control," IEEE Transactions on Automatic Control, vol. 38, no. 10, pp. 1512-1516, 1993, https://doi.org/10.1109/9.241565.

[52] L. Grüne and J. Pannek, “Nonlinear Model Predictive Control,†Springer London, 2011, https://doi.org/10.1007/978-0-85729-501-9.


Refbacks

  • There are currently no refbacks.


Copyright (c) 2024 Mohammed Salim Qasim, Abdulla Ibrahim Abdulla, Abdurahman Basil Ayoub

Creative Commons License
This work is licensed under a Creative Commons Attribution-ShareAlike 4.0 International License.

 

About the JournalJournal PoliciesAuthor Information

International Journal of Robotics and Control Systems
e-ISSN: 2775-2658
Website: https://pubs2.ascee.org/index.php/IJRCS
Email: ijrcs@ascee.org
Organized by: Association for Scientific Computing Electronics and Engineering (ASCEE), Peneliti Teknologi Teknik Indonesia, Department of Electrical Engineering, Universitas Ahmad Dahlan and Kuliah Teknik Elektro
Published by: Association for Scientific Computing Electronics and Engineering (ASCEE)
Office: Jalan Janti, Karangjambe 130B, Banguntapan, Bantul, Daerah Istimewa Yogyakarta, Indonesia