6 #include <dynamic-graph/factory.h> 14 namespace dg = ::dynamicgraph;
19 "VisualPointProjecter");
33 m_point3DSIN << m_transfoSIN),
36 m_point3DgazeSOUT << m_depthSOUT) {
53 Mi = M.inverse(Eigen::Affine);
54 p3g = Mi.matrix() * p3;
63 const double &z = m_depthSOUT(iter);
74 double &VisualPointProjecter::depthSOUT_function(
double &z,
int iter) {
76 assert(p3.size() == 3);
86 os <<
"VisualPointProjecter " <<
getName();
Eigen::Transform< double, 3, Eigen::Affine > SOT_CORE_EXPORT MatrixHomogeneous
void signalRegistration(const SignalArray< int > &signals)
#define CONSTRUCT_SIGNAL_IN(name, type)
#define sotDEBUGOUT(level)
VisualPointProjecter(const std::string &name)
DYNAMICGRAPH_FACTORY_ENTITY_PLUGIN(FeaturePosture, "FeaturePosture")
#define sotDEBUGIN(level)
virtual void display(std::ostream &os) const
#define CONSTRUCT_SIGNAL_OUT(name, type, dep)
const std::string & getName() const