OMPLDynamicReconfigureConfig.h

Go to the documentation of this file.

/*********************************************************************
 * Software License Agreement (BSD License)
 *
 *  Copyright (c) 2008, Willow Garage, Inc.
 *  All rights reserved.
 *
 *  Redistribution and use in source and binary forms, with or without
 *  modification, are permitted provided that the following conditions
 *  are met:
 *
 *   * Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *   * Redistributions in binary form must reproduce the above
 *     copyright notice, this list of conditions and the following
 *     disclaimer in the documentation and/or other materials provided
 *     with the distribution.
 *   * Neither the name of Willow Garage nor the names of its
 *     contributors may be used to endorse or promote products derived
 *     from this software without specific prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 *  "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 *  LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
 *  FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
 *  COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
 *  BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 *  LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
 *  CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 *  LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
 *  ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 *  POSSIBILITY OF SUCH DAMAGE.
 *********************************************************************/

//#line 2 "/opt/ros/fuerte/stacks/dynamic_reconfigure/templates/ConfigType.h"
// *********************************************************
//
// File autogenerated for the ompl_interface_ros package
// by the dynamic_reconfigure package.
// Please do not edit.
//
// ********************************************************/

// Author: Blaise Gassend

#ifndef __ompl_interface_ros__OMPLDYNAMICRECONFIGURECONFIG_H__
#define __ompl_interface_ros__OMPLDYNAMICRECONFIGURECONFIG_H__

#include <dynamic_reconfigure/config_tools.h>
#include <moveit/macros/class_forward.h>
#include <limits>
#include <ros/node_handle.h>
#include <dynamic_reconfigure/ConfigDescription.h>
#include <dynamic_reconfigure/ParamDescription.h>
#include <dynamic_reconfigure/Group.h>
#include <dynamic_reconfigure/config_init_mutex.h>
#include <boost/any.hpp>

namespace ompl_interface_ros
{
class OMPLDynamicReconfigureConfigStatics;

class OMPLDynamicReconfigureConfig
{
public:
  MOVEIT_CLASS_FORWARD(AbstractParamDescription);
  class AbstractParamDescription : public dynamic_reconfigure::ParamDescription
  {
  public:
    AbstractParamDescription(std::string n, std::string t, uint32_t l, std::string d, std::string e)
    {
      name = n;
      type = t;
      level = l;
      description = d;
      edit_method = e;
    }

    virtual void clamp(OMPLDynamicReconfigureConfig& config, const OMPLDynamicReconfigureConfig& max,
                       const OMPLDynamicReconfigureConfig& min) const = 0;
    virtual void calcLevel(uint32_t& level, const OMPLDynamicReconfigureConfig& config1,
                           const OMPLDynamicReconfigureConfig& config2) const = 0;
    virtual void fromServer(const ros::NodeHandle& nh, OMPLDynamicReconfigureConfig& config) const = 0;
    virtual void toServer(const ros::NodeHandle& nh, const OMPLDynamicReconfigureConfig& config) const = 0;
    virtual bool fromMessage(const dynamic_reconfigure::Config& msg, OMPLDynamicReconfigureConfig& config) const = 0;
    virtual void toMessage(dynamic_reconfigure::Config& msg, const OMPLDynamicReconfigureConfig& config) const = 0;
    virtual void getValue(const OMPLDynamicReconfigureConfig& config, boost::any& val) const = 0;
  };

  template <class T>
  class ParamDescription : public AbstractParamDescription
  {
  public:
    ParamDescription(std::string name, std::string type, uint32_t level, std::string description,
                     std::string edit_method, T OMPLDynamicReconfigureConfig::*f)
      : AbstractParamDescription(name, type, level, description, edit_method), field(f)
    {
    }

    T(OMPLDynamicReconfigureConfig::*field);

    virtual void clamp(OMPLDynamicReconfigureConfig& config, const OMPLDynamicReconfigureConfig& max,
                       const OMPLDynamicReconfigureConfig& min) const
    {
      if (config.*field > max.*field)
        config.*field = max.*field;

      if (config.*field < min.*field)
        config.*field = min.*field;
    }

    virtual void calcLevel(uint32_t& comb_level, const OMPLDynamicReconfigureConfig& config1,
                           const OMPLDynamicReconfigureConfig& config2) const
    {
      if (config1.*field != config2.*field)
        comb_level |= level;
    }

