orocos_kdl
puma560.cpp
Go to the documentation of this file.
1 // Copyright (C) 2009 Ruben Smits <ruben dot smits at mech dot kuleuven dot be>
2 
3 // Version: 1.0
4 // Author: Ruben Smits <ruben dot smits 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 #include <chain.hpp>
23 #include "models.hpp"
24 #include <utilities/utility.h>
25 
26 namespace KDL{
28  Chain puma560;
29  puma560.addSegment(Segment());
31  Frame::DH(0.0,PI_2,0.0,0.0),
32  RigidBodyInertia(0,Vector::Zero(),RotationalInertia(0,0.35,0,0,0,0))));
34  Frame::DH(0.4318,0.0,0.0,0.0),
35  RigidBodyInertia(17.4,Vector(-.3638,.006,.2275),RotationalInertia(0.13,0.524,0.539,0,0,0))));
36  puma560.addSegment(Segment());
38  Frame::DH(0.0203,-PI_2,0.15005,0.0),
39  RigidBodyInertia(4.8,Vector(-.0203,-.0141,.070),RotationalInertia(0.066,0.086,0.0125,0,0,0))));
41  Frame::DH(0.0,PI_2,0.4318,0.0),
42  RigidBodyInertia(0.82,Vector(0,.019,0),RotationalInertia(1.8e-3,1.3e-3,1.8e-3,0,0,0))));
43  puma560.addSegment(Segment());
44  puma560.addSegment(Segment());
46  Frame::DH(0.0,-PI_2,0.0,0.0),
47  RigidBodyInertia(0.34,Vector::Zero(),RotationalInertia(.3e-3,.4e-3,.3e-3,0,0,0))));
49  Frame::DH(0.0,0.0,0.0,0.0),
50  RigidBodyInertia(0.09,Vector(0,0,.032),RotationalInertia(.15e-3,0.15e-3,.04e-3,0,0,0))));
51  puma560.addSegment(Segment());
52  return puma560;
53  }
54 
55 }
chain.hpp
KDL::Joint::RotZ
@ RotZ
Definition: joint.hpp:47
KDL::Vector::Zero
static Vector Zero()
Definition: frames.inl:138
utility.h
KDL::RigidBodyInertia
6D Inertia of a rigid body
Definition: rigidbodyinertia.hpp:37
KDL
Definition: kukaLWR_DHnew.cpp:25
KDL::Vector
A concrete implementation of a 3 dimensional vector class.
Definition: frames.hpp:162
KDL::PI_2
const double PI_2
the value of pi/2
Definition: utility.cxx:17
KDL::RotationalInertia
Definition: rotationalinertia.hpp:34
KDL::Puma560
Chain Puma560()
Definition: puma560.cpp:27
KDL::Frame::DH
static Frame DH(double a, double alpha, double d, double theta)
Definition: frames.cpp:95
KDL::Segment
This class encapsulates a simple segment, that is a "rigid body" (i.e., a frame and a rigid body ine...
Definition: segment.hpp:46
KDL::Chain::addSegment
void addSegment(const Segment &segment)
Definition: chain.cpp:53
models.hpp
KDL::Joint
This class encapsulates a simple joint, that is with one parameterized degree of freedom and with sca...
Definition: joint.hpp:45
KDL::Chain
This class encapsulates a serial kinematic interconnection structure. It is built out of segments.
Definition: chain.hpp:35