#include <PMR/Stubs/StubDispenserRequest.pb-c.h>
#include <PMR/Stubs/StubDispenserResponse.pb-c.h>
#include <stdbool.h>
#include <stdlib.h>
#include <stdio.h>
#include <stdint.h>
#include <string.h>
#include <Stubs_Handler/DataDef.h>

#include "inc/hw_memmap.h"
#include "inc/hw_types.h"
#include "inc/hw_uart.h"
#include "driverlib/gpio.h"

#include "usb_serial_adapter.h"
#include "graphics_adapter.h"

#include "MessageContainer.pb-c.h"

#include "Container.h"
#include "Stub_Status.h"

void Stub_DispenserRequest(MessageContainer* requestContainer)
{
    uint32_t status = NOT_SUPPORTED;
    MessageContainer responseContainer;

    StubDispenserRequest* request = stub_dispenser_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);

	//request->dispenserid
	//request->start
	//request->setdirection
	//request->setmicrostepdivision
	//request->setspeed

    writeLine("Dispenser Request: ");

    writeFloat(request->dispenserid);
    writeString(", ");
    writeFloat(request->start);
    writeString(", ");
    writeFloat(request->setdirection);
    writeString(", ");
    writeFloat(request->setmicrostepdivision);
    writeString(", ");
    writeFloat(request->setspeed);

    StubDispenserResponse response =   STUB_DISPENSER_RESPONSE__INIT;
	
	response.dispenserid = request->dispenserid;
	response.has_dispenserid = true;
	
	//response.dispenserposition
	response.has_dispenserposition = false;

	//response.inkworninglevel
	response.has_inkworninglevel = false;
	
	status_response(status,&response.status, &response.statusword ,&response.has_statusword);

    writeLine("Sending Response: ");

    writeFloat(response.dispenserid);
    writeString(", ");
    writeFloat(response.dispenserposition);
    writeString(", ");
    writeFloat(response.inkworninglevel);
    writeString(", ");

    Write_status_response(status);

    responseContainer = createContainer(MESSAGE_TYPE__StubDispenserResponse, requestContainer->token, true, &response, &stub_dispenser_response__pack, &stub_dispenser_response__get_packed_size);

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