Source: https://robot.gmc.ulaval.ca/fileadmin/documents/Memoires/dany_gagnon-lachance.pdf