    virtual void fromServer(const ros::NodeHandle& nh, OMPLDynamicReconfigureConfig& config) const
    {
      nh.getParam(name, config.*field);
    }

    virtual void toServer(const ros::NodeHandle& nh, const OMPLDynamicReconfigureConfig& config) const
    {
      nh.setParam(name, config.*field);
    }

    virtual bool fromMessage(const dynamic_reconfigure::Config& msg, OMPLDynamicReconfigureConfig& config) const
    {
      return dynamic_reconfigure::ConfigTools::getParameter(msg, name, config.*field);
    }

    virtual void toMessage(dynamic_reconfigure::Config& msg, const OMPLDynamicReconfigureConfig& config) const
    {
      dynamic_reconfigure::ConfigTools::appendParameter(msg, name, config.*field);
    }

    virtual void getValue(const OMPLDynamicReconfigureConfig& config, boost::any& val) const
    {
      val = config.*field;
    }
  };

  MOVEIT_CLASS_FORWARD(AbstractGroupDescription);
  class AbstractGroupDescription : public dynamic_reconfigure::Group
  {
  public:
    AbstractGroupDescription(std::string n, std::string t, int p, int i, bool s)
    {
      name = n;
      type = t;
      parent = p;
      state = s;
      id = i;
    }

    std::vector<AbstractParamDescriptionConstPtr> abstract_parameters;
    bool state;

    virtual void toMessage(dynamic_reconfigure::Config& msg, const boost::any& config) const = 0;
    virtual bool fromMessage(const dynamic_reconfigure::Config& msg, boost::any& config) const = 0;
    virtual void updateParams(boost::any& cfg, OMPLDynamicReconfigureConfig& top) const = 0;
    virtual void setInitialState(boost::any& cfg) const = 0;

    void convertParams()
    {
      for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = abstract_parameters.begin();
           i != abstract_parameters.end(); i++)
      {
        parameters.push_back(dynamic_reconfigure::ParamDescription(**i));
      }
    }
  };

  template <class T, class PT>
  class GroupDescription : public AbstractGroupDescription
  {
  public:
    GroupDescription(std::string name, std::string type, int parent, int id, bool s, T PT::*f)
      : AbstractGroupDescription(name, type, parent, id, s), field(f)
    {
    }

    GroupDescription(const GroupDescription<T, PT>& g)
      : AbstractGroupDescription(g.name, g.type, g.parent, g.id, g.state), field(g.field), groups(g.groups)
    {
      parameters = g.parameters;
      abstract_parameters = g.abstract_parameters;
    }

    virtual bool fromMessage(const dynamic_reconfigure::Config& msg, boost::any& cfg) const
    {
      PT* config = boost::any_cast<PT*>(cfg);
      if (!dynamic_reconfigure::ConfigTools::getGroupState(msg, name, (*config).*field))
        return false;

      for (std::vector<AbstractGroupDescriptionConstPtr>::const_iterator i = groups.begin(); i != groups.end(); i++)
      {
        boost::any n = &((*config).*field);
        if (!(*i)->fromMessage(msg, n))
          return false;
      }

      return true;
    }

    virtual void setInitialState(boost::any& cfg) const
    {
      PT* config = boost::any_cast<PT*>(cfg);
      T* group = &((*config).*field);
      group->state = state;

      for (std::vector<AbstractGroupDescriptionConstPtr>::const_iterator i = groups.begin(); i != groups.end(); i++)
      {
        boost::any n = boost::any(&((*config).*field));
        (*i)->setInitialState(n);
      }
    }

    virtual void updateParams(boost::any& cfg, OMPLDynamicReconfigureConfig& top) const
    {
      PT* config = boost::any_cast<PT*>(cfg);

      T* f = &((*config).*field);
      f->setParams(top, abstract_parameters);

      for (std::vector<AbstractGroupDescriptionConstPtr>::const_iterator i = groups.begin(); i != groups.end(); i++)
      {
        boost::any n = &((*config).*field);
        (*i)->updateParams(n, top);
      }
    }

