1 |
|
|
/* |
2 |
|
|
* Copyright 2019 |
3 |
|
|
* Joseph Mirabel |
4 |
|
|
* |
5 |
|
|
* LAAS-CNRS |
6 |
|
|
* |
7 |
|
|
*/ |
8 |
|
|
|
9 |
|
|
/* --------------------------------------------------------------------- */ |
10 |
|
|
/* --- INCLUDE --------------------------------------------------------- */ |
11 |
|
|
/* --------------------------------------------------------------------- */ |
12 |
|
|
|
13 |
|
|
/* --- SOT --- */ |
14 |
|
|
//#define VP_DEBUG |
15 |
|
|
//#define VP_DEBUG_MODE 45 |
16 |
|
|
#include <dynamic-graph/command-bind.h> |
17 |
|
|
#include <dynamic-graph/command-getter.h> |
18 |
|
|
#include <dynamic-graph/command-setter.h> |
19 |
|
|
#include <dynamic-graph/command.h> |
20 |
|
|
|
21 |
|
|
#include <Eigen/LU> |
22 |
|
|
#include <boost/mpl/if.hpp> |
23 |
|
|
#include <boost/type_traits/is_same.hpp> |
24 |
|
|
#include <pinocchio/multibody/liegroup/liegroup.hpp> |
25 |
|
|
#include <sot/core/factory.hh> |
26 |
|
|
#include <sot/core/feature-pose.hh> |
27 |
|
|
#include <sot/core/feature-pose.hxx> |
28 |
|
|
#include <sot/core/macros.hh> |
29 |
|
|
|
30 |
|
|
using namespace dynamicgraph::sot; |
31 |
|
|
|
32 |
|
|
SOT_CORE_DISABLE_WARNING_PUSH |
33 |
|
|
SOT_CORE_DISABLE_WARNING_DEPRECATED |
34 |
|
|
typedef FeaturePose<R3xSO3Representation> FeaturePose_t; |
35 |
|
|
typedef FeaturePose<SE3Representation> FeaturePoseSE3_t; |
36 |
|
|
template <> |
37 |
|
|
DYNAMICGRAPH_FACTORY_ENTITY_PLUGIN(FeaturePose_t, "FeaturePose"); |
38 |
|
|
template <> |
39 |
|
|
DYNAMICGRAPH_FACTORY_ENTITY_PLUGIN(FeaturePoseSE3_t, "FeaturePoseSE3"); |
40 |
|
|
SOT_CORE_DISABLE_WARNING_POP |
41 |
|
|
|
42 |
|
|
namespace dynamicgraph { |
43 |
|
|
namespace sot { |
44 |
|
|
template class FeaturePose<R3xSO3Representation>; |
45 |
|
|
template class FeaturePose<SE3Representation>; |
46 |
|
|
} // namespace sot |
47 |
|
|
} // namespace dynamicgraph |