Source: https://ft.univ-tlemcen.dz/assets/uploads/pdf/departement/gee/Cours_modelisationdes_robots.pdf