This is a simple project developed as part of the avaliation of the course on Least Squares and SLAM held at La Sapienza