Source: http://files.iai.heig-vd.ch/lara/web/p/jdz/CoursAIC/ExercicesRobEtAutomYcCorrParties4.6AICv010.04.02.pdf