Pathfinding with Road IDs

This PR adds support for pathfinding between points of type mantle_api::OpenDriveRoadPosition.

This is a massive change, as previously localization and pathfinding used spatial hashes of physical lanes.

However, a local position's road id is not accessible via physical lanes. Road ids are stored in logical lanes and until recently, no link from physical lanes to logical lanes existed.

This PR adds a lookup from the road id to a corresponding road, which is an ordered list of adjacent logical lanes.

It does so by transferring some of the logic from the TrafficAreaService into the GtGenMap.