LADAR-based detection and tracking of moving objects from a ground vehicle at high speeds

Detection and tracking of moving objects (DATMO) in crowded urban areas from a ground vehicle at high speeds is difficult because of a wide variety of targets and uncertain pose estimation from odometry and GPS/DGPS. In this paper we present a solution of the simultaneous localization and mapping (SLAM) with DATMO problem to accomplish this task using ladar sensors and odometry. With a precise pose estimate and a surrounding map from SLAM, moving objects are detected without a priori knowledge of the targets. The interacting multiple model (IMM) estimation algorithm is used for modeling the motion of a moving object and to predict its future location. The multiple hypothesis tracking (MHT) method is applied to refine detection and data association. Experimental results demonstrate that our algorithm is reliable and robust to detect and track pedestrians and different types of moving vehicles in urban areas.