blob: 87d46e4b7faf0046c5d070485c946d8abc5f59e6 (
plain)
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
|
#include <unistd.h>
#include "protocol.h"
#include "8b10b.h"
void reset_receiver(struct proto_rx_st *st, struct command_if_def *cmd_if) {
st->rxpos = -1;
st->address = 5; /* FIXME debug code */
st->cmd_if = cmd_if;
}
void receive_symbol(struct proto_rx_st *st, int symbol) {
if (symbol == -K28_1) { /* Comma/frame delimiter */
st->rxpos = 0;
/* Fall through and return and just ignore incomplete packets */
} else if (symbol == -DECODING_ERROR) {
goto reset;
} else if (symbol < 0) { /* Unknown comma symbol or error */
goto reset;
} else if (st->rxpos == -1) {
return;
} else if (st->rxpos == 0) { /* First data symbol, and not an error or comma symbol */
st->packet_type = symbol & ~PKT_TYPE_BULK_FLAG;
if (st->packet_type >= st->cmd_if->packet_type_max)
goto reset;
int payload_len = st->cmd_if->payload_len[st->packet_type];
st->is_bulk = symbol & PKT_TYPE_BULK_FLAG;
st->offset = (st->is_bulk) ? (st->address*payload_len + 1) : 2;
st->rxpos++;
if (payload_len == 0 && st->is_bulk) {
handle_command(st->packet_type, NULL);
goto reset;
}
} else if (!st->is_bulk && st->rxpos == 1) {
if (symbol != st->address)
goto reset;
if (st->cmd_if->payload_len[st->packet_type] == 0) {
handle_command(st->packet_type, NULL);
goto reset;
}
st->rxpos = 2;
} else {
if (st->rxpos - st->offset >= 0)
st->argbuf[st->rxpos - st->offset] = symbol;
st->rxpos++;
if (st->rxpos - st->offset == st->cmd_if->payload_len[st->packet_type]) {
handle_command(st->packet_type, (uint8_t *)st->argbuf);
goto reset;
}
}
return;
reset:
st->rxpos = -1;
}
|
