Hostname: page-component-cd9895bd7-dk4vv Total loading time: 0 Render date: 2024-12-23T06:51:54.931Z Has data issue: false hasContentIssue false
  • English
  • Français

Intent-Aware Optimal Collision Avoidance and Trajectory Planning for a Pursuit Vehicle

Published online by Cambridge University Press:  09 February 2022

Karnika Biswas Open the ORCID record for Karnika Biswas [Opens in a new window] ,
Indrani Kar  and
Eric Feron
Karnika Biswas
Affiliation:
Department of EEE, IIT Guwahati, Assam, India
Indrani Kar*
Affiliation:
Department of EEE, IIT Guwahati, Assam, India
Eric Feron
Affiliation:
CEMSE, King Abdullah University of Science and Technology, Thuwal, Saudi Arabia
*
*Corresponding author. E-mail:[email protected]
Get access Rights & Permissions [Opens in a new window]

Summary

This paper presents an integrated optimal control framework for velocity and steering control of an autonomous pursuit vehicle, where the control objectives satisfy the requirements of collision avoidance and moving target tracking. A distinctive feature of the proposed velocity and steering control is the application of logarithmic penalty functions to both. The control barrier imposed by logarithmic function provides a unique tool in computing a balanced trajectory with optimal tracking error, control effort and safety margin. Trajectories compliant with the safety regulations for autonomous driving have been planned based on estimated intention of the target and the obstacles. Effects of the controller weights have been extensively simulated to assess the performance of the proposed strategy in a variety of dynamic situations. The controller has been validated on a real-life robot by using a shrinking horizon control policy for iterative optimisation.

Keywords

optimal controlmoving targetdynamic collision avoidanceinequality constraintsvelocity barriershrinking horizonpenalty function
Type
Research Article
Information
Robotica , Volume 40 , Issue 8 , August 2022 , pp. 2505 - 2526
Copyright
© The Author(s), 2022. Published by Cambridge University Press

Access options

Get access to the full version of this content by using one of the access options below. (Log in options will check for institutional or personal access. Content may require purchase if you do not have access.)

References

