Source: https://www.ensta-bretagne.fr/jaulin/mastersds_cours_robot_boimond.pdf