تعقیب ربات رهبر و اجتناب از موانع متعدد توسط خودرو خودران با گشتاورهای محرک چرخ و فرمان و با استفاده از طراحی مسیر و کنترل ‌‌پیش‌‌بین مدل

نوع مقاله : مقاله پژوهشی

نویسندگان

1 دانشکده مهندسی مکانیک، دانشگاه گیلان، رشت، ایران

2 گروه مهندسی مکانیک، واحد ایذه، دانشگاه آزاد اسلامی، ایذه، ایران

چکیده

این مقاله به بررسی تعقیب ربات رهبر توسط خودرو خودران و مسأله اجتناب از برخورد با موانع می‌پردازد. در این مقاله همانند یک خودرو واقعی، ابعاد هندسی، جرم و ممان اینرسی برای خودرو در نظر گرفته شده است. گشتاور فرمان و گشتاور چرخ محرک، دو ورودی کنترلی هستند. معادلات دینامیک غیرخطی وسیله نقلیه استخراج شده است. ابتدا الگوریتمی برای تغییر جهت وسیله نقلیه برای تعقیب رهبر پیشنهاد می‌شود که به منظور قرارگیری جهت خودرو در جهت مناسب برای تعقیب ربات رهبر طراحی شده است. پس از آن مسیر مناسب برای اجتناب از برخورد با موانع ساکن متعدد و تعقیب رهبر ارائه می‌گردد و سپس از یک کنترل‌کننده پیش‌بین مدل غیرخطی برای دنبال کردن مسیر مرجع استفاده می‌شود. الگوریتم طراحی مسیر براساس تئوری باند الاستیک بوده که عملکرد بسیار خوبی برای عدم برخورد با موانع متعدد و تعقیب ربات رهبر دارد. عملکرد سیستم حلقه بسته از طریق شبیه‌سازی نشان داده شده است. اگرچه خودرو دارای اینرسی است و قیود غیرهولونومیک دارد، شبیه‌سازی‌ها نشان می‌دهند که دو روش طراحی مسیر با طرح کنترل‌کننده پیش‌بین مدل به خوبی کار می‌کند.

کلیدواژه‌ها

موضوعات


عنوان مقاله [English]

Leader Following and Multiple Obstacle Avoidance of Autonomous Vehicle with Steering-Wheel and Driving-Wheel Torques Using Path Planning and Model Predictive Control

نویسندگان [English]

  • Hamed Kouhi Gilvan 1
  • Esmaeil Salahshoor 2
1 Assistant Professor, Faculty of Mechanical Engineering, University of Guilan
2 Department of Mechanical Engineering, Islamic Azad University of Izeh, Izeh, Iran
چکیده [English]

This paper studies the autonomous vehicle leader following and collision avoidance problem. In this paper, like as a real vehicle, geometric dimensions, mass, and moment of inertia are considered for the vehicle; steering-wheel and driving-wheel torques are the two control inputs. The nonlinear dynamics equation of the vehicle is derived. At first, an algorithm is proposed for changing the direction of the vehicle to follow the leader, then the suitable path for multiple obstacle avoidance and leader following is proposed, and then a nonlinear model predictive controller (MPC) is used to follow the reference trajectory. The desired trajectory is designed according to the elastic band method which is a powerful method for obstacle avoidance and leader following. The performances of the closed-loop system are illustrated through simulations. During the simulation, the vehicle first changes its direction and then follows the leader without colliding with obstacles. Although the vehicle is inertial and non-holonomic in behavior, the simulations show that the two path planning methods with MPC scheme work well. For future works, the authors aim to solve the problem with moving obstacles.

کلیدواژه‌ها [English]

  • Autonomous Vehicle
  • Multiple Obstacle Avoidance
  • Nonholonomic Constraint
  • Trajectory Planning
  • Nonlinear Model Predictive Control