    virtual void toMessage(dynamic_reconfigure::Config& msg, const boost::any& cfg) const
    {
      const PT config = boost::any_cast<PT>(cfg);
      dynamic_reconfigure::ConfigTools::appendGroup<T>(msg, name, id, parent, config.*field);

      for (std::vector<AbstractGroupDescriptionConstPtr>::const_iterator i = groups.begin(); i != groups.end(); i++)
      {
        (*i)->toMessage(msg, config.*field);
      }
    }

    T(PT::*field);
    std::vector<OMPLDynamicReconfigureConfig::AbstractGroupDescriptionConstPtr> groups;
  };

  class DEFAULT
  {
  public:
    DEFAULT()
    {
      state = true;
      name = "Default";
    }

    void setParams(OMPLDynamicReconfigureConfig& config, const std::vector<AbstractParamDescriptionConstPtr> params)
    {
      for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = params.begin(); i != params.end(); i++)
      {
        boost::any val;
        (*i)->getValue(config, val);

        if ("link_for_exploration_tree" == (*i)->name)
        {
          link_for_exploration_tree = boost::any_cast<std::string>(val);
        }
      }
    }

    std::string link_for_exploration_tree;

    bool state;
    std::string name;

  } groups;

  //#line 259 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
  std::string link_for_exploration_tree;
  //#line 255 "/opt/ros/fuerte/stacks/dynamic_reconfigure/templates/ConfigType.h"

  bool __fromMessage__(dynamic_reconfigure::Config& msg)
  {
    const std::vector<AbstractParamDescriptionConstPtr>& __param_descriptions__ = __getParamDescriptions__();
    const std::vector<AbstractGroupDescriptionConstPtr>& __group_descriptions__ = __getGroupDescriptions__();

    int count = 0;
    for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = __param_descriptions__.begin();
         i != __param_descriptions__.end(); i++)
      if ((*i)->fromMessage(msg, *this))
        count++;

    for (std::vector<AbstractGroupDescriptionConstPtr>::const_iterator i = __group_descriptions__.begin();
         i != __group_descriptions__.end(); i++)
    {
      if ((*i)->id == 0)
      {
        boost::any n = boost::any(this);
        (*i)->updateParams(n, *this);
        (*i)->fromMessage(msg, n);
      }
    }

    if (count != dynamic_reconfigure::ConfigTools::size(msg))
    {
      ROS_ERROR("OMPLDynamicReconfigureConfig::__fromMessage__ called with an unexpected parameter.");
      ROS_ERROR("Booleans:");
      for (unsigned int i = 0; i < msg.bools.size(); i++)
        ROS_ERROR("  %s", msg.bools[i].name.c_str());
      ROS_ERROR("Integers:");
      for (unsigned int i = 0; i < msg.ints.size(); i++)
        ROS_ERROR("  %s", msg.ints[i].name.c_str());
      ROS_ERROR("Doubles:");
      for (unsigned int i = 0; i < msg.doubles.size(); i++)
        ROS_ERROR("  %s", msg.doubles[i].name.c_str());
      ROS_ERROR("Strings:");
      for (unsigned int i = 0; i < msg.strs.size(); i++)
        ROS_ERROR("  %s", msg.strs[i].name.c_str());
      // @todo Check that there are no duplicates. Make this error more
      // explicit.
      return false;
    }
    return true;
  }

  // This version of __toMessage__ is used during initialization of
  // statics when __getParamDescriptions__ can't be called yet.
  void __toMessage__(dynamic_reconfigure::Config& msg,
                     const std::vector<AbstractParamDescriptionConstPtr>& __param_descriptions__,
                     const std::vector<AbstractGroupDescriptionConstPtr>& __group_descriptions__) const
  {
    dynamic_reconfigure::ConfigTools::clear(msg);
    for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = __param_descriptions__.begin();
         i != __param_descriptions__.end(); i++)
      (*i)->toMessage(msg, *this);

    for (std::vector<AbstractGroupDescriptionConstPtr>::const_iterator i = __group_descriptions__.begin();
         i != __group_descriptions__.end(); i++)
    {
      if ((*i)->id == 0)
      {
        (*i)->toMessage(msg, *this);
      }
    }
  }

  void __toMessage__(dynamic_reconfigure::Config& msg) const
  {
    const std::vector<AbstractParamDescriptionConstPtr>& __param_descriptions__ = __getParamDescriptions__();
    const std::vector<AbstractGroupDescriptionConstPtr>& __group_descriptions__ = __getGroupDescriptions__();
    __toMessage__(msg, __param_descriptions__, __group_descriptions__);
  }

  void __toServer__(const ros::NodeHandle& nh) const
  {
    const std::vector<AbstractParamDescriptionConstPtr>& __param_descriptions__ = __getParamDescriptions__();
    for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = __param_descriptions__.begin();
         i != __param_descriptions__.end(); i++)
      (*i)->toServer(nh, *this);
  }

  void __fromServer__(const ros::NodeHandle& nh)
  {
    static bool setup = false;

    const std::vector<AbstractParamDescriptionConstPtr>& __param_descriptions__ = __getParamDescriptions__();
    for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = __param_descriptions__.begin();
         i != __param_descriptions__.end(); i++)
      (*i)->fromServer(nh, *this);

    const std::vector<AbstractGroupDescriptionConstPtr>& __group_descriptions__ = __getGroupDescriptions__();
    for (std::vector<AbstractGroupDescriptionConstPtr>::const_iterator i = __group_descriptions__.begin();
         i != __group_descriptions__.end(); i++)
    {
      if (!setup && (*i)->id == 0)
      {
        setup = true;
        boost::any n = boost::any(this);
        (*i)->setInitialState(n);
      }
    }
  }

  void __clamp__()
  {
    const std::vector<AbstractParamDescriptionConstPtr>& __param_descriptions__ = __getParamDescriptions__();
    const OMPLDynamicReconfigureConfig& __max__ = __getMax__();
    const OMPLDynamicReconfigureConfig& __min__ = __getMin__();
    for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = __param_descriptions__.begin();
         i != __param_descriptions__.end(); i++)
      (*i)->clamp(*this, __max__, __min__);
  }

  uint32_t __level__(const OMPLDynamicReconfigureConfig& config) const
  {
    const std::vector<AbstractParamDescriptionConstPtr>& __param_descriptions__ = __getParamDescriptions__();
    uint32_t level = 0;
    for (std::vector<AbstractParamDescriptionConstPtr>::const_iterator i = __param_descriptions__.begin();
         i != __param_descriptions__.end(); i++)
      (*i)->calcLevel(level, config, *this);
    return level;
  }

  static const dynamic_reconfigure::ConfigDescription& __getDescriptionMessage__();
  static const OMPLDynamicReconfigureConfig& __getDefault__();
  static const OMPLDynamicReconfigureConfig& __getMax__();
  static const OMPLDynamicReconfigureConfig& __getMin__();
  static const std::vector<AbstractParamDescriptionConstPtr>& __getParamDescriptions__();
  static const std::vector<AbstractGroupDescriptionConstPtr>& __getGroupDescriptions__();

