Template Function pinocchio::computeDelassusMatrix
Defined in File delassus.hxx
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.