hpp-pinocchio  6.1.0
Wrapping of the kinematic/dynamic chain Pinocchio for HPP.
fwd.hh
Go to the documentation of this file.
1 //
2 // Copyright (c) 2016 CNRS
3 // Author: NMansard, Joseph Mirabel from Florent Lamiraux
4 //
5 //
6 
7 // Redistribution and use in source and binary forms, with or without
8 // modification, are permitted provided that the following conditions are
9 // met:
10 //
11 // 1. Redistributions of source code must retain the above copyright
12 // notice, this list of conditions and the following disclaimer.
13 //
14 // 2. Redistributions in binary form must reproduce the above copyright
15 // notice, this list of conditions and the following disclaimer in the
16 // documentation and/or other materials provided with the distribution.
17 //
18 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
19 // "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
20 // LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
21 // A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
22 // HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
23 // SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
24 // LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25 // DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26 // THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
28 // OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
29 // DAMAGE.
30 
31 #ifndef HPP_PINOCCHIO_FWD_HH
32 #define HPP_PINOCCHIO_FWD_HH
33 
34 #ifndef PINOCCHIO_WITH_HPP_FCL
35 #error "hpp-fcl support in Pinocchio is mandatory."
36 #endif
37 
38 #include <coal/collision_data.h> // DistanceResult
39 
40 #include <Eigen/Core>
41 #include <coal/fwd.hh>
43 #include <hpp/util/pointer.hh>
44 #include <pinocchio/multibody/fwd.hpp>
45 #include <pinocchio/multibody/joint/fwd.hpp>
46 #include <pinocchio/spatial/fwd.hpp>
47 #include <vector>
48 
49 namespace hpp {
50 namespace pinocchio {
51 typedef double value_type;
52 
58 HPP_PREDEF_CLASS(JointConfiguration);
61 class Frame;
62 class AbstractDevice;
63 class DeviceSync;
64 struct DeviceData;
65 
67 enum InOutType { INNER, OUTER };
68 
69 // Pinocchio typedefs
70 
71 typedef ::pinocchio::JointCollectionDefaultTpl<value_type, 0> JointCollection;
75 typedef ::pinocchio::ModelTpl<value_type, 0,
76  ::pinocchio::JointCollectionDefaultTpl>
78 typedef ::pinocchio::DataTpl<value_type, 0,
79  ::pinocchio::JointCollectionDefaultTpl>
81 typedef ::pinocchio::GeometryModel GeomModel;
82 typedef ::pinocchio::GeometryData GeomData;
85 typedef ::pinocchio::JointModelTpl<value_type, 0,
86  ::pinocchio::JointCollectionDefaultTpl>
88 
89 typedef Eigen::Array<bool, Eigen::Dynamic, 1> ArrayXb;
90 
91 typedef Eigen::Matrix<value_type, Eigen::Dynamic, 1> vector_t;
93 typedef Eigen::Ref<const Configuration_t> ConfigurationIn_t;
94 typedef Eigen::Ref<Configuration_t> ConfigurationOut_t;
95 typedef shared_ptr<Configuration_t> ConfigurationPtr_t HPP_PINOCCHIO_DEPRECATED;
96 typedef Eigen::Ref<const vector_t> vectorIn_t;
97 typedef Eigen::Ref<vector_t> vectorOut_t;
98 typedef Eigen::Matrix<value_type, Eigen::Dynamic, Eigen::Dynamic> matrix_t;
99 typedef Eigen::Ref<matrix_t> matrixOut_t;
100 typedef matrix_t::Index size_type;
101 typedef Eigen::Matrix<value_type, 3, 3> matrix3_t;
102 typedef Eigen::Matrix<value_type, 3, 1> vector3_t;
103 typedef Eigen::Matrix<value_type, 4, 1> vector4_t;
104 typedef Eigen::Matrix<value_type, 6, Eigen::Dynamic> JointJacobian_t;
105 typedef Eigen::Matrix<value_type, 3, Eigen::Dynamic> ComJacobian_t;
106 typedef Eigen::Block<JointJacobian_t, 3, Eigen::Dynamic> HalfJointJacobian_t;
107 
108 struct JointVector;
109 typedef JointVector JointVector_t;
110 struct ObjectVector;
111 typedef ObjectVector ObjectVector_t;
112 typedef shared_ptr<Body> BodyPtr_t;
113 typedef shared_ptr<const Body> BodyConstPtr_t;
114 using coal::CollisionGeometry;
115 typedef shared_ptr<CollisionGeometry> CollisionGeometryPtr_t;
116 typedef coal::CollisionObject FclCollisionObject;
117 typedef coal::CollisionObject* FclCollisionObjectPtr_t;
118 typedef const coal::CollisionObject* FclConstCollisionObjectPtr_t;
119 typedef shared_ptr<CollisionObject> CollisionObjectPtr_t;
120 typedef shared_ptr<const CollisionObject> CollisionObjectConstPtr_t;
121 typedef shared_ptr<Device> DevicePtr_t;
122 typedef shared_ptr<const Device> DeviceConstPtr_t;
123 typedef std::vector<coal::DistanceResult> DistanceResults_t;
124 typedef shared_ptr<HumanoidRobot> HumanoidRobotPtr_t;
125 typedef shared_ptr<CenterOfMassComputation> CenterOfMassComputationPtr_t;
126 typedef shared_ptr<Joint> JointPtr_t;
127 typedef shared_ptr<const Joint> JointConstPtr_t;
128 typedef shared_ptr<Gripper> GripperPtr_t;
129 typedef std::vector<GripperPtr_t> Grippers_t;
130 
131 typedef shared_ptr<Model> ModelPtr_t;
132 typedef shared_ptr<const Model> ModelConstPtr_t;
133 typedef shared_ptr<Data> DataPtr_t;
134 typedef shared_ptr<const Data> DataConstPtr_t;
135 
136 typedef shared_ptr<GeomModel> GeomModelPtr_t;
137 typedef shared_ptr<const GeomModel> GeomModelConstPtr_t;
138 typedef shared_ptr<GeomData> GeomDataPtr_t;
139 typedef shared_ptr<const GeomData> GeomDataConstPtr_t;
140 
141 template <typename vector_type>
143 template <typename vector_type>
144 class LiegroupElementBase;
151 
153 typedef shared_ptr<LiegroupSpace> LiegroupSpacePtr_t;
154 typedef shared_ptr<const LiegroupSpace> LiegroupSpaceConstPtr_t;
155 } // namespace pinocchio
156 } // namespace hpp
157 #endif // HPP_PINOCCHIO_FWD_HH
Abstract class representing a Device.
Definition: device-sync.hh:41
Definition: body.hh:51
Definition: center-of-mass-computation.hh:52
Definition: collision-object.hh:52
Definition: device-sync.hh:228
Robot with geometric and dynamic pinocchio.
Definition: device.hh:60
Robot frame.
Definition: frame.hh:42
Definition: gripper.hh:48
Humanoid robot.
Definition: humanoid-robot.hh:44
Definition: joint.hh:57
Definition: liegroup-element.hh:117
Definition: liegroup-element.hh:45
Definition: liegroup-space.hh:101
Eigen::Block< JointJacobian_t, 3, Eigen::Dynamic > HalfJointJacobian_t
Definition: fwd.hh:106
shared_ptr< Device > DevicePtr_t
Definition: fwd.hh:121
shared_ptr< CollisionGeometry > CollisionGeometryPtr_t
Definition: fwd.hh:115
shared_ptr< CenterOfMassComputation > CenterOfMassComputationPtr_t
Definition: fwd.hh:125
LiegroupElementBase< vector_t > LiegroupElement
Element of a Lie group.
Definition: fwd.hh:148
shared_ptr< const GeomData > GeomDataConstPtr_t
Definition: fwd.hh:139
shared_ptr< const CollisionObject > CollisionObjectConstPtr_t
Definition: fwd.hh:120
::pinocchio::DataTpl< value_type, 0, ::pinocchio::JointCollectionDefaultTpl > Data
Definition: fwd.hh:80
Request_t
Definition: fwd.hh:66
@ COLLISION
Definition: fwd.hh:66
@ DISTANCE
Definition: fwd.hh:66
Eigen::Ref< matrix_t > matrixOut_t
Definition: fwd.hh:99
shared_ptr< Joint > JointPtr_t
Definition: fwd.hh:126
shared_ptr< GeomModel > GeomModelPtr_t
Definition: fwd.hh:136
ObjectVector ObjectVector_t
Definition: fwd.hh:110
coal::CollisionObject FclCollisionObject
Definition: fwd.hh:116
::pinocchio::GeometryData GeomData
Definition: fwd.hh:82
Eigen::Matrix< value_type, Eigen::Dynamic, 1 > vector_t
Definition: fwd.hh:91
shared_ptr< HumanoidRobot > HumanoidRobotPtr_t
Definition: fwd.hh:124
::pinocchio::FrameIndex FrameIndex
Definition: fwd.hh:73
Eigen::Ref< vector_t > vectorOut_t
Definition: fwd.hh:97
shared_ptr< const Data > DataConstPtr_t
Definition: fwd.hh:134
shared_ptr< Configuration_t > ConfigurationPtr_t HPP_PINOCCHIO_DEPRECATED
Definition: fwd.hh:95
shared_ptr< const LiegroupSpace > LiegroupSpaceConstPtr_t
Definition: fwd.hh:154
shared_ptr< GeomData > GeomDataPtr_t
Definition: fwd.hh:138
Eigen::Matrix< value_type, 3, 1 > vector3_t
Definition: fwd.hh:102
Eigen::Matrix< value_type, Eigen::Dynamic, Eigen::Dynamic > matrix_t
Definition: fwd.hh:98
LiegroupElementBase< vectorOut_t > LiegroupElementRef
Writable reference to a LiegroupElement.
Definition: fwd.hh:150
InOutType
Definition: fwd.hh:67
@ OUTER
Definition: fwd.hh:67
@ INNER
Definition: fwd.hh:67
shared_ptr< LiegroupSpace > LiegroupSpacePtr_t
Definition: fwd.hh:153
::pinocchio::GeomIndex GeomIndex
Definition: fwd.hh:74
matrix_t::Index size_type
Definition: fwd.hh:100
shared_ptr< const Model > ModelConstPtr_t
Definition: fwd.hh:132
Eigen::Matrix< value_type, 6, Eigen::Dynamic > JointJacobian_t
Definition: fwd.hh:104
shared_ptr< Body > BodyPtr_t
Definition: fwd.hh:112
::pinocchio::SE3 Transform3s
Definition: fwd.hh:83
Eigen::Ref< Configuration_t > ConfigurationOut_t
Definition: fwd.hh:94
double value_type
Definition: fwd.hh:51
vector_t Configuration_t
Definition: fwd.hh:92
::pinocchio::JointCollectionDefaultTpl< value_type, 0 > JointCollection
Definition: fwd.hh:71
std::vector< GripperPtr_t > Grippers_t
Definition: fwd.hh:129
::pinocchio::JointModelTpl< value_type, 0, ::pinocchio::JointCollectionDefaultTpl > JointModel
Definition: fwd.hh:87
::pinocchio::JointIndex JointIndex
Definition: fwd.hh:72
Eigen::Matrix< value_type, 3, 3 > matrix3_t
Definition: fwd.hh:101
HPP_PREDEF_CLASS(Body)
shared_ptr< const Joint > JointConstPtr_t
Definition: fwd.hh:127
::pinocchio::GeometryModel GeomModel
Definition: fwd.hh:81
shared_ptr< const GeomModel > GeomModelConstPtr_t
Definition: fwd.hh:137
JointVector JointVector_t
Definition: fwd.hh:108
Eigen::Array< bool, Eigen::Dynamic, 1 > ArrayXb
Definition: fwd.hh:89
::pinocchio::ModelTpl< value_type, 0, ::pinocchio::JointCollectionDefaultTpl > Model
Definition: fwd.hh:77
Eigen::Matrix< value_type, 3, Eigen::Dynamic > ComJacobian_t
Definition: fwd.hh:105
const coal::CollisionObject * FclConstCollisionObjectPtr_t
Definition: fwd.hh:118
shared_ptr< const Device > DeviceConstPtr_t
Definition: fwd.hh:122
shared_ptr< const Body > BodyConstPtr_t
Definition: fwd.hh:113
shared_ptr< Gripper > GripperPtr_t
Definition: fwd.hh:128
shared_ptr< Model > ModelPtr_t
Definition: fwd.hh:131
Eigen::Ref< const vector_t > vectorIn_t
Definition: fwd.hh:96
coal::CollisionObject * FclCollisionObjectPtr_t
Definition: fwd.hh:117
LiegroupElementConstBase< vectorIn_t > LiegroupElementConstRef
Const reference to a LiegroupElement.
Definition: fwd.hh:144
std::vector< coal::DistanceResult > DistanceResults_t
Definition: fwd.hh:123
shared_ptr< CollisionObject > CollisionObjectPtr_t
Definition: fwd.hh:119
::pinocchio::SE3 SE3
Definition: fwd.hh:84
Eigen::Matrix< value_type, 4, 1 > vector4_t
Definition: fwd.hh:103
shared_ptr< Data > DataPtr_t
Definition: fwd.hh:133
Eigen::Ref< const Configuration_t > ConfigurationIn_t
Definition: fwd.hh:93
Utility functions.
Definition: collision-object.hh:40
Definition: device-data.hh:51