feature-line-distance.hh

Go to the documentation of this file.

/*
 * Copyright 2010,
 * François Bleibel,
 * Olivier Stasse,
 *
 * CNRS/AIST
 *
 */
 
#ifndef __SOT_FEATURE_LINEDISTANCE_HH__
#define __SOT_FEATURE_LINEDISTANCE_HH__
 
/* --------------------------------------------------------------------- */
/* --- INCLUDE --------------------------------------------------------- */
/* --------------------------------------------------------------------- */
 
/* SOT */
#include <sot/core/exception-task.hh>
#include <sot/core/feature-abstract.hh>
#include <sot/core/matrix-geometry.hh>
/* --------------------------------------------------------------------- */
/* --- API ------------------------------------------------------------- */
/* --------------------------------------------------------------------- */
 
#if defined(WIN32)
#if defined(feature_line_distance_EXPORTS)
#define SOTFEATURELINEDISTANCE_EXPORT __declspec(dllexport)
#else
#define SOTFEATURELINEDISTANCE_EXPORT __declspec(dllimport)
#endif
#else
#define SOTFEATURELINEDISTANCE_EXPORT
#endif
 
/* --------------------------------------------------------------------- */
/* --- CLASS ----------------------------------------------------------- */
/* --------------------------------------------------------------------- */
 
namespace dynamicgraph {
namespace sot {
 
class SOTFEATURELINEDISTANCE_EXPORT FeatureLineDistance
    : public FeatureAbstract {
 public:
  static const std::string CLASS_NAME;
  virtual const std::string &getClassName(void) const { return CLASS_NAME; }
 
 protected:
  /* --- SIGNALS ------------------------------------------------------------ */
 public:
  dynamicgraph::SignalPtr<MatrixHomogeneous, sigtime_t> positionSIN;
  dynamicgraph::SignalPtr<dynamicgraph::Matrix, sigtime_t> articularJacobianSIN;
  dynamicgraph::SignalPtr<dynamicgraph::Vector, sigtime_t> positionRefSIN;
  dynamicgraph::SignalPtr<dynamicgraph::Vector, sigtime_t> vectorSIN;
  dynamicgraph::SignalTimeDependent<dynamicgraph::Vector, sigtime_t> lineSOUT;
 
  using FeatureAbstract::errorSOUT;
  using FeatureAbstract::jacobianSOUT;
  using FeatureAbstract::selectionSIN;
 
  DECLARE_NO_REFERENCE;
 public:
  FeatureLineDistance(const std::string &name);
  virtual ~FeatureLineDistance(void) {}
 
  virtual size_type &getDimension(size_type &dim, sigtime_t time);
 
  virtual dynamicgraph::Vector &computeError(dynamicgraph::Vector &res,
                                             sigtime_t time);
  virtual dynamicgraph::Matrix &computeJacobian(dynamicgraph::Matrix &res,
                                                sigtime_t time);
  dynamicgraph::Vector &computeLineCoordinates(dynamicgraph::Vector &cood,
                                               sigtime_t time);
 
  virtual void display(std::ostream &os) const;
};
 
} /* namespace sot */
} /* namespace dynamicgraph */
 
#endif  // #ifndef __SOT_FEATURE_LINEDISTANCE_HH__
 
/*
 * Local variables:
 * c-basic-offset: 2
 * End:
 */