node_utils.cpp

Go to the documentation of this file.

// Test utils for nodes
// Author: Max Schwarz <max.schwarz@ais.uni-bonn.de>
 
#include "node_utils.h"
 
#include <sstream>
 
#include <catch_ros/catch.hpp>
 
std::string printMapping(const std::map<std::string, std::string>& mapping)
{
        std::stringstream ss;
        ss << "{ ";
        for(auto& pair : mapping)
        {
                ss << "'" << pair.first << "':='" << pair.second << "', ";
        }
        ss << "}";
 
        return ss.str();
}
 
rosmon::launch::Node::Ptr getNode(const std::vector<rosmon::launch::Node::Ptr>& nodes, const std::string& name, const std::string& namespaceString)
{
        rosmon::launch::Node::Ptr ret;
 
        INFO("Looking for node '" << name << "' in namespace '" << namespaceString << "'");
        INFO("Node list:");
 
        std::stringstream ss;
        for(auto& node : nodes)
                ss << " - '" << node->name() << "' (ns '" << node->namespaceString() << "')\n";
        INFO(ss.str());
 
        for(auto& node : nodes)
        {
                if(node->namespaceString() != namespaceString)
                        continue;
 
                if(node->name() == name)
                {
                        REQUIRE(!ret);
                        ret = node;
                }
        }
 
        REQUIRE(ret);
        return ret;
}