orocos_kdl
treeidsolver_recursive_newton_euler.hpp
Go to the documentation of this file.
1 // Copyright (C) 2009 Ruben Smits <ruben dot smits at intermodalics dot eu>
2 
3 // Version: 1.0
4 // Author: Franco Fusco <franco dot fusco at ls2n dot fr>
5 // Maintainer: Ruben Smits <ruben dot smits at intermodalics dot eu>
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 KDL_TREE_IDSOLVER_RECURSIVE_NEWTON_EULER_HPP
23 #define KDL_TREE_IDSOLVER_RECURSIVE_NEWTON_EULER_HPP
24 
25 #include "treeidsolver.hpp"
26 
27 namespace KDL{
41  class TreeIdSolver_RNE : public TreeIdSolver {
42  public:
48  TreeIdSolver_RNE(const Tree& tree, Vector grav);
49 
60  int CartToJnt(const JntArray &q, const JntArray &q_dot, const JntArray &q_dotdot, const WrenchMap& f_ext, JntArray &torques);
61 
63  virtual void updateInternalDataStructures();
64 
65  private:
67  void initAuxVariables();
68 
70  void rne_step(SegmentMap::const_iterator segment, const JntArray &q, const JntArray &q_dot, const JntArray &q_dotdot, const WrenchMap& f_ext, JntArray& torques);
71 
72  const Tree& tree;
73  unsigned int nj;
74  unsigned int ns;
81  };
82 }
83 
84 #endif
KDL::TreeIdSolver_RNE::tree
const Tree & tree
Definition: treeidsolver_recursive_newton_euler.hpp:72
KDL::TreeIdSolver_RNE::ns
unsigned int ns
Definition: treeidsolver_recursive_newton_euler.hpp:74
KDL::JntArray
Definition: jntarray.hpp:69
KDL::TreeIdSolver_RNE::rne_step
void rne_step(SegmentMap::const_iterator segment, const JntArray &q, const JntArray &q_dot, const JntArray &q_dotdot, const WrenchMap &f_ext, JntArray &torques)
One recursion step.
Definition: treeidsolver_recursive_newton_euler.cpp:78
KDL::TreeIdSolver_RNE::S
std::map< std::string, Twist > S
Definition: treeidsolver_recursive_newton_euler.hpp:76
KDL::TreeIdSolver_RNE::ag
Twist ag
Definition: treeidsolver_recursive_newton_euler.hpp:80
KDL::TreeIdSolver_RNE::TreeIdSolver_RNE
TreeIdSolver_RNE(const Tree &tree, Vector grav)
Definition: treeidsolver_recursive_newton_euler.cpp:28
KDL::TreeIdSolver_RNE::f
std::map< std::string, Wrench > f
Definition: treeidsolver_recursive_newton_euler.hpp:79
KDL
Definition: kukaLWR_DHnew.cpp:25
KDL::Vector
A concrete implementation of a 3 dimensional vector class.
Definition: frames.hpp:162
KDL::TreeIdSolver_RNE::v
std::map< std::string, Twist > v
Definition: treeidsolver_recursive_newton_euler.hpp:77
KDL::TreeIdSolver_RNE::X
std::map< std::string, Frame > X
Definition: treeidsolver_recursive_newton_euler.hpp:75
KDL::TreeIdSolver_RNE::nj
unsigned int nj
Definition: treeidsolver_recursive_newton_euler.hpp:73
KDL::Twist
represents both translational and rotational velocities.
Definition: frames.hpp:723
KDL::TreeIdSolver_RNE::initAuxVariables
void initAuxVariables()
Helper function to initialize private members X, S, v, a, f.
Definition: treeidsolver_recursive_newton_euler.cpp:41
std::map
KDL::Tree
This class encapsulates a tree kinematic interconnection structure. It is built out of segments.
Definition: tree.hpp:99
KDL::TreeIdSolver_RNE
Recursive newton euler inverse dynamics solver for kinematic trees.
Definition: treeidsolver_recursive_newton_euler.hpp:41
treeidsolver.hpp
KDL::TreeIdSolver_RNE::updateInternalDataStructures
virtual void updateInternalDataStructures()
Definition: treeidsolver_recursive_newton_euler.cpp:35
KDL::TreeIdSolver_RNE::a
std::map< std::string, Twist > a
Definition: treeidsolver_recursive_newton_euler.hpp:78
KDL::TreeIdSolver
This abstract class encapsulates the inverse dynamics solver for a KDL::Tree.
Definition: treeidsolver.hpp:40
KDL::TreeIdSolver_RNE::CartToJnt
int CartToJnt(const JntArray &q, const JntArray &q_dot, const JntArray &q_dotdot, const WrenchMap &f_ext, JntArray &torques)
Definition: treeidsolver_recursive_newton_euler.cpp:52