diff options
Diffstat (limited to 'quantum/serial_link/protocol/frame_router.c')
-rw-r--r-- | quantum/serial_link/protocol/frame_router.c | 64 |
1 files changed, 0 insertions, 64 deletions
diff --git a/quantum/serial_link/protocol/frame_router.c b/quantum/serial_link/protocol/frame_router.c deleted file mode 100644 index 529267370..000000000 --- a/quantum/serial_link/protocol/frame_router.c +++ /dev/null | |||
@@ -1,64 +0,0 @@ | |||
1 | /* | ||
2 | The MIT License (MIT) | ||
3 | |||
4 | Copyright (c) 2016 Fred Sundvik | ||
5 | |||
6 | Permission is hereby granted, free of charge, to any person obtaining a copy | ||
7 | of this software and associated documentation files (the "Software"), to deal | ||
8 | in the Software without restriction, including without limitation the rights | ||
9 | to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | ||
10 | copies of the Software, and to permit persons to whom the Software is | ||
11 | furnished to do so, subject to the following conditions: | ||
12 | |||
13 | The above copyright notice and this permission notice shall be included in all | ||
14 | copies or substantial portions of the Software. | ||
15 | |||
16 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | ||
17 | IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | ||
18 | FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE | ||
19 | AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | ||
20 | LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | ||
21 | OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
22 | SOFTWARE. | ||
23 | */ | ||
24 | |||
25 | #include "serial_link/protocol/frame_router.h" | ||
26 | #include "serial_link/protocol/transport.h" | ||
27 | #include "serial_link/protocol/frame_validator.h" | ||
28 | |||
29 | static bool is_master; | ||
30 | |||
31 | void router_set_master(bool master) { is_master = master; } | ||
32 | |||
33 | void route_incoming_frame(uint8_t link, uint8_t* data, uint16_t size) { | ||
34 | if (is_master) { | ||
35 | if (link == DOWN_LINK) { | ||
36 | transport_recv_frame(data[size - 1], data, size - 1); | ||
37 | } | ||
38 | } else { | ||
39 | if (link == UP_LINK) { | ||
40 | if (data[size - 1] & 1) { | ||
41 | transport_recv_frame(0, data, size - 1); | ||
42 | } | ||
43 | data[size - 1] >>= 1; | ||
44 | validator_send_frame(DOWN_LINK, data, size); | ||
45 | } else { | ||
46 | data[size - 1]++; | ||
47 | validator_send_frame(UP_LINK, data, size); | ||
48 | } | ||
49 | } | ||
50 | } | ||
51 | |||
52 | void router_send_frame(uint8_t destination, uint8_t* data, uint16_t size) { | ||
53 | if (destination == 0) { | ||
54 | if (!is_master) { | ||
55 | data[size] = 1; | ||
56 | validator_send_frame(UP_LINK, data, size + 1); | ||
57 | } | ||
58 | } else { | ||
59 | if (is_master) { | ||
60 | data[size] = destination; | ||
61 | validator_send_frame(DOWN_LINK, data, size + 1); | ||
62 | } | ||
63 | } | ||
64 | } | ||