Estimating Visibility from Alternate Perspectives for Motion Planning with Occlusions (2404.07781v1)
Abstract: Visibility is a crucial aspect of planning and control of autonomous vehicles (AV), particularly when navigating environments with occlusions. However, when an AV follows a trajectory with multiple occlusions, existing methods evaluate each occlusion individually, calculate a visibility cost for each, and rely on the planner to minimize the overall cost. This can result in conflicting priorities for the planner, as individual occlusion costs may appear to be in opposition. We solve this problem by creating an alternate perspective cost map that allows for an aggregate view of the occlusions in the environment. The value of each cell on the cost map is a measure of the amount of visual information that the vehicle can gain about the environment by visiting that location. Our proposed method identifies observation locations and occlusion targets drawn from both map data and sensor data. We show how to estimate an alternate perspective for each observation location and then combine all estimates into a single alternate perspective cost map for motion planning.
- C. Schwarz, “On Computing Time-To-Collision for Automation Scenarios,” Transportation research part F: traffic psychology and behaviour, vol. 27, pp. 283–294, 2014.
- Y. Nager, A. Censi, and E. Frazzoli, “What Lies in the Shadows? Safe and Computation-Aware Motion Planning for Autonomous Vehicles Using Intent-Aware Dynamic Shadow Regions,” in Int. Conf. Robotics and Automation (ICRA). IEEE, 2019, pp. 5800–5806.
- Y. Lin and M. Althoff, “CommonRoad-CriMe: A Toolbox for Criticality Measures of Autonomous Vehicles,” in Intelligent Vehicles Symposium (IV). IEEE, 2023.
- D. Adelberger, G. Singer, and L. del Re, “A Topology Based Virtual Co-Driver for Country Roads,” in American Control Conf. (ACC). IEEE, 2022, pp. 2416–2423.
- F. M. Tariq, N. Suriyarachchi, C. Mavridis, and J. S. Baras, “Vehicle Overtaking in a Bidirectional Mixed-Traffic Setting,” in American Control Conf. (ACC). IEEE, 2022, pp. 3132–3139.
- C. Hubmann, N. Quetschlich, J. Schulz, J. Bernhard, D. Althoff, and C. Stiller, “A POMDP Maneuver Planner for Occlusions in Urban Scenarios,” in Intelligent Vehicles Symposium (IV). IEEE, 2019, pp. 2172–2179.
- J. Higgins and N. Bezzo, “A Model Predictive-based Motion Planning Method for Safe and Agile Traversal of Unknown and Occluding Environments,” in Int. Conf. Robotics and Automation (ICRA). IEEE, 2022, pp. 9092–9098.
- H. Andersen, J. Alonso-Mora, Y. H. Eng, D. Rus, and M. H. Ang, “Trajectory Optimization and Situational Analysis Framework for Autonomous Overtaking with Visibility Maximization,” Transactions on Intelligent Vehicles, vol. 5, no. 1, pp. 7–20, 2019.
- B. Li, “Occlusion-Aware On-Road Autonomous Driving: A Trajectory Planning Method considering occlusions of lidars,” Optik, vol. 243, p. 167347, 2021.
- F. Christianos, P. Karkus, B. Ivanovic, S. V. Albrecht, and M. Pavone, “Planning with Occluded Traffic Agents using Bi-Level Variational Occlusion Models,” in Int. Conf. Robotics and Automation (ICRA). IEEE, 2023, pp. 5558–5565.
- B. Gilhuly, A. Sadeghi, P. Yedmellat, K. Rezaee, and S. L. Smith, “Looking for Trouble: Informative Planning for Safe Trajectories with Occlusions,” in Int. Conf. Robotics and Automation (ICRA). IEEE, 2022, pp. 8985–8991.
- S. Thrun, “Learning Occupancy Grid Maps with Forward Sensor Models,” Autonomous robots, vol. 15, pp. 111–127, 2003.
- A. Plebe, J. F. Kooij, G. P. R. Papini, and M. Da Lio, “Occupancy Grid Mapping with Cognitive Plausibility for Autonomous Driving Applications,” in Int. Conf. Computer Vision. IEEE/CVF, 2021, pp. 2934–2941.
- M. Edmonds, T. Yigit, V. Hong, F. Sikandar, and J. Yi, “Optimal Trajectories for Autonomous Human-Following Carts with Gesture-Based Contactless Positioning Suggestions,” in American Control Conf. (ACC). IEEE, 2021, pp. 3896–3901.
- M. Kanai, S. Ishihara, R. Narikawa, and T. Ohtsuka, “Cooperative Motion Generation Using Nonlinear Model Predictive Control for Heterogeneous Agents in Warehouse,” in Conf. on Control Technology and Applications (CCTA). IEEE, 2022, pp. 1402–1407.
- D. D. Fan, A.-A. Agha-Mohammadi, and E. A. Theodorou, “Learning Risk-Aware Costmaps for Traversability in Challenging Environments,” Robotics and Automation Letters, vol. 7, no. 1, pp. 279–286, 2021.
- V. Rajendran, P. Carreno-Medrano, W. Fisher, and D. Kulić, “Human-Aware RRT-Connect: Motion Planning for Safe Human-Robot Collaboration,” in Int. Conf. Robot & Human Interactive Communication (RO-MAN). IEEE, 2021, pp. 15–22.
- J. Mainprice, E. A. Sisbot, L. Jaillet, J. Cortés, R. Alami, and T. Siméon, “Planning Human-Aware Motions Using a Sampling-Based Costmap Planner,” in Int. Conf. Robotics and Automation (ICRA). IEEE, 2011, pp. 5012–5017.
- J. B. Rawlings, “Tutorial Overview of Model Predictive Control,” Control Systems Magazine, vol. 20, no. 3, pp. 38–52, 2000.
- K. S. Mann, A. Tomy, A. Paigwar, A. Renzaglia, and C. Laugier, “Predicting Future Occupancy Grids in Dynamic Environment with Spatio-Temporal Learning,” 2022.
- H.-J. Yoon, H. Kim, K. Shrestha, N. Hovakimyan, and P. Voulgaris, “Estimation and Planning of Exploration Over Grid Map Using A Spatiotemporal Model with Incomplete State Observations,” in Conf. on Control Technology and Applications (CCTA). IEEE, 2021, pp. 998–1003.
- D. Wang, M. Zhang, G. Li, and S. Qin, “Research on Intelligent Robot Path Planning Based on Spatiotemporal Grid Map in Dynamic Environment,” in Conf. on Automation, Control and Robots (ICACR), 2021, pp. 156–161.
- L. Xin, Y. Kong, S. E. Li, J. Chen, Y. Guan, M. Tomizuka, and B. Cheng, “Enable Faster and Smoother Spatio-temporal Trajectory Planning for Autonomous Vehicles in Constrained Dynamic Environment,” Journal of Automobile Engineering, vol. 235, no. 4, pp. 1101–1112, 2021.
- J. Bresenham, “A Linear Algorithm for Incremental Digital Display of Circular Arcs,” Communications of the ACM, vol. 20, no. 2, pp. 100–106, 1977.
- K. Stepanas, J. Williams, E. Hernández, F. Ruetz, and T. Hines, “OHM: GPU Based Occupancy Map Generation,” Robotics and Automation Letters, pp. 1–8, 2022.
- H. Min, K. M. Han, and Y. J. Kim, “OctoMap-RT: Fast Probabilistic Volumetric Mapping Using Ray-Tracing GPUs,” Robotics and Automation Letters, 2023.
- M. G. Castro, S. Triest, W. Wang, J. M. Gregory, F. Sanchez, J. G. Rogers, and S. Scherer, “How Does It Feel? Self-Supervised Costmap Learning for Off-Road Vehicle Traversability,” in Int. Conf. Robotics and Automation (ICRA). IEEE, 2023, pp. 931–938.
- G. Williams, N. Wagener, B. Goldfain, P. Drews, J. M. Rehg, B. Boots, and E. A. Theodorou, “Information Theoretic MPC for Model-Based Reinforcement Learning,” in Int. Conf. Robotics and Automation (ICRA). IEEE, 2017, pp. 1714–1721.
- D. Wang, W. Fu, J. Zhou, and Q. Song, “Occlusion-Aware Motion Planning for Autonomous Driving,” IEEE Access, 2023.
- C. Zhang, F. Steinhauser, G. Hinz, and A. Knoll, “Improved Occlusion Scenario Coverage with a POMDP-based Behavior Planner for Autonomous Urban Driving,” in Int. Intelligent Transportation Systems Conf. (ITSC). IEEE, 2021, pp. 593–600.
- C. van der Ploeg, T. Nyberg, J. M. G. Sánchez, E. Silvas, and N. van de Wouw, “Overcoming the Fear of the Dark: Occlusion-Aware Model-Predictive Planning for Automated Vehicles Using Risk Fields,” arXiv preprint arXiv:2309.15501, 2023.
- G. Williams, A. Aldrich, and E. A. Theodorou, “Model Predictive Path Integral Control: From Theory to Parallel Computation,” Journal of Guidance, Control, and Dynamics, vol. 40, no. 2, pp. 344–357, 2017.
- J. C. Butcher, “A History of Runge-Kutta Methods,” Applied numerical mathematics, vol. 20, no. 3, pp. 247–260, 1996.
- I. S. Mohamed, K. Yin, and L. Liu, “Autonomous navigation of agvs in unknown cluttered environments: log-mppi control strategy,” Robotics and Automation Letters, vol. 7, no. 4, pp. 10 240–10 247, 2022.
- A. Dosovitskiy, G. Ros, F. Codevilla, A. Lopez, and V. Koltun, “CARLA: An Open Urban Driving Simulator,” in Conf. on Robot Learning. PMLR, 2017, pp. 1–16.