private:
  static const OMPLDynamicReconfigureConfigStatics* __get_statics__();
};

template <>  // Max and min are ignored for strings.
inline void
OMPLDynamicReconfigureConfig::ParamDescription<std::string>::clamp(OMPLDynamicReconfigureConfig& config,
                                                                   const OMPLDynamicReconfigureConfig& max,
                                                                   const OMPLDynamicReconfigureConfig& min) const
{
  return;
}

class OMPLDynamicReconfigureConfigStatics
{
  friend class OMPLDynamicReconfigureConfig;

  OMPLDynamicReconfigureConfigStatics()
  {
    OMPLDynamicReconfigureConfig::GroupDescription<OMPLDynamicReconfigureConfig::DEFAULT, OMPLDynamicReconfigureConfig>
        Default("Default", "", 0, 0, true, &OMPLDynamicReconfigureConfig::groups);
    //#line 259 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
    __min__.link_for_exploration_tree = "";
    //#line 259 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
    __max__.link_for_exploration_tree = "";
    //#line 259 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
    __default__.link_for_exploration_tree = "";
    //#line 259 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
    Default.abstract_parameters.push_back(OMPLDynamicReconfigureConfig::AbstractParamDescriptionConstPtr(
        new OMPLDynamicReconfigureConfig::ParamDescription<std::string>(
            "link_for_exploration_tree", "str", 1, "Show the exploration tree for a particular link", "",
            &OMPLDynamicReconfigureConfig::link_for_exploration_tree)));
    //#line 259 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
    __param_descriptions__.push_back(OMPLDynamicReconfigureConfig::AbstractParamDescriptionConstPtr(
        new OMPLDynamicReconfigureConfig::ParamDescription<std::string>(
            "link_for_exploration_tree", "str", 1, "Show the exploration tree for a particular link", "",
            &OMPLDynamicReconfigureConfig::link_for_exploration_tree)));
    //#line 233 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
    Default.convertParams();
    //#line 233 "/opt/ros/fuerte/stacks/dynamic_reconfigure/src/dynamic_reconfigure/parameter_generator.py"
    __group_descriptions__.push_back(OMPLDynamicReconfigureConfig::AbstractGroupDescriptionConstPtr(
        new OMPLDynamicReconfigureConfig::GroupDescription<OMPLDynamicReconfigureConfig::DEFAULT,
                                                           OMPLDynamicReconfigureConfig>(Default)));
    //#line 390 "/opt/ros/fuerte/stacks/dynamic_reconfigure/templates/ConfigType.h"

    for (std::vector<OMPLDynamicReconfigureConfig::AbstractGroupDescriptionConstPtr>::const_iterator i =
             __group_descriptions__.begin();
         i != __group_descriptions__.end(); i++)
    {
      __description_message__.groups.push_back(**i);
    }
    __max__.__toMessage__(__description_message__.max, __param_descriptions__, __group_descriptions__);
    __min__.__toMessage__(__description_message__.min, __param_descriptions__, __group_descriptions__);
    __default__.__toMessage__(__description_message__.dflt, __param_descriptions__, __group_descriptions__);
  }
  std::vector<OMPLDynamicReconfigureConfig::AbstractParamDescriptionConstPtr> __param_descriptions__;
  std::vector<OMPLDynamicReconfigureConfig::AbstractGroupDescriptionConstPtr> __group_descriptions__;
  OMPLDynamicReconfigureConfig __max__;
  OMPLDynamicReconfigureConfig __min__;
  OMPLDynamicReconfigureConfig __default__;
  dynamic_reconfigure::ConfigDescription __description_message__;

