basic_types.h

Go to the documentation of this file.

 #ifndef BT_BASIC_TYPES_H
#define BT_BASIC_TYPES_H

#include <iostream>
#include <vector>
#include <sstream>
#include <unordered_map>
#include <unordered_set>
#include <typeinfo>
#include <functional>
#include <chrono>
#include <memory>
#include "behaviortree_cpp_v3/utils/string_view.hpp"
#include "behaviortree_cpp_v3/utils/safe_any.hpp"
#include "behaviortree_cpp_v3/exceptions.h"
#include "behaviortree_cpp_v3/utils/expected.hpp"
#include "behaviortree_cpp_v3/utils/make_unique.hpp"

namespace BT
{
enum class NodeType
{
    UNDEFINED = 0,
    ACTION,
    CONDITION,
    CONTROL,
    DECORATOR,
    SUBTREE
};

enum class NodeStatus
{
    IDLE = 0,
    RUNNING,
    SUCCESS,
    FAILURE
};

enum class PortDirection{
    INPUT,
    OUTPUT,
    INOUT
};


typedef nonstd::string_view StringView;

template <typename T> inline
T convertFromString(StringView /*str*/)
{
    auto type_name = BT::demangle( typeid(T) );

    std::cerr << "You (maybe indirectly) called BT::convertFromString() for type [" <<
                 type_name <<"], but I can't find the template specialization.\n" << std::endl;

    throw LogicError(std::string("You didn't implement the template specialization of "
                                 "convertFromString for this type: ") + type_name );
}

template <>
std::string convertFromString<std::string>(StringView str);

template <>
const char* convertFromString<const char*>(StringView str);

template <>
int convertFromString<int>(StringView str);

template <>
unsigned convertFromString<unsigned>(StringView str);

template <>
long convertFromString<long>(StringView str);

template <>
unsigned long convertFromString<unsigned long>(StringView str);

template <>
float convertFromString<float>(StringView str);

template <>
double convertFromString<double>(StringView str);

template <> // Integer numbers separated by the characted ";"
std::vector<int> convertFromString<std::vector<int>>(StringView str);

template <> // Real numbers separated by the characted ";"
std::vector<double> convertFromString<std::vector<double>>(StringView str);

template <> // This recognizes either 0/1, true/false, TRUE/FALSE
bool convertFromString<bool>(StringView str);

template <> // Names with all capital letters
NodeStatus convertFromString<NodeStatus>(StringView str);

template <>  // Names with all capital letters
NodeType convertFromString<NodeType>(StringView str);

template <>
PortDirection convertFromString<PortDirection>(StringView str);


typedef std::function<Any(StringView)> StringConverter;

typedef std::unordered_map<const std::type_info*, StringConverter> StringConvertersMap;


// helper function
template <typename T> inline
StringConverter GetAnyFromStringFunctor()
{
    return [](StringView str){ return Any(convertFromString<T>(str)); };
}

template <> inline
StringConverter GetAnyFromStringFunctor<void>()
{
    return {};
}

//------------------------------------------------------------------

template <typename T>
std::string toStr(T value)
{
    return std::to_string(value);
}

std::string toStr(std::string value);

template<> std::string toStr<BT::NodeStatus>(BT::NodeStatus status);

std::string toStr(BT::NodeStatus status, bool colored);

std::ostream& operator<<(std::ostream& os, const BT::NodeStatus& status);

template<> std::string toStr<BT::NodeType>(BT::NodeType type);

std::ostream& operator<<(std::ostream& os, const BT::NodeType& type);


template<> std::string toStr<BT::PortDirection>(BT::PortDirection direction);

std::ostream& operator<<(std::ostream& os, const BT::PortDirection& type);

// Small utility, unless you want to use <boost/algorithm/string.hpp>
std::vector<StringView> splitString(const StringView& strToSplit, char delimeter);

template <typename Predicate>
using enable_if = typename std::enable_if< Predicate::value >::type*;

template <typename Predicate>
using enable_if_not = typename std::enable_if< !Predicate::value >::type*;


template <typename T> using Optional = nonstd::expected<T, std::string>;
// note: we use the name Optional instead of expected because it is more intuitive
// for users that are not up to date with "modern" C++

using Result = Optional<void>;

class PortInfo
{

public:
  PortInfo( PortDirection direction = PortDirection::INOUT  ):
        _type(direction), _info(nullptr) {}

