#include <PMR/Stubs/StubHeaterRequest.pb-c.h>
#include <PMR/Stubs/StubHeaterResponse.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_HeaterRequest(MessageContainer* requestContainer)
{
    uint32_t status = NOT_SUPPORTED;
    MessageContainer responseContainer;

    StubHeaterRequest* request = stub_heater_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);

	/*
	request->heatergroupid
	request->heatergroupon
	request->heatertemperaturereq
    */

    writeLine("Heater Request: ");

    writeFloat(request->heatergroupid);
    writeString(", ");
    writeFloat(request->heatergroupon);
    writeString(", ");
    writeFloat(request->heatertemperaturereq);
              
    StubHeaterResponse response =   STUB_HEATER_RESPONSE__INIT;

	response.heatergroupid = request->heatergroupid;
	response.has_heatergroupid = true;
	
	//response.heatertemperaturesensor
	response.has_heatertemperaturesensor = false;
	
	status_response(status,&response.status, &response.statusword ,&response.has_statusword);
	
    writeLine("Sending Response: ");

    writeFloat(response.heatergroupid);
    writeString(", ");
    writeFloat(response.heatertemperaturesensor);
    writeString(", ");

    Write_status_response(status);

    responseContainer = createContainer(MESSAGE_TYPE__StubHeaterResponse, requestContainer->token, true, &response, &stub_heater_response__pack, &stub_heater_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);
}