-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathstatisticsTask.c
101 lines (94 loc) · 2.94 KB
/
statisticsTask.c
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
/*
* statisticsTask.c
*
* Created on: 2019Äê10ÔÂ18ÈÕ
* Author: jiez
*/
/*
* readFromQueueThread.c
*
* Created on: 2019Äê10ÔÂ14ÈÕ
* Author: jiez
*/
#include "statisticsTask.h"
void *statisticsTask(void *pvParameters)
{
uint32_t T1_cur_ID = 0;
uint32_t T1_last_ID = 0;
uint32_t T2_cur_ID = 0;
uint32_t T2_last_ID = 0;
uint32_t T3_cur_ID = 0;
uint32_t T3_last_ID = 0;
uint32_t T1_missed = 0;
uint32_t T2_missed = 0;
uint32_t T3_missed = 0;
msgQueue_t queueElemRecv;
msgQueue_t2 toSend;
for (;;)
{
recieveMsgFromStatQueue(&queueElemRecv);
switch (queueElemRecv.event)
{
case MSG_RECV_BY_CLIENT:
dbgOutputLoc(MAIN_RECV_EVENT_ENTER_LOC);
// tmpBuff = ((char *) queueElemRecv.msgPtr + 12);
// char msg_id[6] = queueElemRecv.message_id;
uint32_t msg_id_int;
sscanf(queueElemRecv.message_id, "%d", &msg_id_int);
if (strncmp(queueElemRecv.board_id, "rocky", 5) == 0)
{
if(queueElemRecv.isRetain){
T1_last_ID = msg_id_int;
T1_cur_ID = msg_id_int;
}
else
{
T1_cur_ID = msg_id_int;
T1_missed += T1_cur_ID - T1_last_ID - 1;
T1_last_ID = T1_cur_ID;
}
}
// else if (strncmp(queueElemRecv.board_id, "jacob", 5) == 0)
else if (strncmp(queueElemRecv.board_id, "ahmed", 5) == 0)
{
if(queueElemRecv.isRetain){
T2_last_ID = msg_id_int;
T2_cur_ID = msg_id_int;
}
else
{
T2_cur_ID = msg_id_int;
T2_missed += T2_cur_ID - T2_last_ID - 1;
T2_last_ID = T2_cur_ID;
}
}
else if (strncmp(queueElemRecv.board_id, "jacob", 5) == 0)
{
if(queueElemRecv.isRetain){
T3_last_ID = msg_id_int;
T3_cur_ID = msg_id_int;
}
else
{
T3_cur_ID = msg_id_int;
T3_missed += T3_cur_ID - T3_last_ID - 1;
T3_last_ID = T3_cur_ID;
}
}
break;
// data_to_rover.event = queueElemRecv.event;
// data_to_rover.dataLen = queueElemRecv.dataLen;
// memcpy((data_to_rover.msgPtr), queueElemRecv.msgPtr,
// MSG_DATA_LENGTH);
// sendMsgToRoverQueue(&data_to_rover);
// break;
case STATS_PUBLISH:
toSend.event = STATS_MSG;
toSend.T1_miss_num = T1_missed;
toSend.T2_miss_num = T2_missed;
toSend.T3_miss_num = T3_missed;
sendMsgToMqtt(&toSend);
break;
}
}
}