 |
pinocchio
2.5.6
A fast and flexible implementation of Rigid Body Dynamics algorithms and their analytical derivatives
|
|
5 #ifndef __pinocchio_joint_basic_visitors_hpp__
6 #define __pinocchio_joint_basic_visitors_hpp__
8 #include "pinocchio/multibody/joint/fwd.hpp"
22 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
23 inline JointDataTpl<Scalar,Options,JointCollectionTpl>
24 createData(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
38 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl,
typename ConfigVectorType>
39 inline void calc_zero_order(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel,
40 JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata,
41 const Eigen::MatrixBase<ConfigVectorType> & q);
56 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl,
typename ConfigVectorType,
typename TangentVectorType>
57 inline void calc_first_order(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel,
58 JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata,
59 const Eigen::MatrixBase<ConfigVectorType> & q,
60 const Eigen::MatrixBase<TangentVectorType> & v);
74 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl,
typename Matrix6Type>
75 inline void calc_aba(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel,
76 JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata,
77 const Eigen::MatrixBase<Matrix6Type> & I,
88 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
89 inline int nv(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
101 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
102 inline int nq(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
114 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
115 inline int idx_q(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
127 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
128 inline int idx_v(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
138 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
139 inline JointIndex
id(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
152 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
153 inline void setIndexes(JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel, JointIndex
id,
int q,
int v);
161 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
162 inline std::string
shortname(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
173 template<
typename NewScalar,
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
174 typename CastType< NewScalar,JointModelTpl<Scalar,Options,JointCollectionTpl> >::type
175 cast_joint(
const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
191 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
192 inline ConstraintTpl<Eigen::Dynamic,Scalar,Options>
193 constraint_xd(
const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
203 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
204 inline SE3Tpl<Scalar,Options>
205 joint_transform(
const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
215 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
216 inline MotionTpl<Scalar,Options>
217 motion(
const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
227 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
228 inline MotionTpl<Scalar,Options>
229 bias(
const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
239 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
240 inline Eigen::Matrix<Scalar,6,Eigen::Dynamic,Options>
241 u_inertia(
const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
251 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
252 inline Eigen::Matrix<Scalar,Eigen::Dynamic,Eigen::Dynamic,Options>
253 dinv_inertia(
const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
263 template<
typename Scalar,
int Options,
template<
typename S,
int O>
class JointCollectionTpl>
264 inline Eigen::Matrix<Scalar,6,Eigen::Dynamic,Options>
265 udinv_inertia(
const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
275 #endif // ifndef __pinocchio_joint_basic_visitors_hpp__
int idx_q(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointIdxQVisitor to get the index in the full model configuration space...
int idx_v(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointIdxVVisitor to get the index in the full model tangent space corre...
int nv(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointNvVisitor to get the dimension of the joint tangent space.
JointIndex id(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointIdVisitor to get the index of the joint in the kinematic chain.
int nq(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointNqVisitor to get the dimension of the joint configuration space.
Eigen::Matrix< Scalar, 6, Eigen::Dynamic, Options > udinv_inertia(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointUDInvInertiaVisitor to get U*D^{-1} matrix of the inertia matrix de...
std::string shortname(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointShortnameVisitor to get the shortname of the derived joint model.
void calc_first_order(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel, JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata, const Eigen::MatrixBase< ConfigVectorType > &q, const Eigen::MatrixBase< TangentVectorType > &v)
Visit a JointModelTpl and the corresponding JointDataTpl through JointCalcFirstOrderVisitor to comput...
void setIndexes(JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel, JointIndex id, int q, int v)
Visit a JointModelTpl through JointSetIndexesVisitor to set the indexes of the joint in the kinematic...
ConstraintTpl< Eigen::Dynamic, Scalar, Options > constraint_xd(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataVariant through JointConstraintVisitor to get the joint constraint as a dense constr...
Eigen::Matrix< Scalar, 6, Eigen::Dynamic, Options > u_inertia(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointUInertiaVisitor to get the U matrix of the inertia matrix decomposi...
void calc_aba(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel, JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata, const Eigen::MatrixBase< Matrix6Type > &I, const bool update_I)
Visit a JointModelTpl and the corresponding JointDataTpl through JointCalcAbaVisitor to.
MotionTpl< Scalar, Options > motion(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointMotionVisitor to get the joint internal motion as a dense motion.
void calc_zero_order(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel, JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata, const Eigen::MatrixBase< ConfigVectorType > &q)
Visit a JointModelTpl and the corresponding JointDataTpl through JointCalcZeroOrderVisitor to compute...
CastType< NewScalar, JointModelTpl< Scalar, Options, JointCollectionTpl > >::type cast_joint(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl<Scalar,...> to cast it into JointModelTpl<NewScalar,...>
JointDataTpl< Scalar, Options, JointCollectionTpl > createData(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through CreateData visitor to create a JointDataTpl.
SE3Tpl< Scalar, Options > joint_transform(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointTransformVisitor to get the joint internal transform (transform bet...
MotionTpl< Scalar, Options > bias(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointBiasVisitor to get the joint bias as a dense motion.
Eigen::Matrix< Scalar, Eigen::Dynamic, Eigen::Dynamic, Options > dinv_inertia(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointDInvInertiaVisitor to get the D^{-1} matrix of the inertia matrix d...
Main pinocchio namespace.