  static const OMPLDynamicReconfigureConfigStatics* get_instance()
  {
    // Split this off in a separate function because I know that
    // instance will get initialized the first time get_instance is
    // called, and I am guaranteeing that get_instance gets called at
    // most once.
    static OMPLDynamicReconfigureConfigStatics instance;
    return &instance;
  }
};

inline const dynamic_reconfigure::ConfigDescription& OMPLDynamicReconfigureConfig::__getDescriptionMessage__()
{
  return __get_statics__()->__description_message__;
}

inline const OMPLDynamicReconfigureConfig& OMPLDynamicReconfigureConfig::__getDefault__()
{
  return __get_statics__()->__default__;
}

inline const OMPLDynamicReconfigureConfig& OMPLDynamicReconfigureConfig::__getMax__()
{
  return __get_statics__()->__max__;
}

inline const OMPLDynamicReconfigureConfig& OMPLDynamicReconfigureConfig::__getMin__()
{
  return __get_statics__()->__min__;
}

inline const std::vector<OMPLDynamicReconfigureConfig::AbstractParamDescriptionConstPtr>&
OMPLDynamicReconfigureConfig::__getParamDescriptions__()
{
  return __get_statics__()->__param_descriptions__;
}

inline const std::vector<OMPLDynamicReconfigureConfig::AbstractGroupDescriptionConstPtr>&
OMPLDynamicReconfigureConfig::__getGroupDescriptions__()
{
  return __get_statics__()->__group_descriptions__;
}

inline const OMPLDynamicReconfigureConfigStatics* OMPLDynamicReconfigureConfig::__get_statics__()
{
  const static OMPLDynamicReconfigureConfigStatics* statics;

  if (statics)  // Common case
    return statics;

  boost::mutex::scoped_lock lock(dynamic_reconfigure::__init_mutex__);

  if (statics)  // In case we lost a race.
    return statics;

  statics = OMPLDynamicReconfigureConfigStatics::get_instance();

  return statics;
}
}

#endif  // __OMPLDYNAMICRECONFIGURERECONFIGURATOR_H__