// Copyright 2016 Proyectos y Sistemas de Mantenimiento SL (eProsima).
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

/**
 * @file MemoryTestTypes.cpp
 *
 */

#include "MemoryTestTypes.h"

using namespace eprosima::fastrtps;
using namespace eprosima::fastrtps::rtps;

bool MemoryDataType::serialize(
        void* data,
        SerializedPayload_t* payload)
{
    MemoryType* lt = (MemoryType*)data;


    *(uint32_t*)payload->data = lt->seqnum;
    *(uint32_t*)(payload->data + 4) = (uint32_t)lt->data.size();

    //std::copy(lt->data.begin(),lt->data.end(),payload->data+8);
    memcpy(payload->data + 8, lt->data.data(), lt->data.size());
    payload->length = (uint32_t)(8 + lt->data.size());
    return true;
}

bool MemoryDataType::serialize(
        void* data,
        eprosima::fastrtps::rtps::SerializedPayload_t* payload,
        eprosima::fastdds::dds::DataRepresentationId_t)
{
    return serialize(data, payload);
}

bool MemoryDataType::deserialize(
        SerializedPayload_t* payload,
        void* data)
{
    MemoryType* lt = (MemoryType*)data;
    lt->seqnum = *(uint32_t*)payload->data;
    uint32_t siz = *(uint32_t*)(payload->data + 4);
    std::copy(payload->data + 8, payload->data + 8 + siz, lt->data.begin());
    return true;
}

std::function<uint32_t()> MemoryDataType::getSerializedSizeProvider(
        void* data)
{
    return [data]() -> uint32_t
           {
               MemoryType* tdata = static_cast<MemoryType*>(data);
               uint32_t size = 0;

               size = (uint32_t)(sizeof(uint32_t) + sizeof(uint32_t) + tdata->data.size());

               return size;
           };
}

std::function<uint32_t()> MemoryDataType::getSerializedSizeProvider(
        void* data,
        eprosima::fastdds::dds::DataRepresentationId_t)
{
    return getSerializedSizeProvider(data);
}

void* MemoryDataType::createData()
{

    return (void*)new MemoryType();
}

void MemoryDataType::deleteData(
        void* data)
{

    delete((MemoryType*)data);
}

bool TestCommandDataType::serialize(
        void* data,
        SerializedPayload_t* payload)
{
    TestCommandType* t = (TestCommandType*)data;
    *(TESTCOMMAND*)payload->data = t->m_command;
    payload->length = 4;
    return true;
}

bool TestCommandDataType::serialize(
        void* data,
        eprosima::fastrtps::rtps::SerializedPayload_t* payload,
        eprosima::fastdds::dds::DataRepresentationId_t)
{
    return serialize(data, payload);
}

bool TestCommandDataType::deserialize(
        SerializedPayload_t* payload,
        void* data)
{
    TestCommandType* t = (TestCommandType*)data;
    //	cout << "PAYLOAD LENGTH: "<<payload->length << endl;
    //	cout << "PAYLOAD FIRST BYTE: "<< (int)payload->data[0] << endl;
    t->m_command = *(TESTCOMMAND*)payload->data;
    //	cout << "COMMAND: "<<t->m_command<< endl;
    return true;
}

std::function<uint32_t()> TestCommandDataType::getSerializedSizeProvider(
        void*)
{
    return []() -> uint32_t
           {
               uint32_t size = 0;

               size = (uint32_t)sizeof(uint32_t);

               return size;
           };
}

std::function<uint32_t()> TestCommandDataType::getSerializedSizeProvider(
        void* data,
        eprosima::fastdds::dds::DataRepresentationId_t)
{
    return getSerializedSizeProvider(data);
}

void* TestCommandDataType::createData()
{

    return (void*)new TestCommandType();
}

void TestCommandDataType::deleteData(
        void* data)
{

    delete((TestCommandType*)data);
}
