com_private.cpp 1.89 KB
Newer Older
1
#include "ros_bridge/include/com_private.h"
2 3 4

#include "ros_bridge/rapidjson/include/rapidjson/writer.h"

5
#include <functional>
6
#include <iostream>
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21

std::size_t ros_bridge::com_private::getHash(const std::string &str)
{
    std::hash<std::string> hash;
    return hash(str);
}

std::size_t ros_bridge::com_private::getHash(const char *str)
{
    return ros_bridge::com_private::getHash(std::string(str));
}

bool ros_bridge::com_private::getTopic(const ros_bridge::com_private::JsonDoc &doc, std::string &topic)
{
    if ( doc.HasMember("topic") && doc["topic"].IsString() ){
22 23 24 25 26 27 28 29 30 31 32 33 34


        rapidjson::StringBuffer sb1;
        rapidjson::Writer<rapidjson::StringBuffer> writer1(sb1);
        doc.Accept(writer1);
        std::cout << "getTopic doc: " << sb1.GetString() << std::endl;

        rapidjson::StringBuffer sb;
        rapidjson::Writer<rapidjson::StringBuffer> writer(sb);
        doc["topic"].Accept(writer);
        topic = sb.GetString();

        std::cout << "getTopic topic: " << sb.GetString() << std::endl;
35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51
        return true;
    } else
        return false;
}

bool ros_bridge::com_private::removeTopic(ros_bridge::com_private::JsonDoc &doc)
{
    if ( doc.HasMember("topic") && doc["topic"].IsString() ){
        doc.RemoveMember("topic");
        return true;
    } else
        return false;
}

bool ros_bridge::com_private::getType(const ros_bridge::com_private::JsonDoc &doc, std::string &type)
{
    if ( doc.HasMember("type") && doc["type"].IsString() ){
52 53 54 55
        rapidjson::StringBuffer sb;
        rapidjson::Writer<rapidjson::StringBuffer> writer(sb);
        doc["type"].Accept(writer);
        type = sb.GetString();
56 57 58 59 60 61 62 63 64 65 66 67 68
        return true;
    } else
        return false;
}

bool ros_bridge::com_private::removeType(ros_bridge::com_private::JsonDoc &doc)
{
    if ( doc.HasMember("type") && doc["type"].IsString() ){
        doc.RemoveMember("type");
        return true;
    } else
        return false;
}