Here’s a quick demo of Hybrid A* in CARLA. Currently, it is using the velodyne_height_map plugin to detect obstacles, and I create a costmap/occupancy map based on that. For the Hybrid A Star implementation, I chose one done by @karlkruzer due to its easy integration with ROS. I’ll post a GitHub / full write up later once I get control implemented.