Simultaneous Localization and Mapping for Path-Constrained Motion

• Published in: IEEE transactions on intelligent transportation systems Vol. 13; no. 2; pp. 541 - 552
• Main Authors: Hasberg, C., Hensel, S., Stiller, C.
• Format: Journal Article
• Language: English
• Published: New York IEEE 01.06.2012; The Institute of Electrical and Electronics Engineers, Inc. (IEEE)
• Subjects: Approximation methods; Cubic splines; Kinematics; Localization; Mathematical model; Mathematical models; Phase change materials; Position (location); probabilistic curvemap (PCM); Probabilistic methods; Probability theory; simultaneous localization and mapping (SLAM); Splines (mathematics); Uncertainty; Vectors; Vehicles
• ISSN: 1524-9050; 1558-0016
• DOI: 10.1109/TITS.2011.2177522

Accurate localization is a fundamental component of driver-assistance systems and autonomous vehicles. For path-constrained motion, a map offers significant information and assists localization with valuable information about the evolution of the kinematic vehicle states. We propose natural parameterized cubic spline curves to approximate true motion constraints, particularly the centerline of individual road lanes or rail tracks. Vehicle kinematics is modeled in 1-D curve coordinates. Since map information is subject to uncertainties, a probabilistic treatment is a prerequisite to obtaining consistent localization results. The proposed probabilistic curvemap (PCM) and the close map-to-vehicle relation enable a straightforward derivation of measurement update equations without additional map-matching steps and offer themselves to classical filter techniques. Incoming sensor measurements are used for simultaneous vehicle localization and local PCM update around the current vehicle position. Thus, every revisit of a location reduces uncertainty in the local PCM. Moreover, when no prior information is provided in the PCM, extrapolation is carried out to handle these situations with incomplete maps. The proposed filter is validated through simulations and real-world railway experiments.