An Efficient Risk-aware Branch MPC for Automated Driving that is Robust to Uncertain Vehicle Behaviors (2403.18695v1)
Abstract: One of the critical challenges in automated driving is ensuring safety of automated vehicles despite the unknown behavior of the other vehicles. Although motion prediction modules are able to generate a probability distribution associated with various behavior modes, their probabilistic estimates are often inaccurate, thus leading to a possibly unsafe trajectory. To overcome this challenge, we propose a risk-aware motion planning framework that appropriately accounts for the ambiguity in the estimated probability distribution. We formulate the risk-aware motion planning problem as a min-max optimization problem and develop an efficient iterative method by incorporating a regularization term in the probability update step. Via extensive numerical studies, we validate the convergence of our method and demonstrate its advantages compared to the state-of-the-art approaches.
- “Baidu Apollo EM Motion Planner” arXiv: 1807.08048 In arXiv:1807.08048 [cs], 2018 URL: http://arxiv.org/abs/1807.08048
- “Interactive Multi-Modal Motion Planning With Branch Model Predictive Control” In IEEE Robotics and Automation Letters 7.2, 2022, pp. 5365–5372 DOI: 10.1109/LRA.2022.3156648
- “Contingency Planning Over Probabilistic Obstacle Predictions for Autonomous Road Vehicles” In IEEE Transactions on Robotics 29.4, 2013, pp. 913–929 DOI: 10.1109/TRO.2013.2254033
- John P. Alsterda, Matthew Brown and J.Christian Gerdes “Contingency Model Predictive Control for Automated Vehicles” In 2019 American Control Conference (ACC), 2019, pp. 717–722 DOI: 10.23919/ACC.2019.8815260
- Haimin Hu and Jaime F. Fisac “Active Uncertainty Reduction for Human-Robot Interaction: An Implicit Dual Control Approach” In Algorithmic Foundations of Robotics XV, Springer Proceedings in Advanced Robotics Springer International Publishing, 2023, pp. 385–401
- Renzi Wang, Mathijs Schuurmans and Panagiotis Patrinos “Interaction-aware Model Predictive Control for Autonomous Driving” In 2023 European Control Conference (ECC), 2023, pp. 1–6 DOI: 10.23919/ECC57647.2023.10178332
- “A Robust Scenario MPC Approach for Uncertain Multi-Modal Obstacles” In IEEE Control Systems Letters 5.3, 2021, pp. 947–952 DOI: 10.1109/LCSYS.2020.3006819
- Junru Gu, Chen Sun and Hang Zhao “DenseTNT: End-to-end Trajectory Prediction from Dense Goal Sets” In 2021 IEEE/CVF International Conference on Computer Vision (ICCV) Montreal, QC, Canada: IEEE, 2021, pp. 15283–15292 DOI: 10.1109/ICCV48922.2021.01502
- “Interactive Joint Planning for Autonomous Vehicles” In IEEE Robotics and Automation Letters 9.2, 2024, pp. 987–994 DOI: 10.1109/LRA.2023.3332474
- “Risk-averse model predictive control” In Automatica 100, 2019, pp. 281–288 DOI: https://doi.org/10.1016/j.automatica.2018.11.022
- “MARC: Multipolicy and Risk-Aware Contingency Planning for Autonomous Driving” In IEEE Robotics and Automation Letters 8.10, 2023, pp. 6587–6594 DOI: 10.1109/LRA.2023.3310431
- Alexander Shapiro, Darinka Dentcheva and Andrzej Ruszczynski “Lectures on Stochastic Programming: Modeling and Theory, Third Edition” Philadelphia, PA: Society for IndustrialApplied Mathematics, 2021 DOI: 10.1137/1.9781611976595
- “Solving a Class of Non-Convex Min-Max Games Using Iterative First Order Methods” arXiv:1902.08297 [cs, math, stat] arXiv, 2019 URL: http://arxiv.org/abs/1902.08297
- “Nonconvex Min-Max Optimization: Applications, Challenges, and Recent Theoretical Advances” In IEEE Signal Processing Magazine 37.5, 2020, pp. 55–66 DOI: 10.1109/MSP.2020.3003851
- “Hybrid Block Successive Approximation for One-Sided Non-Convex Min-Max Problems: Algorithms and Applications” In IEEE Transactions on Signal Processing 68, 2020, pp. 3676–3691 DOI: 10.1109/TSP.2020.2986363
- James Blake Rawlings, David Q. Mayne and Moritz Diehl “Model predictive control: theory, computation, and design” Madison, Wisconsin: Nob Hill Publishing, 2017
- “Iterative Linear Quadratic Regulator Design for Nonlinear Biological Movement Systems” In Proceedings of the First International Conference on Informatics in Control, Automation and Robotics, 2004, pp. 222–229 DOI: 10.5220/0001143902220229
- Yuval Tassa, Nicolas Mansard and Emo Todorov “Control-limited differential dynamic programming” In 2014 IEEE International Conference on Robotics and Automation (ICRA), 2014, pp. 1168–1175 DOI: 10.1109/ICRA.2014.6907001
- Jianyu Chen, Wei Zhan and Masayoshi Tomizuka “Autonomous Driving Motion Planning With Constrained Iterative LQR” In IEEE Transactions on Intelligent Vehicles 4.2, 2019, pp. 244–254 DOI: 10.1109/TIV.2019.2904385
- Taylor A. Howell, Brian E. Jackson and Zachary Manchester “ALTRO: A Fast Solver for Constrained Trajectory Optimization” In 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2019, pp. 7674–7679 DOI: 10.1109/IROS40897.2019.8967788
- Fang Da “Comprehensive Reactive Safety: No Need For A Trajectory If You Have A Strategy” In 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2022, pp. 2903–2910 DOI: 10.1109/IROS47612.2022.9981757
- Luyao Zhang, Shaohang Han and Sergio Grammatico “Automated Lane Merging via Game Theory and Branch Model Predictive Control” arXiv:2311.14916 [cs, eess] arXiv, 2024 DOI: 10.48550/arXiv.2311.14916
- “Interaction-aware trajectory prediction and planning for autonomous vehicles in forced merge scenarios” In IEEE Transactions on Intelligent Transportation Systems 24.1 IEEE, 2022, pp. 474–488
- R.Tyrrell Rockafellar, Stanislav P. Uryasev and Michael Zabarankin “Deviation Measures in Risk Analysis and Optimization”, 2002 DOI: 10.2139/ssrn.365640
- Nicol N. Schraudolph “Fast Curvature Matrix-Vector Products for Second-Order Gradient Descent” In Neural Computation 14.7, 2002, pp. 1723–1738 DOI: 10.1162/08997660260028683
- Jorge Nocedal and Stephen J. Wright “Numerical Optimization”, Springer Series in Operations Research and Financial Engineering Springer New York, 2006 DOI: 10.1007/978-0-387-40065-5
- Amir Beck “First-Order Methods in Optimization” Philadelphia, PA: Society for IndustrialApplied Mathematics, 2017 DOI: 10.1137/1.9781611974997
- Alexander Liniger, Alexander Domahidi and Manfred Morari “Optimization-Based Autonomous Racing of 1:43 Scale RC Cars” arXiv:1711.07300 [cs, math] In Optimal Control Applications and Methods 36.5, 2015, pp. 628–647 DOI: 10.1002/oca.2123
- Luyao Zhang, Shaohang Han and Sergio Grammatico “An Efficient Game-Theoretic Planner for Automated Lane Merging with Multi-Modal Behavior Understanding” In 2023 IEEE 26th International Conference on Intelligent Transportation Systems (ITSC), 2023, pp. 3085–3090 DOI: 10.1109/ITSC57777.2023.10422316
- “EPSILON: An Efficient Planning System for Automated Vehicles in Highly Interactive Environments” In IEEE Transactions on Robotics 38.2, 2022, pp. 1118–1138 DOI: 10.1109/TRO.2021.3104254
- Andreas Wächter and Lorenz T. Biegler “On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming” In Mathematical Programming 106.1, 2006, pp. 25–57 DOI: 10.1007/s10107-004-0559-y
- “CasADi: a software framework for nonlinear optimization and optimal control” In Mathematical Programming Computation 11.1, 2019, pp. 1–36 DOI: 10.1007/s12532-018-0139-4
- Iain S. Duff “MA57—a code for the solution of sparse symmetric definite and indefinite systems” In ACM Transactions on Mathematical Software 30.2, 2004, pp. 118–144 DOI: 10.1145/992200.992202