Papers
Topics
Authors
Recent
Gemini 2.5 Flash
Gemini 2.5 Flash
158 tokens/sec
GPT-4o
7 tokens/sec
Gemini 2.5 Pro Pro
45 tokens/sec
o3 Pro
4 tokens/sec
GPT-4.1 Pro
38 tokens/sec
DeepSeek R1 via Azure Pro
28 tokens/sec
2000 character limit reached

An Efficient Risk-aware Branch MPC for Automated Driving that is Robust to Uncertain Vehicle Behaviors (2403.18695v1)

Published 27 Mar 2024 in eess.SY, cs.RO, and cs.SY

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.

Definition Search Book Streamline Icon: https://streamlinehq.com
References (33)
  1. “Baidu Apollo EM Motion Planner” arXiv: 1807.08048 In arXiv:1807.08048 [cs], 2018 URL: http://arxiv.org/abs/1807.08048
  2. “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
  3. “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
  4. 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
  5. 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
  6. 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
  7. “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
  8. 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
  9. “Interactive Joint Planning for Autonomous Vehicles” In IEEE Robotics and Automation Letters 9.2, 2024, pp. 987–994 DOI: 10.1109/LRA.2023.3332474
  10. “Risk-averse model predictive control” In Automatica 100, 2019, pp. 281–288 DOI: https://doi.org/10.1016/j.automatica.2018.11.022
  11. “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
  12. 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
  13. “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
  14. “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
  15. “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
  16. James Blake Rawlings, David Q. Mayne and Moritz Diehl “Model predictive control: theory, computation, and design” Madison, Wisconsin: Nob Hill Publishing, 2017
  17. “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
  18. 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
  19. 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
  20. 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
  21. 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
  22. 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
  23. “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
  24. R.Tyrrell Rockafellar, Stanislav P. Uryasev and Michael Zabarankin “Deviation Measures in Risk Analysis and Optimization”, 2002 DOI: 10.2139/ssrn.365640
  25. 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
  26. 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
  27. Amir Beck “First-Order Methods in Optimization” Philadelphia, PA: Society for IndustrialApplied Mathematics, 2017 DOI: 10.1137/1.9781611974997
  28. 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
  29. 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
  30. “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
  31. 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
  32. “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
  33. 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

Summary

We haven't generated a summary for this paper yet.

X Twitter Logo Streamline Icon: https://streamlinehq.com