robot/sim.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

#include <stdio.h>
#include <time.h>
#include <string.h>

#include "sim.h"

struct timespec reference_time; // NOLINT

void time_reset() {
	// printf("SIM: time_reset()\n");
	clock_gettime(CLOCK_MONOTONIC, &reference_time);
	return;
}

unsigned long get_ms() {
	// printf("SIM: get_ms()\n");
	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) {
	printf("SIM: red_led(%i)\n", on);
	return;
}

void green_led(unsigned char on) {
	printf("SIM: green_led(%i)\n", on);
	return;
}

void clear() {
	printf("SIM: clear()\n");
	return;
}

void play(const char* melody) {
	printf("SIM: play(\"%s\")\n", melody);
	return;
}

void serial_set_baud_rate(unsigned int rate) {
	printf("SIM: serial_set_baud_rate(%u)\n", rate);
	return;
}

// TODO: hexdump binary data
void serial_send(char* message, unsigned int length) {
	char message_copy[length];
	strncpy(message_copy, message, length);
	printf("SIM: serial_send(\"%s\", %u)\n", message_copy, length);
	return;
}