properties.h

#pragma once
 
#include <py_binding_tools/ros_msg_typecasters.h>
#include <moveit/task_constructor/properties.h>
#include <boost/any.hpp>
#include <typeindex>
 
namespace moveit {
namespace python {
 
class PYBIND11_EXPORT PropertyConverterBase
{
public:
    using to_python_converter_function = pybind11::object (*)(const boost::any&);
    using from_python_converter_function = boost::any (*)(const pybind11::object&);
 
protected:
    static bool insert(const std::type_index& type_index, const std::string& ros_msg_name,
                       to_python_converter_function to, from_python_converter_function from);
};
 
template <typename T>
class PropertyConverter : protected PropertyConverterBase
{
public:
    PropertyConverter() { insert(typeid(T), rosMsgName<T>(), &toPython, &fromPython); }
 
private:
    static pybind11::object toPython(const boost::any& value) { return pybind11::cast(boost::any_cast<T>(value)); }
    static boost::any fromPython(const pybind11::object& po) { return pybind11::cast<T>(po); }
 
    template <class Q = T>
    typename std::enable_if<ros::message_traits::IsMessage<Q>::value, std::string>::type rosMsgName() {
        return ros::message_traits::DataType<T>::value();
    }
 
    template <class Q = T>
    typename std::enable_if<!ros::message_traits::IsMessage<Q>::value, std::string>::type rosMsgName() {
        return std::string();
    }
};
 
namespace properties {
 
template <typename type_, typename... options>
class class_ : public pybind11::classh<type_, options...>  // NOLINT(readability-identifier-naming)
{
    using base_class_ = pybind11::classh<type_, options...>;
 
public:
    // forward all constructors
    using base_class_::base_class_;
 
    template <typename PropertyType, typename... Extra>
    class_& property(const char* name, const Extra&... extra) {
        PropertyConverter<PropertyType>();  // register corresponding property converter
        auto getter = [name](type_& self) -> PropertyType& {
            moveit::task_constructor::PropertyMap& props = self.properties();
            return const_cast<PropertyType&>(props.get<PropertyType>(name));
        };
        auto setter = [name](type_& self, const PropertyType& value) {
            moveit::task_constructor::PropertyMap& props = self.properties();
            props.set(name, boost::any(value));
        };
        base_class_::def_property(name, getter, setter, pybind11::return_value_policy::reference_internal, extra...);
        return *this;
    }
};
}  // namespace properties
}  // namespace python
}  // namespace moveit