feature-posture.hh

Go to the documentation of this file.

/*
 * Copyright 2010,
 * Florent Lamiraux
 * Thomas Moulard,
 *
 * CNRS/AIST
 *
 */

#ifndef SOT_CORE_FEATURE_POSTURE_HH
#define SOT_CORE_FEATURE_POSTURE_HH

#include <dynamic-graph/signal-ptr.h>
#include <dynamic-graph/signal-time-dependent.h>
#include <dynamic-graph/value.h>

#include "sot/core/api.hh"
#include "sot/core/feature-abstract.hh"
/* --------------------------------------------------------------------- */
/* --- API ------------------------------------------------------------- */
/* --------------------------------------------------------------------- */

#if defined(WIN32)
#if defined(feature_posture_EXPORTS)
#define SOTFEATUREPOSTURE_EXPORT __declspec(dllexport)
#else
#define SOTFEATUREPOSTURE_EXPORT __declspec(dllimport)
#endif
#else
#define SOTFEATUREPOSTURE_EXPORT
#endif

namespace dynamicgraph {
namespace sot {
using command::Command;
using command::Value;

class SOTFEATUREPOSTURE_EXPORT FeaturePosture : public FeatureAbstract {
  class SelectDof;
  friend class SelectDof;

  DYNAMIC_GRAPH_ENTITY_DECL();

 public:
  typedef dynamicgraph::SignalPtr<dynamicgraph::Vector, int> signalIn_t;
  typedef dynamicgraph::SignalTimeDependent<dynamicgraph::Vector, int>
      signalOut_t;

  DECLARE_NO_REFERENCE;

  explicit FeaturePosture(const std::string &name);
  virtual ~FeaturePosture();
  virtual unsigned int &getDimension(unsigned int &res, int);
  void selectDof(unsigned dofId, bool control);

 protected:
  virtual dynamicgraph::Vector &computeError(dynamicgraph::Vector &res, int);
  virtual dynamicgraph::Matrix &computeJacobian(dynamicgraph::Matrix &res, int);
  virtual dynamicgraph::Vector &computeErrorDot(dynamicgraph::Vector &res,
                                                int time);

  signalIn_t state_;
  signalIn_t posture_;
  signalIn_t postureDot_;
  signalOut_t error_;

 private:
  std::vector<bool> activeDofs_;
  std::size_t nbActiveDofs_;
};  // class FeaturePosture
}  // namespace sot
}  // namespace dynamicgraph

#endif  // SOT_CORE_FEATURE_POSTURE_HH