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

    MessageContainer responseContainer;

    StubOptLimitSwitchRequest* request = stub_opt_limit_switch_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);

	/*
	request->limitswitchrid
	request->limitswitchrdisable
    */

    writeLine("OptLimit Switch Request: ");

    writeFloat(request->limitswitchrid);
    writeString(", ");
    writeFloat(request->limitswitchrdisable);
              
    StubOptLimitSwitchResponse response =   STUB_OPT_LIMIT_SWITCH_RESPONSE__INIT;
	
	response.limitswitchrid = request->limitswitchrid;
	response.has_limitswitchrid = true;
	
	//response.limitswitchditection = 2;
	response.has_limitswitchditection = false;
	
	status_response(status,&response.status, &response.statusword ,&response.has_statusword);

    writeLine("Sending Response: ");

    writeFloat(response.limitswitchrid);
    writeString(", ");
    writeFloat(response.limitswitchditection);
    writeString(", ");

    Write_status_response(status);

    responseContainer = createContainer(MESSAGE_TYPE__StubOptLimitSwitchResponse, requestContainer->token, true, &response, &stub_opt_limit_switch_response__pack, &stub_opt_limit_switch_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);
}