Campbell, J. L., Brown, J. L., Graving, J. S., Richard, C. M., Lichty, M. G., Bacon, L. P., Morgan, J. F., Li, H., Williams, W. N. and Sanquist, T., Human Factors Design Guidance for Level 2 and Level 3 Automated Driving Concepts, (Report No. DOT HS 812 555) (National Highway Traffic Safety Administration, Washington, DC, August 2018).Google Scholar
Becker, C., Yount, L., Rosen-Levy, S. and Brewer, J., Functional Safety Assessment of an Automated Lane Centering System, (Report No. DOT HS 812 573), (National Highway Traffic Safety Administration, Washington, DC, August 2018).Google Scholar
Swanson, E., Yanagisawa, M., Najm, W. G., Foderaro, F. and Azeredo, P., Crash Avoidance Needs and Countermeasure Profiles for Safety Applications based on Light-vehicle-to-pedestrian Communications, (Report No. DOT HS 812 312) (National Highway Traffic Safety Administration, Washington, DC, August 2016).Google Scholar
Bajcsy, A., Bansal, S., Ratner, E., Tomlin, C. J. and Dragan, A. D., “A robust control framework for human motion prediction,” IEEE Robot. Autom. Lett. 6(1), 24–31 (2021).CrossRefGoogle Scholar
Cho, Y., Han, J. and Kim, J., “Intent inference of ship maneuvering for automatic ship collision avoidance,” IFAC-PapersOnline 51(29), 384–388 (2018).CrossRefGoogle Scholar
Wang, Y., Ren, Y., Elliott, S. and Zhang, W., “Enabling courteous vehicle interactions through game-based and dynamics-aware intent inference,” IEEE Trans. Intell. Vehicles 5(2), 217–228 (2020).Google Scholar
Patterson, A., Lakshmanan, A. and Hovakimyan, N., “Intent-aware Probabilistic Trajectory Estimation for Collision Prediction with Uncertainty Qualification,” Proceedings of IEEE International Conference on Decision and Control (2019) pp. 3827–3832.Google Scholar
Minguez, R. Q., Alonso, I. P., FernÁndez-Llorca, D. and Sotelo, M. Á., “Pedestrian path, pose and intention prediction through Gaussian process dynamical models and pedestrian activity recognition,” IEEE Trans. Intell. Transport. Syst. 20(5), 1803–1814 (2019).Google Scholar
Capparella, F., Freda, L., Malagnino, M. and Oriolo, G., “Visual Servoing of a Wheeled Mobile Robot for Intercepting a Moving Object,” Proceedings of IROS’05, IEEE International Conference on Intelligent Robots and Systems (2005) pp. 2737–2743.Google Scholar
Li, J., Xing, Z., Zhang, W., Lin, Y., and Shu, F., “Vehicle tracking in wireless sensor networks via deep reinforcement learning” IEEE Sens. Lett. 4(3), 1–4 (2020).CrossRefGoogle Scholar
Qu, H., Yang, S. X., Willms, A. R. and Yi, Zr., “Real-time robot path planning based on a modified pulse-coupled neural network model,” IEEE Trans. Neural Netw. 20(11), 1724–1739 (2009).Google Scholar
Hwang, C. L., Wang, T. H. and Wong, C. C., “A Dynamic Target Tracking of Car-like Wheeled Robot in a Sensor-network Environment via Fuzzy Decentralized Sliding-mode Grey Prediction Control” Proceedings of ICRA’07, IEEE International Conference on Robotics and Automation (2007) pp. 3463–3469.Google Scholar
Wai, R. J. and Lin, Y. W., “Adaptive moving-target tracking control of a vision-based mobile robot via a dynamic petri recurrent fuzzy neural network,” IEEE Trans. Syst, Fuzzy. 21(4), 688–701 (2013).CrossRefGoogle Scholar
Ren, H., Chen, S., Yang, L. and Zhao, Y., “Optimal path planning and speed control integration strategy for UGVs in static and dynamic environments,” IEEE Trans. Vehicular Technol. 69(10), 10619–10629 (2020).CrossRefGoogle Scholar
Hajiloo, R., Abroshan, M. and Khajepour, A., Kasaiezadeh, A. and Chen, S., “Integrated steering and differential braking for emergency collision avoidance in autonomous vehicles,” IEEE Trans. Intell. Transport. Syst. Early Access.Google Scholar
Berntorp, K., Bai, R., Erliksson, K.F., Danielson, C., Weiss, A. and Cairano, S. D., “Positive invariant sets for safe integrated vehicle motion planning and control,” IEEE Trans. Intell. Veh. 5(1), 112–126 (2020).CrossRefGoogle Scholar
Tuncer, B. and Özkan, E., “Random matrix based extended target tracking with orientation : A new model and inference,” IEEE Trans. Signal Process. 69, 1910–1923 (2021).Google Scholar
Shan, Y., Zheng, B., Chen, L., Chen, L. and Chen, D., “A reinforcement learning-based adaptive path tracking approach for autonomous driving,” IEEE Trans. Vehicular Technol. 69(10), 10581–10595 (2020).CrossRefGoogle Scholar
Liu, X., Xin, X., Li, Z. and Chen, Z., “Near optimal control based on the tensor-product technique,” IEEE Trans. Circ. Syst. II Exp. Briefs 64(5), 560–564 (2017).Google Scholar
Zhang, H., De Saporta, B., Dufour, F., Laneuville, D. and NÈgre, A., “Stochastic control of observer trajectories in passive tracking with acoustic signal propagation optimisation,” IET Radar, Sonar Navigat. 12(1), 112–120 (2018).Google Scholar
Mavrommati, A., Tzorakoleftherakis, E,., Abraham, I. and Murphey, T. D., “Real-time area coverage and target localization using receding-horizon Ergodic exploration,” IEEE Trans. Robot. 34(1), 62–80 (2019).CrossRefGoogle Scholar
Ferri, G., MunafÒ, A. and LePage, K. D., “An autonomous underwater vehicle data-driven control strategy for target tracking,” IEEE J. Oceanic. Eng. 43(2), 323–343 (2018).CrossRefGoogle Scholar
Zhang, X., Jiang, W., Yu, S., Xu, X. and Li, Z., “A dual-level model predictive control scheme for multi-timescale dynamical systems – Extended version,” arXiv: 1906.07334v6 (eess) (2021).Google Scholar
Farahani, S. S., Majumdar, R., Prabhu, V. S. and Soudjani, S., “Shrinking Horizon model predictive control with signal temporal logic constraints under stochastic disturbances,” IEEE Trans. Autom. Control 64(8), 3324–3331 (2019).Google Scholar
Zhang, H., Sun, X. and Chen, M., “Azimuth Tracking for Underwater Moving Target Based on MUSIC and Function Approximation,” Proceedings of IEEE International Conference on Mechatronics and Automation (2018) pp. 449–454.Google Scholar
Gurriet, T., Mote, M., Singletary, A., Nilsson, P., Feron, E. and Ames, A. D., “A scalable safety-critical control framework for nonlinear systems,” IEEE Access 8, 187249–187275 (2020).CrossRefGoogle Scholar
Li, B., Ouyang, Y., Zhang, Y., Acarman, T., Kong, Q. and Shao, Z., “Optimal cooperative Maneuver planning for multiple nonholonomic robots in a tiny environment via adaptive-scaling constrained optimization,” IEEE Robot. Autom. Lett., Preprint (2021).Google Scholar
Pinch, E. R., Optimal Control and the Calculus of Variations (Oxford University Press, Oxford, New York, 1993).Google Scholar
Betts, J. T., “Survey of numerical methods for trajectory optimization,” J. Guid. Cont. Dynam. 21(2), 193–207 (1998).Google Scholar
Jorge, N. and Wright, S. J., Numerical Optimization, Operations Research and Financial Engineering (Springer-Verlag, New York, 2006).Google Scholar
Kierzenka, J. and Shampine, L. F., “A BVP solver based on residual control and the Maltab PSE,” ACM Trans. Math. Softw. 27(3), 299–316 (2001).Google Scholar
Nageli, T., Alonso-Mora, J., Domahidi, A., Rus, D. and Hilliges, O., “Real-time motion planning for aerial videography with dynamic obstacle avoidance and viewpoint optimization,” IEEE Robot. Automat. Lett. 2(3), 1696–1703 (2017).CrossRefGoogle Scholar
Press, W. H., Teukolsky, S. A., Vetterling, W. T. and Flannery, B. P., Numerical Recipes in C : The Art of Scientific Computing (Cambridge University Press, 2002).Google Scholar
Waltman, P., “Existence and uniqueness of solutions of boundary value problems for two dimensional systems of nonlinear differential equations,” Trans. Am. Math. Soc. 153, 223–234 (1971).CrossRefGoogle Scholar
Bailey, P. B., Shampine, L. F. and Waltman, P. E., “Nonlinear two point boundary value problems,” In: Computational Mathematics : Theory and Mathematics (General), Lecture Notes in Mathematics in Science and Engineering (Academic Press, Philadelphia, USA, 1968).Google Scholar
Freund, R. M., Penalty and Barrier Methods for Constrained Optimization, 15.084J Nonlinear Programming, Massachusetts Institute of Technology: MIT OpenCourseWare (2004).Google Scholar
Verscheure, D., Diehl, M., De Schutter, J. and Swevers, J., “Recursive Log-barrier Method for On-line Time-optimal Robot Path Tracking,” Proceedings of ACC’09: American Control Conference (2009) pp. 4134–4140.Google Scholar
Mobilerobotics, https://www.generationrobots.com/media/Patrolbot-PTLB-RevA.pdf Google Scholar
Unity3d, https://unity3d.com//how-to/create-AR-games-in-Unity-efficiently.Google Scholar
Cho, D. K., Chun, S. H., Ahn, J. G., Kwon, Y. S., Eom, J. H. and Kim, Y., “A UDP-based protocol for mobile robot control over wireless internet,” Proceedings of ROBOCOMM’09: IEEE International Conference Robot Communication and Coordination (2009) pp. 1–4.Google Scholar
Huang, L., “Velocity planning for a mobile robot to track a moving target – A potential field approach,” J. Robot. Autonom. Syst. 57(2), 55–63 (2009).Google Scholar
Belkhouche, F. and Belkhouche, B., “A method for robot navigation toward a moving goal with unknown maneuvers,” Robotica 23(6), 709–720 (2005).CrossRefGoogle Scholar
Kunwar, F. and Benhabib, B., “Rendezvous-guidance trajectory planning for robotic dynamic obstacle avoidance and interception,” IEEE Trans. Syst. Man Cybernet. B Cybernet. 36(6), 1432–1441 (2006).CrossRefGoogle ScholarPubMed
Liu, L., Yao, J., He, D., Chen, J., Huang, J., Xu, H., Wang, B. and Guo, J., “Global dynamic path planning fusion algorithm combining jump-A* algorithm and dynamic window approach,” IEEE Access 9, 19632–19638 (2021).CrossRefGoogle Scholar
Lee, D. H., Lee, S. S., Ahn, C. K., Shi, P. and Lim, C. C., “Finite distribution estimation-based dynamic window approach to reliable obstacle avoidance of mobile robot,” IEEE Trans. Indus. Electron. 68(10), 9998–10006 (2020).Google Scholar
Matveev, A. S., Wang, C. and Savkin, A.V., “Real-time navigation of mobile robots in problems of border patrolling and avoiding collisions with moving and deforming obstacles,” Robot. Autonom. Syst. 60(6), 769–788 (2012).Google Scholar
Kuwata, Y., Wolf, M. T., Zarzhitsky, D. and Huntsberger, T. L., “Safe maritime autonomous navigation with COLREGS, using velocity obstacles,” IEEE J. Ocean. Eng. 39(1), 110–119 (2014).CrossRefGoogle Scholar
Supplementary material: PDF

Biswas et al. supplementary material

Biswas et al. supplementary material 1

Download Biswas et al. supplementary material(PDF)
PDF 97 KB
Supplementary material: File

Biswas et al. supplementary material

Biswas et al. supplementary material 2

Download Biswas et al. supplementary material(File)
File 62.9 KB
Supplementary material: File

Biswas et al. supplementary material

Biswas et al. supplementary material 3

Download Biswas et al. supplementary material(File)
File 14.2 KB