Template Function pinocchio::computeJointKinematicRegressor(const ModelTpl<Scalar, Options, JointCollectionTpl>&, const DataTpl<Scalar, Options, JointCollectionTpl>&, const JointIndex, const ReferenceFrame, const SE3Tpl<Scalar, Options>&)

Function Documentation

template<typename Scalar, int Options, template<typename, int> class JointCollectionTpl>
DataTpl<Scalar, Options, JointCollectionTpl>::Matrix6x pinocchio::computeJointKinematicRegressor(const ModelTpl<Scalar, Options, JointCollectionTpl> &model, const DataTpl<Scalar, Options, JointCollectionTpl> &data, const JointIndex joint_id, const ReferenceFrame rf, const SE3Tpl<Scalar, Options> &placement)

Computes the kinematic regressor that links the joint placements variations of the whole kinematic tree to the placement variation of the frame rigidly attached to the joint and given by its placement w.r.t. to the joint frame.

Remark

It assumes that the forwardKinematics(const ModelTpl<Scalar,Options,JointCollectionTpl> &, DataTpl<Scalar,Options,JointCollectionTpl> &, const Eigen::MatrixBase<ConfigVectorType> &) has been called first.

Parameters:

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

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

  • joint_id – [in] Index of the joint.

  • rf – [in] Reference frame in which the result is expressed (LOCAL, LOCAL_WORLD_ALIGNED or WORLD).

  • placement – [in] Relative placement to the joint frame.