iDynTree/ModelTransformers.h file

bool removeFakeLinks(const Model& modelWithFakeLinks, Model& modelWithoutFakeLinks)

\function Remove all fake links in the model, transforming them in frames.

Given a Model in input, this function copies all its links and joints to the model in output, except for links that recognized as "fake links".

The condition for a link to be classified as "fake link" are:

• The link has a zero mass.
• The link is a leaf, i.e. it is connected to only one neighbor.
• The link is connected to its only neighbor with a fixed joint.

Once a "fake link" has been identified to respect this two conditions, it and the joint that it connects it to its only neighbor is not copied to the output model, but a frame with the same name of the "fake link" and with the same transform is added to the model.

bool createReducedModel(const Model& fullModel, const std::vector<std::string>& jointsInReducedModel, Model& reducedModel)

This function takes in input a iDynTree::Model and an ordered list of joints and returns a model with just the joint specified in the list, with that exact order.

All other joints are be removed by lumping (i.e. fusing together) the inertia of the links that are connected by that joint, assuming the joint to be in "rest" position (i.e. zero for revolute or prismatic joints). The links eliminated with this process are be added back to the reduced model as "frames", and are copied in the same way all the additional frames of the lumped links.

bool createReducedModel(const Model& fullModel, const std::vector<std::string>& jointsInReducedModel, Model& reducedModel, const std::unordered_map<std::string, double>& removedJointPositions)

This function takes in input a iDynTree::Model and an ordered list of joints and returns a model with just the joint specified in the list, with that exact order.

All other joints are be removed by lumping (i.e. fusing together) the inertia of the links that are connected by that joint, assuming the joint to be in "rest" position (i.e. zero for revolute or prismatic joints), or the position specified in the removedJointPositions if a given joint is specified in removedJointPositions

bool createModelWithNormalizedJointNumbering(const Model& model, const std::string& baseForNormalizedJointNumbering, Model& reducedModel)

Given a specified base, return a model with a "normalized" joint numbering for that base.

This function takes in input a iDynTree::Model and a name of a link in that model. It returns a model identical to the one in input, but with the joint serialization of the non-fixed joint modified in such a way that a non-fixed joint has an index higher than all the non-fixed joints on the path between it and the base. After all the non-fixed joints, the fixed joints are also added with the same criteria, but applied to fixed joints.

bool extractSubModel(const iDynTree::Model& fullModel, const iDynTree::Traversal& subModelTraversal, iDynTree::Model& outputSubModel)

Extract sub model from sub model traversal.

This function creates a new iDynTree::Model containing links and joints composing the subModelTraversal. The function takes in input a iDynTree::Model and a iDynTree::Traversal. The new model will contain joints and links composing the subModelTraversal, with the same order. The FT sensor frames are added as additional frames.

bool addValidNamesToAllSolidShapes(const iDynTree::Model& inputModel, iDynTree::Model& outputModel)

Add automatically generated names to all visual and collision solid shapes of the model.

This function creates a new iDynTree::Model that is identical to the input one, but that sets a valid name for all the visual and collision solid shapes of the model.

For links that already have at least either collision or visual with valid name, all the corresponding shapes (collision or visual) will not be modified.

For links in which all shapes of a given type that do not have a valid name, a name will be generated as the following:

• If there is a single collision or visual element in the link, it will be named <linkName>_collision or <linkName>_visual
• If there are multiple collision or visual elements in the link, the solid shapes will be <linkName>_collision_0, <linkName>_collision_1, ... <linkName>_collision_n or <linkName>_visual_0, <linkName>_visual_1, ... <linkName>_visual_n