I think LIDAR is the most likely solution. With enough resolution, you could get a reasonable 3D map of the vehicle's surroundings with a very accurate relative model of where the vehicle is located.