aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Code_Composer/twine_usblib_demo/Stubs_Handler/Stub_Dispenser.c
blob: cc1f1e4eaefd39356b69e341e8bcdaebcb078ca1 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
#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);
}