RBDyn provide a set of class and function to model the dynamics of rigid body system. This implementation is based on Roy Featherstone Rigid Body Dynamics Algorithms book.