robotology / idyntree

Multibody Dynamics Library designed for Free Floating Robots
BSD 3-Clause "New" or "Revised" License
155 stars 65 forks source link

Model::computeFullTreeTraversal crashes on iDynTree::Model with loop #1120

Open traversaro opened 9 months ago

traversaro commented 9 months ago

Even if it is not supported in most classes for kinematics or dynamics computations, iDynTree::Model supports representing graphs with loops. However, if a iDynTree::Model with graph with a loop is passed to Model::computeFullTreeTraversal, the method crash. Instead, the method should either print an error or compute the traversal corresponding to a spanning tree.