DebugHelper.hpp

Go to the documentation of this file.

#pragma once

#include <ros/ros.h>
#include <string>
#include <sstream>
#include <vector>

namespace robot_model_services {

class DebugHelper {

public:

    enum DebugLevel {
        PARAMETERS = 1,
        RATING = 2,
        ROBOT_MODEL = 4,
        MAP = 8,
        IK_RATING = 16
    };

private:

    static boost::shared_ptr<DebugHelper> instancePtr;
    static const int ALL = PARAMETERS
                            + RATING + ROBOT_MODEL + MAP + IK_RATING;
    static const int NONE = 0;

    ros::NodeHandle mNodeHandle;
    unsigned int mLevels;

public:

    static boost::shared_ptr<DebugHelper> getInstance();

    void write(const char * text, DebugLevel level);

    void write(const std::string &text, DebugLevel level);

    void write(const std::ostream &text, DebugLevel level);

    void writeNoticeably(const char * text, DebugLevel level);

    void writeNoticeably(const std::string &text, DebugLevel level);

    void writeNoticeably(const std::ostream &text, DebugLevel level);

    unsigned int getLevel();

    std::string getLevelString();


    void setLevels(std::string levelsStr);

    void setLevels();

private:

    DebugHelper();

    static int parseLevels(std::vector<std::string> levels);

    static void addToString(std::string& s, const std::string& add);

    bool checkLevel(DebugLevel level);

};

typedef boost::shared_ptr<DebugHelper> DebugHelperPtr;
}