Slam Music Tour Dates: Eureka moments! Slam Implementation using ESDF

Simultaneous localization and mapping (SLAM) is a method to help robots explore, navigate, and map an unknown environment. It is well known that traditional methods for SLAM based on the extended Kalman filter (EKF) suffer computational complexity problems when dealing with large scale environments, as well as inconsistencies for non-linear SLAM problems.

To incorporate non-linear measurements, current research has been focused on smoothing approaches using Graph SLAM techniques. The Exactly Sparse Delayed-State Filter (ESDF) was exploited by Eustice et al. to map the RMS titanic using pose constraints between camera views. We use the like manifestation as a first direct for our Graph SLAM implementation. A lot of the work on ESDF was done by my team mate Tom.Pseudo code for our ESDF We ran our algorithms on two data sets - Manhattan3500 CMU Newell-Simon Hall, A LevelManhattan3500 Simulated DatasetCMU Newell-Simon Hall, A Level Dataset Manhattan 3500 is a simulated data set of a robot driving around the streets of Manhattan. It contains 3500 pose constraints and covariances associated with each constraint. The CMU Newell-Simon Hall dataset contains odometry from an IMU and roll and bearin returns for a 180 degree SICK laser. Manhattan 3500: This dataset was used to maintain the process of the ESDF before fusing it with the correlative Scan-Matcher to finish our system. Figures below show the ESDF performance both with and without loop closures. We can hold the natural sparsity of the SLAM information matrix. Only 0.182 percent of the elements of the information matrix are non-zero.Manhattan open LoopManhattan Close Loop CMU Newell-Simon Hall: This dataset was first used to insure the operation of the correlative Scan-Matcher in an open loop scenario. Once it was confirmed that the Scan-Matcher was returning reliable rigid body constraints, we used the rigid body constraints from the Scan-Matcher in conjunction with the ESDF. Figures below shows the map generated using only the pose constraints from the correlative Scan-Matcher. The administration runs open loop until the final thirteen pose constraints, which are loop closing events. The final map recovered is visually quite like to the map recovered by iSAM. For our final implementation we would like to use iSAM given its computational benefits.ESDF on CMU DatasetiSAM open loopiSAM close loop