6 #ifndef __pinocchio_multibody_data_hpp__ 7 #define __pinocchio_multibody_data_hpp__ 9 #include "pinocchio/math/tensor.hpp" 11 #include "pinocchio/spatial/fwd.hpp" 12 #include "pinocchio/spatial/se3.hpp" 13 #include "pinocchio/spatial/force.hpp" 14 #include "pinocchio/spatial/motion.hpp" 15 #include "pinocchio/spatial/inertia.hpp" 16 #include "pinocchio/multibody/fwd.hpp" 17 #include "pinocchio/multibody/joint/joint-generic.hpp" 18 #include "pinocchio/container/aligned-vector.hpp" 20 #include "pinocchio/serialization/serializable.hpp" 23 #include <Eigen/Cholesky> 28 template<
typename _Scalar,
int _Options,
template<
typename,
int>
class JointCollectionTpl>
32 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
59 typedef Eigen::Matrix<Scalar,Eigen::Dynamic,Eigen::Dynamic,Options>
MatrixXs;
60 typedef Eigen::Matrix<Scalar,Eigen::Dynamic,1,Options>
VectorXs;
61 typedef Eigen::Matrix<Scalar,3,1,Options>
Vector3;
62 typedef Eigen::Matrix<Scalar, 6, 1, Options>
Vector6c;
63 typedef Eigen::Matrix<Scalar, 1, 6, Eigen::RowMajor | Options>
Vector6r;
73 typedef Eigen::Matrix<Scalar,6,Eigen::Dynamic,Options>
Matrix6x;
75 typedef Eigen::Matrix<Scalar,3,Eigen::Dynamic,Options>
Matrix3x;
77 typedef Eigen::Matrix<Scalar,6,6,Options>
Matrix6;
78 typedef Eigen::Matrix<Scalar,6,6,Eigen::RowMajor | Options>
RowMatrix6;
79 typedef Eigen::Matrix<Scalar,Eigen::Dynamic,Eigen::Dynamic,Eigen::RowMajor | Options>
RowMatrixXs;
422 #include "pinocchio/multibody/data.hxx" 424 #endif // ifndef __pinocchio_multibody_data_hpp__ Matrix6x dJ
Derivative of the Jacobian with respect to the time.
JointCollectionTpl const Eigen::MatrixBase< ConfigVectorType > const Eigen::MatrixBase< TangentVectorType > & v
Matrix6x psidd
psiddot Second Derivative of Jacobian w.r.t to the parent body moving a(p(j)) x Sj + v(p(j)) x psidj ...
TangentVectorType tau
Vector of joint torques (dim model.nv).
std::vector< int > nvSubtree_fromRow
Subtree of the current row index (used in Cholesky Decomposition).
FrameTpl< Scalar, Options > Frame
Matrix6x psid
psidot Derivative of Jacobian w.r.t to the parent body moving v(p(j)) x Sj
Eigen::Matrix< Scalar, Eigen::Dynamic, 1, Options > VectorXs
JointDataTpl< Scalar, Options, JointCollectionTpl > JointData
VectorXs g
Vector of generalized gravity (dim model.nv).
Eigen::Matrix< Scalar, Eigen::Dynamic, Eigen::Dynamic, Eigen::RowMajor|Options > RowMatrixXs
std::vector< std::vector< int > > supports_fromRow
Each element of this vector corresponds to the ordered list of indexes belonging to the supporting tr...
Matrix6x J
Jacobian of joint placements.
Matrix6x UDinv
Used in computeMinverse.
MatrixXs dtau_dv
Partial derivative of the joint torque vector with respect to the joint velocity. ...
MatrixXs jointTorqueRegressor
Matrix related to joint torque regressor.
Matrix6x dAdv
Variation of the spatial acceleration set with respect to the joint velocity.
VectorXs tmp
Temporary of size NV used in Cholesky Decomposition.
Tensor3x kinematic_hessians
Tensor containing the kinematic Hessian of all the joints.
A Plucker coordinate frame attached to a parent joint inside a kinematic tree.
Matrix6x dFda
Variation of the forceset with respect to the joint acceleration.
void computeLastChild(const Model &model)
JointDataVector joints
Vector of pinocchio::JointData associated to the pinocchio::JointModel stored in model, encapsulated in JointDataAccessor.
BodyRegressorType bodyRegressor
Body regressor.
std::vector< int > end_idx_v_fromRow
End index of the Joint motion subspace.
typedef PINOCCHIO_ALIGNED_STD_VECTOR(JointModel) JointModelVector
Eigen::Matrix< Scalar, 6, 6, Eigen::RowMajor|Options > RowMatrix6
Eigen::Matrix< Scalar, 6, 1, Options > Vector6c
MotionTpl< Scalar, Options > Motion
VectorXs torque_residual
Temporary corresponding to the residual torque .
Tensor< Scalar, 3, Options > Tensor3x
.
Eigen::LLT< MatrixXs > llt_JMinvJt
Cholesky decompostion of .
MatrixXs dtau_dq
Partial derivative of the joint torque vector with respect to the joint configuration.
VectorXs D
Diagonal of the joint space intertia matrix obtained by a Cholesky Decomposition. ...
TangentVectorType u
Intermediate quantity corresponding to apparent torque [ABA].
ModelTpl< Scalar, Options, JointCollectionTpl > Model
Matrix6x ddJ
Second derivative of the Jacobian with respect to the time.
RowMatrixXs Minv
The inverse of the joint space inertia matrix (a square matrix of dim model.nv).
Matrix6 Itmp
Temporary for derivative algorithms.
VectorXs nle
Vector of Non Linear Effects (dim model.nv). It corresponds to concatenation of the Coriolis...
ForceTpl< Scalar, Options > Force
Matrix6x IS
Used in computeMinverse.
MatrixXs ddq_dq
Partial derivative of the joint acceleration vector with respect to the joint configuration.
std::vector< Index > IndexVector
MatrixXs JMinvJt
Inverse of the operational-space inertia matrix.
Matrix6x dFdq
Variation of the forceset with respect to the joint configuration.
Matrix3x Jcom
Jacobian of center of mass.
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar Scalar
Matrix6x dAdq
Variation of the spatial acceleration set with respect to the joint configuration.
Tensor3x d2tau_dqdq
SO Partial derivative of the joint torque vector with respect to the joint configuration.
MatrixXs M
The joint space inertia matrix (a square matrix of dim model.nv).
MatrixXs C
The Coriolis matrix (a square matrix of dim model.nv).
JointCollectionTpl< Scalar, Options > JointCollection
Eigen::Matrix< Scalar, Eigen::Dynamic, Eigen::Dynamic, Options > MatrixXs
Matrix6x dAg
Centroidal Momentum Matrix Time Variation.
InertiaTpl< Scalar, Options > Inertia
Tensor3x d2tau_dqdv
SO Cross-Partial derivative of the joint torque vector with respect to the joint configuration/veloci...
TangentVectorType ddq
The joint accelerations computed from ABA.
std::vector< int > lastChild
Index of the last child (for CRBA)
JointModelTpl< Scalar, Options, JointCollectionTpl > JointModel
Matrix6x dFdv
Variation of the forceset with respect to the joint velocity.
Force dhg
Centroidal momentum time derivative.
pinocchio::JointIndex JointIndex
MatrixXs ddq_dv
Partial derivative of the joint acceleration vector with respect to the joint velocity.
Scalar kinetic_energy
Kinetic energy of the model.
Eigen::Matrix< Scalar, 1, 6, Eigen::RowMajor|Options > Vector6r
VectorXs lambda_c
Lagrange Multipliers corresponding to the contact forces in pinocchio::forwardDynamics.
Main pinocchio namespace.
std::vector< int > start_idx_v_fromRow
Starting index of the Joint motion subspace.
VectorXs Dinv
Diagonal inverse of the joint space intertia matrix obtained by a Cholesky Decomposition.
pinocchio::FrameIndex FrameIndex
Matrix6x dHdq
Variation of the spatial momenta with respect to the joint configuration.
VectorXs ConfigVectorType
Dense vectorized version of a joint configuration vector.
Matrix6x Ag
Centroidal Momentum Matrix.
TangentVectorType dq_after
Generalized velocity after impact.
Eigen::Matrix< Scalar, 3, Eigen::Dynamic, Options > Matrix3x
The 3d jacobian type (temporary)
Matrix6x SDinv
Used in computeMinverse.
Eigen::Matrix< Scalar, 6, 6, Options > Matrix6
MatrixXs sDUiJt
Temporary corresponding to .
Inertia Ig
Centroidal Composite Rigid Body Inertia.
void computeParents_fromRow(const Model &model)
Matrix3x staticRegressor
Matrix related to static regressor.
VectorXs impulse_c
Lagrange Multipliers corresponding to the contact impulses in pinocchio::impulseDynamics.
Scalar potential_energy
Potential energy of the model.
std::vector< int > nvSubtree
Dimension of the subtree motion space (for CRBA)
std::vector< int > parents_fromRow
First previous non-zero row in M (used in Cholesky Decomposition).
DataTpl()
Default constructor.
Force hg
Centroidal momentum quantity.
pinocchio::GeomIndex GeomIndex
Eigen::Matrix< Scalar, 6, Eigen::Dynamic, Options > Matrix6x
The 6d jacobian type (temporary)
MatrixXs U
Joint space intertia matrix square root (upper trianglular part) computed with a Cholesky Decompositi...
JointCollectionTpl & model
void computeSupports_fromRow(const Model &model)
Eigen::Matrix< Scalar, 6, 10, Options > BodyRegressorType
The type of the body regressor.
Eigen::Matrix< Scalar, 3, 1, Options > Vector3
SE3Tpl< Scalar, Options > SE3
Matrix6 M6tmp
Temporary for derivative algorithms.
Tensor3x d2tau_dvdv
SO Partial derivative of the joint torque vector with respect to the joint velocity.
std::vector< Scalar > mass
Vector of subtree mass. In other words, mass[j] is the mass of the subtree supported by joint ...
VectorXs TangentVectorType
Dense vectorized version of a joint tangent vector (e.g. velocity, acceleration, etc). It also handles the notion of co-tangent vector (e.g. torque, etc).
Matrix6x dVdq
Variation of the spatial velocity set with respect to the joint configuration.
Tensor3x d2tau_dadq
SO Cross-Partial derivative of the joint torque vector with respect to the joint acceleration/configu...