#include <PMR/Stubs/StubCartridgeReadRequest.pb-c.h>
#include <PMR/Stubs/StubCartridgeReadResponse.pb-c.h>
#include <PMR/Stubs/StubCartridgeWriteRequest.pb-c.h>
#include <PMR/Stubs/StubCartridgeWriteResponse.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_CartridgeReadRequest(MessageContainer* requestContainer)
{
    uint32_t status = NOT_SUPPORTED;
    MessageContainer responseContainer;

    StubCartridgeReadRequest* request = stub_cartridge_read_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);

	//request->cartridgeid

    writeLine("cartridge Request: ");

    writeFloat(request->cartridgeid);

    StubCartridgeReadResponse response =   STUB_CARTRIDGE_READ_RESPONSE__INIT;
	
	response.cartridgeid = request->cartridgeid;
	response.has_cartridgeid = true;
	
	//response.cartridgecolor
	response.has_cartridgecolor = false;

	//response.cartridgeversion
	response.has_cartridgeversion = false;
	
	//response.cartridgedata
	response.has_cartridgedata = false;
	
	//response.cartridgeused
	response.has_cartridgeused = false;
	
    status_response(status,&response.status, &response.statusword ,&response.has_statusword);

    writeLine("Sending Response: ");

    writeFloat(response.cartridgeid);
    writeString(", ");
    writeFloat(response.cartridgecolor);
    writeString(", ");
    writeFloat(response.cartridgeversion);
    writeString(", ");
    writeFloat(response.cartridgedata);
    writeString(", ");
    writeFloat(response.cartridgeused);
    writeString(", ");

    Write_status_response(status);

    responseContainer = createContainer(MESSAGE_TYPE__StubCartridgeReadResponse, requestContainer->token, true, &response, &stub_cartridge_read_response__pack, &stub_cartridge_read_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);
}

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

    StubCartridgeWriteRequest* request = stub_cartridge_write_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);

	//request->cartridgeid
	//request->cartridgecolor
	//request->cartridgeversion
	//request->cartridgedata
	//request->cartridgeused

    writeLine("Cartridge Request: ");

    writeFloat(request->cartridgeid);
    writeString(", ");
    writeFloat(request->cartridgecolor);
    writeString(", ");
    writeFloat(request->cartridgeversion);
    writeString(", ");
    writeFloat(request->cartridgedata);
    writeString(", ");
    writeFloat(request->cartridgeused);
	
    StubCartridgeWriteResponse response =   STUB_CARTRIDGE_WRITE_RESPONSE__INIT;
	
	response.cartridgeid = request->cartridgeid;
	response.has_cartridgeid = true;
	
//    char temp[7] = "PASSED";
//    response.status = temp;
//    response.statusword = OK;
//    response.has_statusword = true;
	status_response(status,&response.status, &response.statusword ,&response.has_statusword);

    writeLine("Sending Response: ");

    writeFloat(response.cartridgeid);
    writeString(", ");
//    writeFloat(response.statusword);
//    WRITELINESTATUS;
    Write_status_response(status);

    responseContainer = createContainer(MESSAGE_TYPE__StubCartridgeWriteResponse, requestContainer->token, true, &response, &stub_cartridge_write_response__pack, &stub_cartridge_write_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);
}