/*
 * Stub_ReadEmbeddedVersion.c
 *
 *  Created on: May 3, 2018
 *      Author: avi
 */

#include <Container.h>
#include <DataDef.h>
#include <DataDef.h>
#include <PMR/Stubs/StubReadEmbeddedVersionResponse.pb-c.h>
#include <PMR/Stubs/StubReadEmbeddedVersionRequest.pb-c.h>

#include <stdbool.h>
#include <stdlib.h>
#include <stdio.h>
#include <stdint.h>
#include <string.h>
#include "inc/hw_memmap.h"
#include "inc/hw_types.h"
#include "inc/hw_uart.h"

#include "Drivers/USB_Communication/USBCDCD.h"


#include "MessageContainer.pb-c.h"

#include "Stub_Status.h"
#include "drivers/FPGA/FPGA.h"

#include "Common/SW_Info/SW_Info.h"


void Stub_ReadEmbeddedVersionRequest(MessageContainer* requestContainer)
{

    char buffer[MAX_STRING_LEN] = {0};//33

    MessageContainer responseContainer;

    StubReadEmbeddedVersionRequest* request = stub_read_embedded_version_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);

    StubReadEmbeddedVersionResponse response =   STUB_READ_EMBEDDED_VERSION_RESPONSE__INIT;

    GetTangoVersion(&buffer);

    response.version = &buffer[4];

    response.has_verbuild = true;
    response.has_vermajor = true;
    response.has_verminor = true;
    response.has_verpatch = true;

    response.vermajor = buffer[0];
    response.verminor = buffer[1];
    response.verpatch = buffer[2];
    response.verbuild = buffer[3];

    responseContainer = createContainer(MESSAGE_TYPE__StubReadEmbeddedVersionResponse, requestContainer->token, true, &response, &stub_read_embedded_version_response__pack, &stub_read_embedded_version_response__get_packed_size);

    //free(request);
    //-------------------------------------------------------------------------------------------
    uint8_t* container_buffer = malloc(message_container__get_packed_size(&responseContainer));
    size_t container_size = message_container__pack(&responseContainer, container_buffer);
    free(responseContainer.data.data);
    SendChars((char*)container_buffer, container_size);
    //free(container_buffer);
    //free(requestContainer);
    stub_read_embedded_version_request__free_unpacked(request,NULL);
}