[1] H. Sayyaadi, H. Kouhi, H. Salarieh, Control of car-like (wheeled) multi robots for following and hunting a moving target, Scientia Iranica, 18(4) (2011) 950-965.
[2] J.-P. Laumond, P.E. Jacobs, M. Taix, R.M. Murray, A motion planner for nonholonomic mobile robots, IEEE Transactions on robotics and automation, 10(5) (1994) 577-593.
[3] A. Bemporad, A. De Luca, G. Oriolo, Local incremental planning for a car-like robot navigating among obstacles, in:  Proceedings of IEEE International Conference on Robotics and Automation, IEEE, 1996, pp. 1205-1211.
[4] T. Shim, G. Adireddy, H. Yuan, Autonomous vehicle collision avoidance system using path planning and model-predictive-control-based active front steering and wheel torque control, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of automobile engineering, 226(6) (2012) 767-778.
[5] J. Wurts, J.L. Stein, T. Ersal, Collision imminent steering at high speed using nonlinear model predictive control, IEEE Transactions on Vehicular Technology, 69(8) (2020) 8278-8289.
[6] K. Kanjanawaniskul, Motion control of a wheeled mobile robot using model predictive control: A survey, Asia-Pacific Journal of Science and Technology, 17(5) (2012) 811-837.
[7] H. Chen, H.a. Yang, X. Wang, T. Zhang, Formation control for car-like mobile robots using front-wheel driving and steering, International Journal of Advanced Robotic Systems, 15(3) (2018) 1729881418778228.
[8] C. Choi, Y. Kang, Simultaneous braking and steering control method based on nonlinear model predictive control for emergency driving support, International Journal of Control, Automation and Systems, 15(1) (2017) 345-353.
[9] C. Hu, L. Zhao, L. Cao, P. Tjan, N. Wang, Steering control based on model predictive control for obstacle avoidance of unmanned ground vehicle, Measurement and Control, 53(3-4) (2020) 501-518.
[10] F. Borrelli, P. Falcone, T. Keviczky, J. Asgari, D. Hrovat, MPC-based approach to active steering for autonomous vehicle systems, International journal of vehicle autonomous systems, 3(2-4) (2005) 265-291.
[11] V. Turri, A. Carvalho, H.E. Tseng, K.H. Johansson, F. Borrelli, Linear model predictive control for lane keeping and obstacle avoidance on low curvature roads, in:  16th international IEEE conference on intelligent transportation systems (ITSC 2013), IEEE, 2013, pp. 378-383.
[12] F. Yakub, Y. Mori, Comparative study of autonomous path-following vehicle control via model predictive control and linear quadratic control, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of automobile engineering, 229(12) (2015) 1695-1714.
[13] H. Yoshida, S. Shinohara, M. Nagai, Lane change steering manoeuvre using model predictive control theory, Vehicle System Dynamics, 46(S1) (2008) 669-681.
[14] V. Sezer, M. Gokasan, A novel obstacle avoidance algorithm:“Follow the Gap Method”, Robotics and Autonomous Systems, 60(9) (2012) 1123-1134.
[15] A. Swief, A. El-Zawawi, M. El-Habrouk, A Survey of Model Predictive Control Development in Automotive Industries, in:  2019 International Conference on Applied Automation and Industrial Diagnostics (ICAAID), IEEE, 2019, pp. 1-7.
[16] H. Guo, J. Liu, D. Cao, H. Chen, R. Yu, C. Lv, Dual-envelop-oriented moving horizon path tracking control for fully automated vehicles, Mechatronics, 50 (2018) 422-433.
[17] D. Yang, S. Zheng, C. Wen, P.J. Jin, B. Ran, A dynamic lane-changing trajectory planning model for automated vehicles, Transportation Research Part C: Emerging Technologies, 95 (2018) 228-247.
[18] S. Dixit, S. Fallah, U. Montanaro, M. Dianati, A. Stevens, F. Mccullough, A. Mouzakitis, Trajectory planning and tracking for autonomous overtaking: State-of-the-art and future prospects, Annual Reviews in Control, 45 (2018) 76-86.
[19] V.T. Minh, Nonlinear Model Predictive Controller and Feasible Path Planning for Autonomous Robots, Open Computer Science, 6(1) (2016) 178-186.
[20] J. Pumwa, Time Variant Predictive Control of Autonomous Vehicles: Time Variant Predictive Control of Autonomous Vehicles, International Journal of Innovative Technology and Interdisciplinary Sciences, 2(1) (2019) 62-77.
[21] V.T. Minh, R. Moezzi, K. Dhoska, J. Pumwa, Model Predictive Control for Autonomous Vehicle Tracking, International Journal of Innovative Technology and Interdisciplinary Sciences, 4(1) (2021) 560-603.
[22] H. Yuan, X. Sun, T. Gordon, Unified decision-making and control for highway collision avoidance using active front steer and individual wheel torque control, Vehicle system dynamics, 57(8) (2019) 1188-1205.
[23] Y. Gao, T. Gordon, M. Lidberg, Optimal control of brakes and steering for autonomous collision avoidance using modified Hamiltonian algorithm, Vehicle system dynamics, 57(8)  (2019), 1224–1240.
[24] C. Li, J. Wang, X. Wang, Y. Zhang, A model based path planning algorithm for self-driving cars in dynamic environment, in:  2015 chinese automation congress (CAC), IEEE, 2015, pp. 1123-1128.
[25] J. Ji, A. Khajepour, W.W. Melek, Y. Huang, Path planning and tracking for vehicle collision avoidance based on model predictive control with multiconstraints, IEEE Transactions on Vehicular Technology, 66(2) (2016) 952-964.
[26] U. Rosolia, S. De Bruyne, A.G. Alleyne, Autonomous vehicle control: A nonconvex approach for obstacle avoidance, IEEE Transactions on Control Systems Technology, 25(2) (2016) 469-484.
[27] X. Du, K.K.K. Htet, K.K. Tan, Development of a genetic-algorithm-based nonlinear model predictive control scheme on velocity and steering of autonomous vehicles, IEEE Transactions on Industrial Electronics, 63(11) (2016) 6970-6977.
[28] M.A. Abbas, R. Milman, J.M. Eklund, Obstacle avoidance in real time with nonlinear model predictive control of autonomous vehicles, Canadian journal of electrical and computer engineering, 40(1) (2017) 12-22.
[29] S. Cheng, L. Li, H.-Q. Guo, Z.-G. Chen, P. Song, Longitudinal collision avoidance and lateral stability adaptive control system based on MPC of autonomous vehicles, IEEE Transactions on Intelligent Transportation Systems, 21(6) (2019) 2376-2385.
[30] A.S.P. Singh, O. Nishihara, Minimum resultant vehicle force optimal state feedback control for obstacle avoidance, IEEE Transactions on Control Systems Technology, 28(5) (2019) 1846-1861.
[31] Q. Wu, W.-D. Liu, S.-Y. Guo, S. Cheng, S.-J. Li, H.-W. Liang, Z.-J. Liu, Research on Lane-Change Strategy With Real-Time Obstacle Avoidance Function, IEEE Access, 8 (2020) 211255-211268.
[32] M. Li, X. Song, H. Cao, Z. Huang, Shared steering control combined with driving intention for vehicle obstacle avoidance, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of automobile engineering, 233(11) (2019) 2791-2808.
[33] J. Park, D. Kim, Y. Yoon, H. Kim, K. Yi, Obstacle avoidance of autonomous vehicles based on model predictive control, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, 223(12) (2009) 1499-1516.
[34] G. Yin, J. Li, X. Jin, C. Bian, N. Chen, Integration of motion planning and model-predictive-control-based control system for autonomous electric vehicles, Transport, 30(3) (2015) 353-360.
[35] J. Kim, K. Jo, K. Chu, M. Sunwoo, Road-model-based and graph-structure-based hierarchical path-planning approach for autonomous vehicles, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, 228(8) (2014) 909-928.
[36] H. Cao, X. Song, Z. Huang, L. Pan, Simulation research on emergency path planning of an active collision avoidance system combined with longitudinal control for an autonomous vehicle, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of automobile engineering, 230(12) (2016) 1624-1653.
[37] L. Xu, W. Zhuang, G. Yin, G. Li, C. Bian, Robust overtaking control of autonomous electric vehicle with parameter uncertainties, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of automobile engineering, 233(13) (2019) 3358-3376.
[38] Y. Gao, T. Lin, F. Borrelli, E. Tseng, D. Hrovat, Predictive control of autonomous ground vehicles with obstacle avoidance on slippery roads, in:  Dynamic systems and control conference, 2010, pp. 265-272.
[39] X. He, Y. Liu, C. Lv, X. Ji, Y. Liu, Emergency steering control of autonomous vehicle for collision avoidance and stabilisation, Vehicle system dynamics, 57(8) (2019) 1163-1187.
[40] L. Chen, D. Qin, X. Xu, Y. Cai, J. Xie, A path and velocity planning method for lane changing collision avoidance of intelligent vehicle based on cubic 3-D Bezier curve, Advances in Engineering Software, 132 (2019) 65-73.
[41] W. Xue, L. Zheng, Active Collision Avoidance System Design Based on Model Predictive Control with Varying Sampling Time, Automotive Innovation, 3(1) (2020) 62-72.
[42] C. Wnag, W. Zhao, Z. Xu, G. Zhou, Path planning and stability control of collision avoidance system based on active front steering, Science China Technological Sciences, 60(8) (2017) 1231-1243.
[43] G. Xia, X. Xia, X. Sun, Formation control with collision avoidance for underactuated surface vehicles, Asian Journal of Control, 24(5) (2022) 2244-2257.
[44] D. Xue, D. Wu, A.S. Yamashita, Z. Li, Proximal policy optimization with reciprocal velocity obstacle based collision avoidance path planning for multi-unmanned surface vehicles, Ocean Engineering, 273 (2023) 114005.
[45] X. Li, Z. Xu, S. Li, Z. Su, X. Zhou, Simultaneous obstacle avoidance and target tracking of multiple wheeled mobile robots with certified safety, IEEE transactions on cybernetics, 52(11) (2021) 11859-11873.
[46] Z. Zhang, L. Zheng, Y. Li, P. Zeng, Y. Liang, Structured road-oriented motion planning and tracking framework for active collision avoidance of autonomous vehicles, Science China Technological Sciences, 64(11) (2021) 2427-2440.
[47] H. Wang, B. Liu, Path planning and path tracking for collision avoidance of autonomous ground vehicles, IEEE Systems Journal, 16(3) (2021) 3658-3667.
[48] X. Zhang, W. Zhang, Y. Zhao, H. Wang, F. Lin, Y. Cai, Personalized motion planning and tracking control for autonomous vehicles obstacle avoidance, IEEE Transactions on Vehicular Technology, 71(5) (2022) 4733-4747.
[49] Z. Li, J. Li, Y. Li, An Integrated Path Planning Framework for Multi-Obstacle Avoidance of the Multi-Axle Autonomous Vehicle with Enhanced Safety and Stability, IEEE Transactions on Vehicular Technology, (2023).
[50] H. Kouhi, A. Moradi, Multiple-Vehicle Cooperative Autonomous Parking Trajectory Planning Using Connected Fifth Degree Polynomials and Genetic Algorithm Optimization, IEEE Transactions on Intelligent Vehicles, (2024).
[51] D. Feng, B.H. Krogh, Satisficing feedback strategies for local navigation of autonomous mobile robots, IEEE transactions on systems, man, and cybernetics, 20(6) (1990) 1383-1395.