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
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
|
#include <Container.h>
#include <PMR/Common/MessageContainer.pb-c.h>
#include <PMR/Stubs/StubDispenserRequest.pb-c.h>
#include <PMR/Stubs/StubDispenserResponse.pb-c.h>
#include "include.h"
#include "driverlib/gpio.h"
#include "Drivers/USB_Communication/USBCDCD.h"
#include "drivers/adc_sampling/adc.h"
#include "modules/ids/ids_ex.h"
#include <Drivers/I2C_Communication/Dispenser_Card/IO_Ports/Dispenser_IO.h>
#include "Stub_Status.h"
#include <math.h>
void Stub_DispenserRequest(MessageContainer* requestContainer)
{
uint32_t status = PASSED;
MessageContainer responseContainer;
StubDispenserRequest* request = stub_dispenser_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);
/*
ADCAcquireInit();
SysCtlDelay(10000);
ADCAcquireStart(0,1);
SysCtlDelay(10000);
ADC_TriggerCollection();
SysCtlDelay(10000);
ADC0SS0Handler();
SysCtlDelay(100000);
*/
//TCA9534Regs Regs;
//static bool first_time = true;
//if(first_time == true)
//if ((Regs.Config[request->dispenserid].bit.DISP_DOWN != TCA9534_INPUT) || (Regs.Config[request->dispenserid].bit.DISP_UP!= TCA9534_INPUT))
//{
status |= TCA9534Init(request->dispenserid/*, &Regs*/,true);
//first_time = false;
//}
if(request->setdirection == true)
{
TCA9534TestRelay(request->dispenserid/*, &Regs*/,ENABLE);
}
else
TCA9534TestRelay(request->dispenserid/*, &Regs*/,DISABLE);
delayms(5);
if(request->start == true)
{
TCA9534ByPass(request->dispenserid/*, &Regs*/, ENABLE);
}
else
TCA9534ByPass(request->dispenserid/*, &Regs*/, DISABLE);
delayms(5);
/*
if(request->setmicrostepdivision == 1)
TCA9534TestByPassTestRelay(request->dispenserid, &Regs);
delayms(5);
if(request->setspeed == 1)
test_IO();
delayms(5);
*/
//request->dispenserid
//request->start
//request->setdirection
//request->setmicrostepdivision
//request->setspeed
StubDispenserResponse response = STUB_DISPENSER_RESPONSE__INIT;
//response.dispenserid = (uint32_t)((round)(CalculateDispenserPressure(0x00000004)));//CHAN_DISPENSE_PRESSURE_6);
status |= TCA9534SetReadInputReg(request->dispenserid);
status |= TCA9534ReadInputReg(request->dispenserid/*, &Regs*/);
response.dispenserid = request->dispenserid;
response.has_dispenserid = true;
response.dispenserposition = (Get_Notification_Disp_UP(request->dispenserid/*, &Regs*/) << 8) | (Get_Notification_Disp_Down(request->dispenserid/*, &Regs*/));
response.has_dispenserposition = true;
response.inkworninglevel = (Get_Notification_Realy_On(request->dispenserid/*, &Regs*/) << 8) | (Get_Notification_Over_Press(request->dispenserid/*, &Regs*/));
response.has_inkworninglevel = true;
status_response(status,&response.status, &response.statusword ,&response.has_statusword);
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);
free(responseContainer.data.data);
SendChars((char*)container_buffer, container_size);
//free(container_buffer);
//free(requestContainer);
stub_dispenser_request__free_unpacked(request,NULL);
}
|
