Long-Range Road Geometry Estimation Using Moving Vehicles and Roadside Observations

This paper presents an algorithm for estimating the shape of the road ahead of a host vehicle equipped with the following onboard sensors: a camera, a radar, and vehicle internal sensors. The aim is to accurately describe the road geometry up to 200 m ahead in highway scenarios. This purpose is accomplished by deriving a precise clothoid-based road model for which we design a Bayesian fusion framework. Using this framework, the road geometry is estimated using sensor observations on the shape of the lane markings, the heading of leading vehicles, and the position of roadside radar reflectors. The evaluation on sensor data shows that the proposed algorithm is capable of capturing the shape of the road well, even in challenging mountainous highways.