This is utility software for SLAM with Tree-based netwORk Optimizer (TORO) - View it on GitHub