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
119
120
121
122
123
|
#include <Container.h>
#include <DataDef.h>
#include <PMR/Stubs/StubFpgaReadRegRequest.pb-c.h>
#include <PMR/Stubs/StubFpgaReadRegResponse.pb-c.h>
#include <PMR/Stubs/StubFpgaWriteRegRequest.pb-c.h>
#include <PMR/Stubs/StubFpgaWriteRegResponse.pb-c.h>
#include <stdbool.h>
#include <stdlib.h>
#include <stdio.h>
#include <stdint.h>
#include <string.h>
#include "inc/hw_memmap.h"
#include "inc/hw_types.h"
#include "inc/hw_uart.h"
#include "Drivers/USB_Communication/USBCDCD.h"
#include "MessageContainer.pb-c.h"
#include "Stub_Status.h"
#include "drivers/FPGA/FPGA.h"
#include "drivers/FPGA/FPGA_Comm.h"
#include "control/control.h"
void Stub_FpgaReadRegRequest(MessageContainer* requestContainer)
{
uint32_t status = PASSED;
MessageContainer responseContainer;
StubFpgaReadRegRequest* request = stub_fpga_read_reg_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);
StubFpgaReadRegResponse response = STUB_FPGA_READ_REG_RESPONSE__INIT;
status_response(status,&response.status, &response.statusword ,&response.has_statusword);
if((request->address < FPGA1_BASE) || (request->address > (FPGA3_BASE | (0x3FF))))//TODO update the last add
{
status = FAILED;
}
else
{
volatile short *ptr;
ptr = (volatile short *) (request->address);
response.address = request->address;
response.has_address = true;
response.value = *ptr;
response.has_value = true;
}
responseContainer = createContainer(MESSAGE_TYPE__StubFpgaReadRegResponse, requestContainer->token, true, &response, &stub_fpga_read_reg_response__pack, &stub_fpga_read_reg_response__get_packed_size);
Write_status_response(status);
//free(request);
stub_fpga_read_reg_request__free_unpacked(request,NULL);
//-------------------------------------------------------------------------------------------
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);
}
uint32_t value = 0,ctlId;
uint32_t ResetCallBackFunction(uint32_t IfIndex, uint32_t BusyFlag)
{
SafeRemoveControlCallback(ctlId, ResetCallBackFunction );
volatile short *ptr = (volatile short *)(FPGA3_BASE | 0x3D0);
*ptr = (value & 0xFFFF);
return OK;
}
void Stub_FpgaWriteRegRequest(MessageContainer* requestContainer)
{
uint32_t status = PASSED;
volatile short *ptr;
MessageContainer responseContainer;
StubFpgaWriteRegRequest* request = stub_fpga_write_reg_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);
if((request->address < FPGA1_BASE) || (request->address > (FPGA3_BASE | (0x3FF))))//TODO update the last add
{
status = FAILED;
}
else
{
value = request->value;
ptr = (volatile short *) (request->address);
if (request->address == (FPGA3_BASE | 0x3D0))
{
ctlId = AddControlCallback("Reset", ResetCallBackFunction, 2* eOneSecond, TemplateDataReadCBFunction,ptr,ptr, 0 );
}
else
*ptr = (request->value & 0xFFFF);
}
StubFpgaWriteRegResponse response = STUB_FPGA_WRITE_REG_RESPONSE__INIT;
status_response(status,&response.status, &response.statusword ,&response.has_statusword);
responseContainer = createContainer(MESSAGE_TYPE__StubFpgaWriteRegResponse, requestContainer->token, true, &response, &stub_fpga_write_reg_response__pack, &stub_fpga_write_reg_response__get_packed_size);
Write_status_response(status);
//free(request);
stub_fpga_write_reg_request__free_unpacked(request,NULL);
//-------------------------------------------------------------------------------------------
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);
}
|
