Source: https://www2.ift.ulaval.ca/~pgiguere/cours/IntroRobotique/exercices/ExemplesExamenFinal.pdf