    PortInfo( PortDirection direction,
              const std::type_info& type_info,
              StringConverter conv):
        _type(direction),
        _info( &type_info ),
        _converter(conv)
    {}

    PortDirection direction() const;

    const std::type_info* type() const;

    Any parseString(const char *str) const;

    Any parseString(const std::string& str) const;

    template <typename T>
    Any parseString(const T& ) const
    {
        // avoid compilation errors
        return {};
    }

    void setDescription(StringView description);

    void setDefaultValue(StringView default_value_as_string);

    const std::string& description() const;

    const std::string& defaultValue() const;

private:

    PortDirection _type;
    const std::type_info* _info;
    StringConverter _converter;
    std::string description_;
    std::string default_value_;
};

template <typename T = void>
std::pair<std::string,PortInfo> CreatePort(PortDirection direction,
                                           StringView name,
                                           StringView description = {})
{
    std::pair<std::string,PortInfo> out;

    if( std::is_same<T, void>::value)
    {
        out = {static_cast<std::string>(name), PortInfo(direction) };
    }
    else{
        out =  {static_cast<std::string>(name), PortInfo(direction, typeid(T),
                                          GetAnyFromStringFunctor<T>() ) };
    }
    if( !description.empty() )
    {
        out.second.setDescription(description);
    }
    return out;
}

//----------
template <typename T = void> inline
    std::pair<std::string,PortInfo> InputPort(StringView name, StringView description = {})
{
    return CreatePort<T>(PortDirection::INPUT, name, description );
}

template <typename T = void> inline
std::pair<std::string,PortInfo> OutputPort(StringView name, StringView description = {})
{
    return CreatePort<T>(PortDirection::OUTPUT, name, description );
}

template <typename T = void> inline
    std::pair<std::string,PortInfo> BidirectionalPort(StringView name, StringView description = {})
{
    return CreatePort<T>(PortDirection::INOUT, name, description );
}
//----------
template <typename T = void> inline
    std::pair<std::string,PortInfo> InputPort(StringView name, const T& default_value, StringView description)
{
    auto out = CreatePort<T>(PortDirection::INPUT, name, description );
    out.second.setDefaultValue( BT::toStr(default_value) );
    return out;
}

template <typename T = void> inline
    std::pair<std::string,PortInfo> BidirectionalPort(StringView name, const T& default_value, StringView description)
{
    auto out = CreatePort<T>(PortDirection::INOUT, name, description );
    out.second.setDefaultValue( BT::toStr(default_value) );
    return out;
}
//----------

typedef std::unordered_map<std::string, PortInfo> PortsList;

template <typename T, typename = void>
struct has_static_method_providedPorts: std::false_type {};

template <typename T>
struct has_static_method_providedPorts<T,
        typename std::enable_if<std::is_same<decltype(T::providedPorts()), PortsList>::value>::type>
    : std::true_type {};

template <typename T> inline
PortsList getProvidedPorts(enable_if< has_static_method_providedPorts<T> > = nullptr)
{
    return T::providedPorts();
}

template <typename T> inline
PortsList getProvidedPorts(enable_if_not< has_static_method_providedPorts<T> > = nullptr)
{
    return {};
}

typedef std::chrono::high_resolution_clock::time_point TimePoint;
typedef std::chrono::high_resolution_clock::duration Duration;

} // end namespace


#endif   // BT_BASIC_TYPES_H