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
|
#include <stdio.h>
#include <time.h>
#include <string.h>
#include "sim.h"
struct timespec reference_time; // NOLINT
void time_reset() {
simprintfunc("time_reset", "");
clock_gettime(CLOCK_MONOTONIC, &reference_time);
return;
}
unsigned long get_ms() {
simprintfunc("get_ms", "");
struct timespec elapsed;
clock_gettime(CLOCK_MONOTONIC, &elapsed);
return ((elapsed.tv_sec * 1000) + (elapsed.tv_nsec / 1000000)) -
((reference_time.tv_sec * 1000) + (reference_time.tv_nsec / 1000000));
}
void red_led(unsigned char on) {
simprintfunc("red_led", "%i", on);
return;
}
void green_led(unsigned char on) {
simprintfunc("green_led", "%i", on);
return;
}
void clear() {
simprintfunc("clear", "");
return;
}
void play(const char* melody) {
simprintfunc("play", "\"%s\"", melody);
return;
}
void serial_set_baud_rate(unsigned int rate) {
simprintfunc("serial_set_baud_rate", "%u", rate);
return;
}
void serial_send(char* message, unsigned int length) {
simprintfunc("serial_send", "<see below>, %u", length);
unsigned int bytes = 0;
simprintf("");
for (unsigned int byte = 0; byte < length; byte++) {
if (bytes > DBG_BYTES_PER_LINE) {
bytes = 0;
printf("\n");
simprintf("");
}
printf("%02x ", message[byte]);
bytes++;
}
printf("\n");
return;
}
|