KDL  1.4.0
chaindynparam.hpp
Go to the documentation of this file.
1 // Copyright (C) 2009 Dominick Vanthienen <dominick dot vanthienen at mech dot kuleuven dot be>
2 
3 // Version: 1.0
4 // Author: Dominick Vanthienen <dominick dot vanthienen at mech dot kuleuven dot be>
5 // Maintainer: Ruben Smits <ruben dot smits at mech dot kuleuven dot be>
6 // URL: http://www.orocos.org/kdl
7 
8 // This library is free software; you can redistribute it and/or
9 // modify it under the terms of the GNU Lesser General Public
10 // License as published by the Free Software Foundation; either
11 // version 2.1 of the License, or (at your option) any later version.
12 
13 // This library is distributed in the hope that it will be useful,
14 // but WITHOUT ANY WARRANTY; without even the implied warranty of
15 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 // Lesser General Public License for more details.
17 
18 // You should have received a copy of the GNU Lesser General Public
19 // License along with this library; if not, write to the Free Software
20 // Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
21 
22 #ifndef KDLCHAINDYNPARAM_HPP
23 #define KDLCHAINDYNPARAM_HPP
24 
28 #include <Eigen/StdVector>
29 
30 namespace KDL {
31 
48  {
49  public:
50  ChainDynParam(const Chain& chain, Vector _grav);
51  virtual ~ChainDynParam();
52 
53  virtual int JntToCoriolis(const JntArray &q, const JntArray &q_dot, JntArray &coriolis);
54  virtual int JntToMass(const JntArray &q, JntSpaceInertiaMatrix& H);
55  virtual int JntToGravity(const JntArray &q,JntArray &gravity);
56 
58  virtual void updateInternalDataStructures();
59 
60  private:
61  const Chain& chain;
62  int nr;
63  unsigned int nj;
64  unsigned int ns;
70  std::vector<Wrench> wrenchnull;
71  std::vector<Frame> X;
72  std::vector<Twist> S;
73  //std::vector<RigidBodyInertia> I;
74  std::vector<ArticulatedBodyInertia, Eigen::aligned_allocator<ArticulatedBodyInertia> > Ic;
77 
78  };
79 
80 }
81 
82 #endif
JntArray jntarraynull
Definition: chaindynparam.hpp:67
std::vector< ArticulatedBodyInertia, Eigen::aligned_allocator< ArticulatedBodyInertia > > Ic
Definition: chaindynparam.hpp:74
virtual ~ChainDynParam()
Definition: chaindynparam.cpp:147
Vector vectornull
Definition: chaindynparam.hpp:66
This class encapsulates a serial kinematic interconnection structure.
Definition: chain.hpp:35
int nr
Definition: chaindynparam.hpp:62
Twist ag
Definition: chaindynparam.hpp:76
This class represents an fixed size array containing joint values of a KDL::Chain.
Definition: jntarray.hpp:69
Solver interface supporting storage and description of the latest error.
Definition: solveri.hpp:84
Wrench F
Definition: chaindynparam.hpp:75
std::vector< Wrench > wrenchnull
Definition: chaindynparam.hpp:70
represents both translational and rotational velocities.
Definition: frames.hpp:720
Definition: articulatedbodyinertia.cpp:28
A concrete implementation of a 3 dimensional vector class.
Definition: frames.hpp:160
unsigned int nj
Definition: chaindynparam.hpp:63
Vector grav
Definition: chaindynparam.hpp:65
unsigned int ns
Definition: chaindynparam.hpp:64
ChainDynParam(const Chain &chain, Vector _grav)
Definition: chaindynparam.cpp:28
Recursive newton euler inverse dynamics solver.
Definition: chainidsolver_recursive_newton_euler.hpp:40
virtual int JntToCoriolis(const JntArray &q, const JntArray &q_dot, JntArray &coriolis)
Definition: chaindynparam.cpp:125
std::vector< Twist > S
Definition: chaindynparam.hpp:72
ChainIdSolver_RNE chainidsolver_gravity
Definition: chaindynparam.hpp:69
std::vector< Frame > X
Definition: chaindynparam.hpp:71
Implementation of a method to calculate the matrices H (inertia),C(coriolis) and G(gravitation) for t...
Definition: chaindynparam.hpp:47
virtual void updateInternalDataStructures()
Update the internal data structures.
Definition: chaindynparam.cpp:45
represents both translational and rotational acceleration.
Definition: frames.hpp:878
const Chain & chain
Definition: chaindynparam.hpp:61
virtual int JntToMass(const JntArray &q, JntSpaceInertiaMatrix &H)
Definition: chaindynparam.cpp:59
ChainIdSolver_RNE chainidsolver_coriolis
Definition: chaindynparam.hpp:68
virtual int JntToGravity(const JntArray &q, JntArray &gravity)
Definition: chaindynparam.cpp:137