jaus++/2.0/src/jaus/core/discovery/queryservices.cpp

Go to the documentation of this file.

#include "jaus/core/discovery/queryservices.h"

using namespace JAUS;

QueryServices::QueryServices(const Address& dest,
                             const Address& src) : Message(QUERY_SERVICES, dest, src)
{
}


QueryServices::QueryServices(const QueryServices& message) : Message(QUERY_SERVICES)
{
    *this = message;
}


QueryServices::~QueryServices()
{

}


int QueryServices::WriteMessageBody(Packet& packet) const
{
    int total = 0;
    int expected = BYTE_SIZE;
    Byte count = (Byte)mNodeList.size();
    total += packet.WriteByte(count);
    
    List::const_iterator node;
    for(node = mNodeList.begin();
        node != mNodeList.end();
        node++)
    {        
        expected += BYTE_SIZE*2;
        Byte count2 = (Byte)node->second.size();
        total += packet.Write(node->first);
        total += packet.Write(count2);

        std::vector<Byte>::const_iterator component;
        for(component = node->second.begin();
            component != node->second.end();
            component++)
        {
            expected += BYTE_SIZE;
            total += packet.Write(*component);
        }
    }

    return total == expected ? total : -1;
}


int QueryServices::ReadMessageBody(const Packet& packet) 
{
    int total = 0;
    int expected = BYTE_SIZE;
    Byte count = 0;

    total += packet.Read(count);
    
    for(Byte i = 0; i < count; i++)
    {        
        expected += BYTE_SIZE*2;
        Byte node = 0, count2 = 0;
        std::vector<Byte> components;

        total += packet.Read(node);
        total += packet.Read(count2);        

        for(Byte j = 0; j < count2; j++)
        {
            expected += BYTE_SIZE;
            Byte component = 0;
            total += packet.Read(component);
            components.push_back(component);
        }
        mNodeList[node] = components;
    }

    return total == expected ? total : -1;
}


void QueryServices::ClearMessageBody()
{
    mNodeList.clear();
}



QueryServices& QueryServices::operator =(const QueryServices& message)
{
    if(this != &message)
    {
        CopyHeaderData(&message);
        mNodeList = message.mNodeList;
    }
    return *this;
}


/*  End of File */