Papers
Topics
Authors
Recent
Gemini 2.5 Flash
Gemini 2.5 Flash
139 tokens/sec
GPT-4o
47 tokens/sec
Gemini 2.5 Pro Pro
43 tokens/sec
o3 Pro
4 tokens/sec
GPT-4.1 Pro
47 tokens/sec
DeepSeek R1 via Azure Pro
28 tokens/sec
2000 character limit reached

Robust Predictive Motion Planning by Learning Obstacle Uncertainty (2403.06222v1)

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

Abstract: Safe motion planning for robotic systems in dynamic environments is nontrivial in the presence of uncertain obstacles, where estimation of obstacle uncertainties is crucial in predicting future motions of dynamic obstacles. The worst-case characterization gives a conservative uncertainty prediction and may result in infeasible motion planning for the ego robotic system. In this paper, an efficient, robust, and safe motion-planing algorithm is developed by learning the obstacle uncertainties online. More specifically, the unknown yet intended control set of obstacles is efficiently computed by solving a linear programming problem. The learned control set is used to compute forward reachable sets of obstacles that are less conservative than the worst-case prediction. Based on the forward prediction, a robust model predictive controller is designed to compute a safe reference trajectory for the ego robotic system that remains outside the reachable sets of obstacles over the prediction horizon. The method is applied to a car-like mobile robot in both simulations and hardware experiments to demonstrate its effectiveness.

