Source: https://polytech-nancy.univ-lorraine.fr/sites/dev-esstin.univ-lorraine.fr/files/users/documents/cp_olympiades_fanuc_robotique_avril18.pdf