aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Code_Composer/twine_usblib_demo/Stubs_Handler/Stub_OptLimitSwitch.c
blob: a885cc0c0ae78fb0e2525f48f363fd9c9f376165 (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
#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);
}