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
|
#include "mbed.h"
#include "cmsis_os.h"
typedef struct {
float voltage; /* AD result of measured voltage */
float current; /* AD result of measured current */
uint32_t counter; /* A counter value */
} message_t;
osPoolDef(mpool, 16, message_t);
osPoolId mpool;
osMessageQDef(queue, 16, message_t);
osMessageQId queue;
void send_thread (void const *argument) {
uint32_t i = 0;
while (true) {
i++; // fake data update
message_t *message = (message_t*)osPoolAlloc(mpool);
message->voltage = (i * 0.1) * 33;
message->current = (i * 0.1) * 11;
message->counter = i;
osMessagePut(queue, (uint32_t)message, osWaitForever);
osDelay(1000);
}
}
osThreadDef(send_thread, osPriorityNormal, DEFAULT_STACK_SIZE);
int main (void) {
mpool = osPoolCreate(osPool(mpool));
queue = osMessageCreate(osMessageQ(queue), NULL);
osThreadCreate(osThread(send_thread), NULL);
while (true) {
osEvent evt = osMessageGet(queue, osWaitForever);
if (evt.status == osEventMessage) {
message_t *message = (message_t*)evt.value.p;
printf("\nVoltage: %.2f V\n\r" , message->voltage);
printf("Current: %.2f A\n\r" , message->current);
printf("Number of cycles: %u\n\r", message->counter);
osPoolFree(mpool, message);
}
}
}
|