Template Function pinocchio::computeDelassusMatrix

Function Documentation

template<typename Scalar, int Options, template<typename, int> class JointCollectionTpl, typename ConfigVectorType, class ModelAllocator, class DataAllocator, typename MatrixType>
void pinocchio::computeDelassusMatrix(const ModelTpl<Scalar, Options, JointCollectionTpl> &model, DataTpl<Scalar, Options, JointCollectionTpl> &data, const Eigen::MatrixBase<ConfigVectorType> &q, const std::vector<RigidConstraintModelTpl<Scalar, Options>, ModelAllocator> &contact_models, std::vector<RigidConstraintDataTpl<Scalar, Options>, DataAllocator> &contact_data, const Eigen::MatrixBase<MatrixType> &delassus, const Scalar mu = 0)

Computes the Delassus matrix associated to a set of given constraints.

Template Parameters:
  • JointCollection – Collection of Joint types.

  • ConfigVectorType – Type of the joint configuration vector.

  • ModelAllocator – Allocator class for the std::vector.

  • DataAllocator – Allocator class for the std::vector.

Parameters:
  • model[in] The model structure of the rigid body system.

  • data[in] The data structure of the rigid body system.

  • q[in] The joint configuration (size model.nq).

  • contact_models[in] Vector of contact models.

  • contact_datas[in] Vector of contact data.

  • delassus[out] The resulting Delassus matrix.

  • mu[in] Optional damping factor used when computing the inverse of the Delassus matrix.

Returns:

The (damped) Delassus matrix.