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
|
#include <stdlib.h>
#include "../shared/bin.h"
#include "../shared/modes.h"
#include "../shared/protocol.h"
#include "commands.h"
#include "main.h"
#include "time.h"
void w2_send_bin(w2_s_bin *data) {
w2_serial_write("\xff", 1);
for (uint8_t i = 0; i < data->bytes; i++) {
uint8_t byte = data->data[i];
byte == 0xff ? w2_serial_write("\xff\xff", 2) : w2_serial_write((char *)&byte, 1);
}
}
void w2_send_info() {
W2_CREATE_MSG_BIN(w2_s_cmd_info_rx, msg, msg_bin);
msg->opcode = W2_CMD_INFO | W2_CMDDIR_RX;
w2_send_bin(msg_bin);
free(msg_bin);
}
void w2_send_dirc(uint16_t left, uint16_t right) {
W2_CREATE_MSG_BIN(w2_s_cmd_dirc_rx, msg, msg_bin);
msg->opcode = W2_CMD_DIRC | W2_CMDDIR_RX;
msg->left = w2_bin_hton16(left);
msg->right = w2_bin_hton16(right);
w2_send_bin(msg_bin);
free(msg_bin);
}
void w2_send_ping() {
g_w2_state.ping_id = (uint8_t)rand();
W2_CREATE_MSG_BIN(w2_s_cmd_ping_rx, msg, msg_bin);
msg->opcode = W2_CMD_PING | W2_CMDDIR_RX;
msg->id = g_w2_state.ping_id;
w2_send_bin(msg_bin);
free(msg_bin);
w2_timer_start(W2_TIMER_PING);
}
void w2_send_mode(w2_e_mode mode) {
if (mode == W2_M_PREV) {
W2_CREATE_MSG_BIN(w2_s_cmd_sres_rx, msg, msg_bin);
msg->opcode = W2_CMD_SRES | W2_CMDDIR_RX;
msg->type = W2_CMD_SRES_RX_TYPE_PREVMODE;
w2_send_bin(msg_bin);
free(msg_bin);
} else {
W2_CREATE_MSG_BIN(w2_s_cmd_mode_rx, msg, msg_bin);
msg->opcode = W2_CMD_MODE | W2_CMDDIR_RX;
msg->mode = mode;
w2_send_bin(msg_bin);
free(msg_bin);
}
}
void w2_send_tarq(w2_e_target_area target_area) {
W2_CREATE_MSG_BIN(w2_s_cmd_tarq_rx, msg, msg_bin);
msg->opcode = W2_CMD_TARQ | W2_CMDDIR_RX;
msg->target_area = target_area;
w2_send_bin(msg_bin);
free(msg_bin);
}
|