PrincetonRaceCar_routing

This is the routing and path planning package based on Lanelet2. We have following features:

1. Build Lanelet2 map from image
2. Visualize basic lanes of a lanelet2 map (osm file) in RVIZ
3. Query route information given a pose
4. Plan a path given a start and end pose