Definition Search Book Streamline Icon: https://streamlinehq.com
References (40)
  1. B. Olofsson and L. Nielsen, “Using crash databases to predict effectiveness of new autonomous vehicle maneuvers for lane-departure injury reduction,” IEEE Transactions on Intelligent Transportation Systems, vol. 22, no. 6, pp. 3479–3490, 2020.
  2. H. Seo, D. Lee, C. Y. Son, I. Jang, C. J. Tomlin, and H. J. Kim, “Real-time robust receding horizon planning using Hamilton–Jacobi reachability analysis,” IEEE Transactions on Robotics, vol. 39, no. 1, pp. 90–109, 2023.
  3. I. Batkovic, A. Gupta, M. Zanon, and P. Falcone, “Experimental validation of safe MPC for autonomous driving in uncertain environments,” IEEE Transactions on Control Systems Technology, vol. 31, no. 5, pp. 2027–2042, 2023.
  4. Y. Gao, F. J. Jiang, L. Xie, and K. H. Johansson, “Risk-aware optimal control for automated overtaking with safety guarantees,” IEEE Transactions on Control Systems Technology, vol. 30, no. 4, pp. 1460–1472, 2022.
  5. S. H. Nair, V. Govindarajan, T. Lin, C. Meissen, H. E. Tseng, and F. Borrelli, “Stochastic MPC with multi-modal predictions for traffic intersections,” in IEEE International Conference on Intelligent Transportation Systems (ITSC), 2022, pp. 635–640.
  6. V. Fors, B. Olofsson, and E. Frisk, “Resilient branching MPC for multi-vehicle traffic scenarios using adversarial disturbance sequences,” IEEE Transactions on Intelligent Vehicles, vol. 7, no. 4, pp. 838–848, 2022.
  7. A. Li, L. Sun, W. Zhan, M. Tomizuka, and M. Chen, “Prediction-based reachability for collision avoidance in autonomous driving,” in IEEE International Conference on Robotics and Automation (ICRA), 2021, pp. 7908–7914.
  8. M. Chen and C. J. Tomlin, “Hamilton–Jacobi reachability: Some recent theoretical advances and applications in unmanned airspace management,” Annual Review of Control, Robotics, and Autonomous Systems, vol. 1, no. 1, pp. 333–358, 2018.
  9. M. Althoff and J. M. Dolan, “Online verification of automated road vehicles using reachability analysis,” IEEE Transactions on Robotics, vol. 30, no. 4, pp. 903–918, 2014.
  10. M. Althoff and S. Magdici, “Set-based prediction of traffic participants on arbitrary road networks,” IEEE Transactions on Intelligent Vehicles, vol. 1, no. 2, pp. 187–202, 2016.
  11. X. Wang and M. Althoff, “Safe reinforcement learning for automated vehicles via online reachability analysis,” IEEE Transactions on Intelligent Vehicles, 2024.
  12. C. Danielson, K. Berntorp, A. Weiss, and S. Di Cairano, “Robust motion planning for uncertain systems with disturbances using the invariant-set motion planner,” IEEE Transactions on Automatic Control, vol. 65, no. 10, pp. 4456–4463, 2020.
  13. S. Dixit, U. Montanaro, M. Dianati, D. Oxtoby, T. Mizutani, A. Mouzakitis, and S. Fallah, “Trajectory planning for autonomous high-speed overtaking in structured environments using robust MPC,” IEEE Transactions on Intelligent Transportation Systems, vol. 21, no. 6, pp. 2310–2323, 2020.
  14. M. Nezami, N. T. Nguyen, G. Männel, H. S. Abbas, and G. Schildbach, “A safe control architecture based on robust model predictive control for autonomous driving,” in American Control Conference (ACC).   IEEE, 2022, pp. 914–919.
  15. M. Althoff, O. Stursberg, and M. Buss, “Model-based probabilistic collision detection in autonomous driving,” IEEE Transactions on Intelligent Transportation Systems, vol. 10, no. 2, pp. 299–310, 2009.
  16. X. Wang, Z. Li, J. Alonso-Mora, and M. Wang, “Reachability-based confidence-aware probabilistic collision detection in highway driving,” arXiv preprint arXiv:2302.07109, 2023.
  17. T. Westny, J. Oskarsson, B. Olofsson, and E. Frisk, “MTP-GO: Graph-based probabilistic multi-agent trajectory prediction with neural ODEs,” IEEE Transactions on Intelligent Vehicles, vol. 8, no. 9, pp. 4223–4236, 2023.
  18. K. Driggs-Campbell, R. Dong, and R. Bajcsy, “Robust, informative human-in-the-loop predictions via empirical reachable sets,” IEEE Transactions on Intelligent Vehicles, vol. 3, no. 3, pp. 300–309, 2018.
  19. D. Fridovich-Keil, A. Bajcsy, J. F. Fisac, S. L. Herbert, S. Wang, A. D. Dragan, and C. J. Tomlin, “Confidence-aware motion prediction for real-time collision avoidance,” The International Journal of Robotics Research, vol. 39, no. 2-3, pp. 250–265, 2020.
  20. J. H. Gillula and C. J. Tomlin, “Reducing conservativeness in safety guarantees by learning disturbances online: iterated guaranteed safe online learning,” in Robotics: Science and Systems, vol. 8.   MIT Press, 2013, p. 81.
  21. Y. Gao, S. Yan, J. Zhou, M. Cannon, A. Abate, and K. H. Johansson, “Learning-based rigid tube model predictive control,” arXiv preprint arXiv:2304.05105, 2024.
  22. B. Paden, M. Čáp, S. Z. Yong, D. Yershov, and E. Frazzoli, “A survey of motion planning and control techniques for self-driving urban vehicles,” IEEE Transactions on Intelligent Vehicles, vol. 1, no. 1, pp. 33–55, 2016.
  23. T. Benciolini, D. Wollherr, and M. Leibold, “Non-conservative trajectory planning for automated vehicles by estimating intentions of dynamic obstacles,” IEEE Transactions on Intelligent Vehicles, vol. 8, no. 3, pp. 2463–2481, 2023.
  24. J. Zhou, B. Olofsson, and E. Frisk, “Interaction-aware motion planning for autonomous vehicles with multi-modal obstacle uncertainty predictions,” IEEE Transactions on Intelligent Vehicles, 2023.
  25. C. Pek and M. Althoff, “Fail-safe motion planning for online verification of autonomous vehicles using convex optimization,” IEEE Transactions on Robotics, vol. 37, no. 3, pp. 798–814, 2021.
  26. S. H. Nair, E. H. Tseng, and F. Borrelli, “Collision avoidance for dynamic obstacles with uncertain predictions using model predictive control,” in IEEE Conference on Decision and Control (CDC), 2022, pp. 5267–5272.
  27. T. Brüdigam, M. Olbrich, D. Wollherr, and M. Leibold, “Stochastic model predictive control with a safety guarantee for automated driving,” IEEE Transactions on Intelligent Vehicles, vol. 8, no. 1, pp. 22–36, 2023.
  28. O. de Groot, B. Brito, L. Ferranti, D. Gavrila, and J. Alonso-Mora, “Scenario-based trajectory optimization in uncertain dynamic environments,” IEEE Robotics and Automation Letters, vol. 6, no. 3, pp. 5389–5396, 2021.
  29. I. Batkovic, U. Rosolia, M. Zanon, and P. Falcone, “A robust scenario MPC approach for uncertain multi-modal obstacles,” IEEE Control Systems Letters, vol. 5, no. 3, pp. 947–952, 2021.
  30. T. Brüdigam, J. Zhan, D. Wollherr, and M. Leibold, “Collision avoidance with stochastic model predictive control for systems with a twofold uncertainty structure,” in IEEE International Intelligent Transportation Systems Conference (ITSC), 2021, pp. 432–438.
  31. H. Hu, D. Isele, S. Bae, and J. F. Fisac, “Active uncertainty reduction for safe and efficient interaction planning: A shielding-aware dual control approach,” The International Journal of Robotics Research, pp. 1–24, 2023.
  32. M. C. Campi and S. Garatti, “The exact feasibility of randomized solutions of uncertain convex programs,” SIAM Journal on Optimization, vol. 19, no. 3, pp. 1211–1230, 2008.
  33. X. Zhang, A. Liniger, and F. Borrelli, “Optimization-based collision avoidance,” IEEE Transactions on Control Systems Technology, vol. 29, no. 3, pp. 972–983, 2021.
  34. pytope·PyPI. [Online]. Available: {https://pypi.org/project/pytope/}
  35. J. A. 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, 2019.
  36. A. Wächter and L. T. Biegler, “On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming,” Mathematical Programming, vol. 106, no. 1, pp. 25–57, 2006.
  37. “HSL. A collection of Fortran codes for large scale scientific computation,” Accessed: May. 5, 2021. [Online]. Available: https://licences.stfc.ac.uk/product/coin-hsl
  38. “Qualisys motion-capture systems,” https://www.qualisys.com/.
  39. K. Berntorp, R. Bai, K. F. Erliksson, C. Danielson, A. Weiss, and S. Di Cairano, “Positive invariant sets for safe integrated vehicle motion planning and control,” IEEE Transactions on Intelligent Vehicles, vol. 5, no. 1, pp. 112–126, 2019.
  40. K. Berntorp, T. Hoang, and S. Di Cairano, “Motion planning of autonomous road vehicles by particle filtering,” IEEE Transactions on Intelligent Vehicles, vol. 4, no. 2, pp. 197–210, 2019.
Citations (1)
View on Semantic Scholar

Summary

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

Ai Sparkles Streamline Icon: https://streamlinehq.com Summarize Now