Reference https://github.com/gpdaniels/slam https://github.com/MiguelAngelCalveraUnizar/Mini-SLAM_student