parameter_server.h

Go to the documentation of this file.

/* This file is part of RGBDSLAM.
 * 
 * RGBDSLAM is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 * 
 * RGBDSLAM is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 * 
 * You should have received a copy of the GNU General Public License
 * along with RGBDSLAM.  If not, see <http://www.gnu.org/licenses/>.
 */
#ifndef PARAMETER_SERVER_H_
#define PARAMETER_SERVER_H_
#include <string>
#include <ros/ros.h>
#include <boost/any.hpp>

//this is a global definition of the points to be used
//changes to omit color would need adaptations in 
//the visualization too
#include "pcl/point_cloud.h"
#include "pcl/point_types.h"
typedef pcl::PointXYZRGB point_type;
typedef pcl::PointCloud<point_type> pointcloud_type;
//#define CONCURRENT_EDGE_COMPUTATION
//Compile out DEBUG Statements. Hardly benefitial though
#define ROSCONSOLE_SEVERITY_INFO 1

class ParameterServer {
public:
    static ParameterServer* instance();

    template<typename T>
    void set(const std::string param, T value) {
        if(config.count(param)==0){
          ROS_ERROR("ParameterServer: Ignoring invalid parameter: \"%s\"", param.c_str());
          return;
        }
        try{
          boost::any_cast<T>(value); //fails if wrong param type
        } catch (boost::bad_any_cast e) {
          ROS_ERROR("ParameterServer: Ignoring invalid parameter type: %s", e.what());
          return;
        }
        config[param] = value;
    }

    template<typename T>
    T get(const std::string param) {
        if(config.count(param)==0){
          ROS_FATAL("ParameterServer object queried for invalid parameter \"%s\"", param.c_str());
          assert(config.count(param)==0);
        }
        boost::any value = config[param];
        return boost::any_cast<T>(value);
    }

    std::string getDescription(std::string param_name);

    std::map<std::string, boost::any>& getConfigData(){
      return config;
    }

    void getValues();
private:
    void addOption(std::string name, boost::any value, std::string description);
    std::map<std::string, boost::any> config;
    std::map<std::string, std::string> descriptions;

    static ParameterServer* _instance;
    std::string pre;
    ros::NodeHandle handle;

    ParameterServer();

    void defaultConfig();

    void checkValues();

    template<typename T>
    T getFromParameterServer(const std::string param, T def) {
        std::string fullParam = param;
        T result;
        handle.param(fullParam, result, def);
        return result;
    }
};

#endif /* PARAMETER_SERVER_H_ */