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
|
#include <cstdio>
#include <cstdlib>
#include <string.h>
#include "cmd.h"
#include "sock.h"
#include "parse.h"
char* consume_token(char* input, const char* ifs) {
strtok(input, ifs);
return strtok(NULL, "\0");
}
void cmd_exit(char*) {
exit(EXIT_SUCCESS);
}
void cmd_test(char*) {
const char* data = "Hello world!";
i2c_send(0x39, data, strlen(data));
}
void cmd_help(char*) {
printf("List of available commands:\n");
for (size_t i = 0; i < cmds_length; i++) {
struct cmd cmd = cmds[i];
printf(" %-*s", 10, cmd.name);
if (cmd.info != NULL)
printf(" %s", cmd.info);
printf("\n");
}
printf(
"\n"
"You can also use the TAB key to autocomplete commands\n"
);
}
void cmd_send(char* addr_str) {
char* data_str = consume_token(addr_str, IFS);
char* end;
uint16_t addr = strtol(addr_str, &end, 0);
if (addr_str + strlen(addr_str) != end) {
printf("address format error\n");
return;
}
char* data;
size_t data_size;
int err = strtodata(data_str, &data, &data_size);
if (err <= 0) {
printf("data format error at index %d:\n%s\n%*s^\n",
-err, data_str, -err, "");
return;
}
// printf("(0x%02x) -> \"%.*s\"\n", addr, data_size, data);
i2c_send(addr, data, data_size);
free(data);
}
|