custom_entity.cpp

Go to the documentation of this file.

/* Copyright 2010-2019 LAAS, CNRS
 * Thomas Moulard.
 *
 */

#define ENABLE_RT_LOG

#include "custom_entity.h"

#include <dynamic-graph/command-bind.h>
#include <dynamic-graph/entity.h>
#include <dynamic-graph/exception-factory.h>
#include <dynamic-graph/factory.h>
#include <dynamic-graph/pool.h>
#include <dynamic-graph/real-time-logger.h>
#include <dynamic-graph/signal-ptr.h>
#include <dynamic-graph/signal-time-dependent.h>

#include <boost/bind.hpp>

namespace dynamicgraph {

CustomEntity::CustomEntity(const std::string n)
    : Entity(n),
      m_sigdSIN(NULL, "CustomEntity(" + name + ")::input(double)::in_double"),
      m_sigdTimeDepSOUT(boost::bind(&CustomEntity::update, this, _1, _2),
                        m_sigdSIN,
                        "CustomEntity(" + name + ")::input(double)::out_double")

{
  addSignal();

  using namespace dynamicgraph::command;

  this->addCommand("act",
                   makeCommandVoid0(*this, &CustomEntity::act,
                                    docCommandVoid0("act on input signal")));
}

void CustomEntity::addSignal() {
  signalRegistration(m_sigdSIN << m_sigdTimeDepSOUT);
}

void CustomEntity::rmValidSignal() {
  signalDeregistration("in_double");
  signalDeregistration("out_double");
}

double &CustomEntity::update(double &res, const int &inTime) {
  const double &aDouble = m_sigdSIN(inTime);
  res = aDouble;
  logger().stream(MSG_TYPE_ERROR) << "start update " << res << '\n';
  DYNAMIC_GRAPH_ENTITY_DEBUG(*this)
      << "This is a message of level MSG_TYPE_DEBUG\n";
  DYNAMIC_GRAPH_ENTITY_INFO(*this)
      << "This is a message of level MSG_TYPE_INFO\n";
  DYNAMIC_GRAPH_ENTITY_WARNING(*this)
      << "This is a message of level MSG_TYPE_WARNING\n";
  DYNAMIC_GRAPH_ENTITY_ERROR(*this)
      << "This is a message of level MSG_TYPE_ERROR\n";
  DYNAMIC_GRAPH_ENTITY_DEBUG_STREAM(*this)
      << "This is a message of level MSG_TYPE_DEBUG_STREAM\n";
  DYNAMIC_GRAPH_ENTITY_INFO_STREAM(*this)
      << "This is a message of level MSG_TYPE_INFO_STREAM\n";
  DYNAMIC_GRAPH_ENTITY_WARNING_STREAM(*this)
      << "This is a message of level MSG_TYPE_WARNING_STREAM\n";
  DYNAMIC_GRAPH_ENTITY_ERROR_STREAM(*this)
      << "This is a message of level MSG_TYPE_ERROR_STREAM\n";
  logger().stream(MSG_TYPE_ERROR) << "end update\n";
  return res;
}

void CustomEntity::act() { m_sigdSIN.accessCopy(); }

DYNAMICGRAPH_FACTORY_ENTITY_PLUGIN(CustomEntity, "CustomEntity");
}  // namespace dynamicgraph