'Institute of Electrical and Electronics Engineers (IEEE)'
Abstract
This paper applies some previously studied extended
Kalman filter techniques for planar road geometry estimation
to the domain of autonomous navigation of off-highway
vehicles. In this work, a clothoid model of the road geometry is
constructed and estimated recursively based on road features
extracted from single-axis LADAR range measurements. We
present a method for feature extraction of the road centerline
in the image plane, and describe its application to recursive
estimation of the road geometry. We analyze the performance of
our method against simulated motion of varied road geometries
and against closed-loop detection, tracking and following of
desert roads. Our method accomodates full 6 DOF motion of
the vehicle as it navigates, constructs consistent estimates of the
road geometry with respect to a fixed global reference frame,
and requires an estimate of the sensor pose for each range
measurement