https://1library.org/document/dzx3dozr-design-indoor-mapping-using-laser-scanners-dof-slam.html