joint-basic-visitors.hpp
Go to the documentation of this file.
1 //
2 // Copyright (c) 2016,2018 CNRS
3 //
4 
5 #ifndef __pinocchio_joint_basic_visitors_hpp__
6 #define __pinocchio_joint_basic_visitors_hpp__
7 
8 #include "pinocchio/multibody/joint/fwd.hpp"
9 
10 namespace pinocchio
11 {
12 
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);
25 
26 
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);
42 
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);
61 
62 
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,
78  const bool update_I);
79 
88  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
89  inline int nv(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
90 
91 
92 
101  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
102  inline int nq(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
103 
104 
114  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
115  inline int idx_q(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
116 
117 
127  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
128  inline int idx_v(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
129 
130 
138  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
139  inline JointIndex id(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
140 
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);
154 
155 
161  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
162  inline std::string shortname(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel);
163 
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);
176 
185  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl, typename JointModelDerived>
186  bool isEqual(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel_generic,
187  const JointModelBase<JointModelDerived> & jmodel);
188 
189 
198  template<typename NewScalar, typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl, typename JointModelDerived>
199  bool hasSameIndexes(const JointModelTpl<Scalar,Options,JointCollectionTpl> & jmodel_generic,
200  const JointModelBase<JointModelDerived> & jmodel);
201 
202 
203  //
204  // Visitors on JointDatas
205  //
206 
207 
216  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
217  inline ConstraintTpl<Eigen::Dynamic,Scalar,Options>
218  constraint_xd(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
219 
228  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
229  inline SE3Tpl<Scalar,Options>
230  joint_transform(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
231 
240  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
241  inline MotionTpl<Scalar,Options>
242  motion(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
243 
252  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
253  inline MotionTpl<Scalar,Options>
254  bias(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
255 
264  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
265  inline Eigen::Matrix<Scalar,6,Eigen::Dynamic,Options>
266  u_inertia(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
267 
276  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
277  inline Eigen::Matrix<Scalar,Eigen::Dynamic,Eigen::Dynamic,Options>
278  dinv_inertia(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
279 
288  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl>
289  inline Eigen::Matrix<Scalar,6,Eigen::Dynamic,Options>
290  udinv_inertia(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jdata);
291 
300  template<typename Scalar, int Options, template<typename S, int O> class JointCollectionTpl, typename JointDataDerived>
301  bool isEqual(const JointDataTpl<Scalar,Options,JointCollectionTpl> & jmodel_generic,
302  const JointDataBase<JointDataDerived> & jmodel);
303 
304 } // namespace pinocchio
305 
306 
307 /* --- Details -------------------------------------------------------------------- */
308 // Included later
309 // #include "pinocchio/multibody/joint/joint-basic-visitors.hxx"
310 
311 
312 #endif // ifndef __pinocchio_joint_basic_visitors_hpp__
pinocchio::v
JointCollectionTpl const Eigen::MatrixBase< ConfigVectorType > const Eigen::MatrixBase< TangentVectorType > & v
Definition: joint-configuration.hpp:746
pinocchio::nv
int nv(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointNvVisitor to get the dimension of the joint tangent space...
pinocchio::motion
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...
pinocchio::idx_q
int idx_q(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointIdxQVisitor to get the index in the full model configuration space...
pinocchio::idx_v
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...
pinocchio::nq
int nq(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointNqVisitor to get the dimension of the joint configuration space...
pinocchio::createData
JointDataTpl< Scalar, Options, JointCollectionTpl > createData(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through CreateData visitor to create a JointDataTpl.
pinocchio::joint_transform
SE3Tpl< Scalar, Options > joint_transform(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointTransformVisitor to get the joint internal transform (transform bet...
pinocchio::id
JointIndex id(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointIdVisitor to get the index of the joint in the kinematic chain...
pinocchio::udinv_inertia
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...
pinocchio::hasSameIndexes
bool hasSameIndexes(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel_generic, const JointModelBase< JointModelDerived > &jmodel)
Check whether JointModelTpl<Scalar,...> has the indexes than another JointModelDerived.
pinocchio::isEqual
bool isEqual(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel_generic, const JointModelBase< JointModelDerived > &jmodel)
Visit a JointModelTpl<Scalar,...> to compare it to JointModelDerived.
pinocchio::q
JointCollectionTpl const Eigen::MatrixBase< ConfigVectorType > & q
Definition: joint-configuration.hpp:746
pinocchio::shortname
std::string shortname(const JointModelTpl< Scalar, Options, JointCollectionTpl > &jmodel)
Visit a JointModelTpl through JointShortnameVisitor to get the shortname of the derived joint model...
pinocchio::u_inertia
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...
pinocchio
Main pinocchio namespace.
Definition: timings.cpp:30
pinocchio::JointIndex
Index JointIndex
Definition: src/multibody/fwd.hpp:28
pinocchio::cast_joint
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,...>
pinocchio::setIndexes
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...
pinocchio::bias
MotionTpl< Scalar, Options > bias(const JointDataTpl< Scalar, Options, JointCollectionTpl > &jdata)
Visit a JointDataTpl through JointBiasVisitor to get the joint bias as a dense motion.
pinocchio::calc_first_order
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...
pinocchio::dinv_inertia
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...
pinocchio::constraint_xd
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...
pinocchio::calc_aba
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...
pinocchio::calc_zero_order
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...

pinocchio
Author(s):
autogenerated on Tue Jun 1 2021 02:45:03