Simultaneous localization, mapping and moving object tracking (SLAMMOT) involves both simultaneous localization and mapping (SLAM) in dynamic environments and detecting and tracking these dynamic objects. In this paper, we establish a mathematical framework to integrate SLAM and moving object tracking. We describe two solutions: SLAM with generalized objects, and SLAM with detection and tracking of moving objects (DATMO). SLAM with generalized objects calculates a joint posterior over all generalized objects and the robot. Such an approach is similar to existing SLAM algorithms, but with additional structure to allow for motion modeling of generalized objects. Unfortunately, it is computationally demanding and generally infeasible. SLAM with DATMO decomposes the estimation problem into two separate estimators. By maintaining separate posteriors for stationary objects and moving objects, the resulting estimation problems are much lower dimensional then SLAM with generalized objects. Both SLAM and moving object tracking from a moving vehicle in crowded urban areas are daunting tasks. Based on the SLAM with DATMO framework, we propose practical algorithms which deal with issues of perception modeling, data association, and moving object detection. The implementation of SLAM with DATMO was demonstrated using data collected from the CMU Navlab11 vehicle at high speeds in crowded urban environments. Ample experimental results shows the feasibility of the proposed theory and algorithms.

No abstract

The Navlab group at Carnegie Mellon University has a long history of development of automated vehicles and intelligent systems for driver assistance. The earlier work of the group concentrated on road following, cross-country driving, and obstacle detection. The new focus is on short-range sensing, to look all around the vehicle for safe driving. The current system uses video sensing, laser rangefinders, a novel light-stripe rangefinder, software to process each sensor individually, a map-based fusion system, and a probability based predictive model. The complete system has been demonstrated on the Navlab 11 vehicle for monitoring the environment of a vehicle driving through a cluttered urban environment, detecting and tracking fixed objects, moving objects, pedestrians, curbs, and roads. Robotics Technology and Intelligent VehiclesDuring the decade of the 1990's, researchers from automotive engineering, from robotics, and from allied fields came together to start building intelligent vehicles [1,2,3,4]. These vehicles use sensors, actuators, processors, and communications systems to either drive automatically, or to monitor a human driver and assist in navigation or warn in case of a developing dangerous situation.The field was driven by several market demand factors. First is an increasing interest in safety. While the accident rate has decreased steadily for 40 years, the total miles traveled have increased, with the net result that the number of road fatalities in the US has stayed approximately constant, averaging 40,000 / year [5]. Furthermore, there is an increasing sense that vehicles have become safer (air bags, anti-lock brakes, crumple zones); roadways have become safer (the Interstate highway system); societal pressures have become stronger (mandatory child safety seats, serious enforcement of drunk driving laws) but the drivers themselves have not necessarily improved. Currently, in the US, 70% of all crashes are primarily caused by the drivers, and in another 20% driver error is a major contributing factor [5,6].Beyond safety, the next major driving factors have to do with congestion and pollution. In the US, traffic continues to grow at 4% / year, while with the completion of the Interstate highway system, major new road construction greatly lags traffic growth. Computercontrolled vehicles promise to smooth out traffic flow, permitting more vehicles to travel in

No abstract