This repo contains an initialization method for range-aided simultaneous localization and mapping (RA-SLAM). With range measurements, velocity measurements, and orientation measurements, the robot's position and beacon positions are estimated.
Note: this repo only conatins an example on simulated data, as the field data is not open-sourced.