diff options
Diffstat (limited to 'quantum/serial_link/system/serial_link.c')
-rw-r--r-- | quantum/serial_link/system/serial_link.c | 250 |
1 files changed, 0 insertions, 250 deletions
diff --git a/quantum/serial_link/system/serial_link.c b/quantum/serial_link/system/serial_link.c deleted file mode 100644 index 6363f8ff3..000000000 --- a/quantum/serial_link/system/serial_link.c +++ /dev/null | |||
@@ -1,250 +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 | #include "report.h" | ||
25 | #include "host_driver.h" | ||
26 | #include "serial_link/system/serial_link.h" | ||
27 | #include <hal.h> | ||
28 | #include "serial_link/protocol/byte_stuffer.h" | ||
29 | #include "serial_link/protocol/transport.h" | ||
30 | #include "serial_link/protocol/frame_router.h" | ||
31 | #include "matrix.h" | ||
32 | #include "sync_timer.h" | ||
33 | #include <stdbool.h> | ||
34 | #include "print.h" | ||
35 | #include "config.h" | ||
36 | |||
37 | #define SYNC_TIMER_OFFSET 2 | ||
38 | |||
39 | static event_source_t new_data_event; | ||
40 | static bool serial_link_connected; | ||
41 | static bool is_master = false; | ||
42 | |||
43 | static uint8_t keyboard_leds(void); | ||
44 | static void send_keyboard(report_keyboard_t* report); | ||
45 | static void send_mouse(report_mouse_t* report); | ||
46 | static void send_system(uint16_t data); | ||
47 | static void send_consumer(uint16_t data); | ||
48 | |||
49 | host_driver_t serial_driver = {keyboard_leds, send_keyboard, send_mouse, send_system, send_consumer}; | ||
50 | |||
51 | // Define these in your Config.h file | ||
52 | #ifndef SERIAL_LINK_BAUD | ||
53 | # error "Serial link baud is not set" | ||
54 | #endif | ||
55 | |||
56 | #ifndef SERIAL_LINK_THREAD_PRIORITY | ||
57 | # error "Serial link thread priority not set" | ||
58 | #endif | ||
59 | |||
60 | static SerialConfig config = {.sc_speed = SERIAL_LINK_BAUD}; | ||
61 | |||
62 | //#define DEBUG_LINK_ERRORS | ||
63 | |||
64 | static uint32_t read_from_serial(SerialDriver* driver, uint8_t link) { | ||
65 | const uint32_t buffer_size = 16; | ||
66 | uint8_t buffer[buffer_size]; | ||
67 | uint32_t bytes_read = sdAsynchronousRead(driver, buffer, buffer_size); | ||
68 | uint8_t* current = buffer; | ||
69 | uint8_t* end = current + bytes_read; | ||
70 | while (current < end) { | ||
71 | byte_stuffer_recv_byte(link, *current); | ||
72 | current++; | ||
73 | } | ||
74 | return bytes_read; | ||
75 | } | ||
76 | |||
77 | static void print_error(char* str, eventflags_t flags, SerialDriver* driver) { | ||
78 | #ifdef DEBUG_LINK_ERRORS | ||
79 | if (flags & SD_PARITY_ERROR) { | ||
80 | print(str); | ||
81 | print(" Parity error\n"); | ||
82 | } | ||
83 | if (flags & SD_FRAMING_ERROR) { | ||
84 | print(str); | ||
85 | print(" Framing error\n"); | ||
86 | } | ||
87 | if (flags & SD_OVERRUN_ERROR) { | ||
88 | print(str); | ||
89 | uint32_t size = qSpaceI(&(driver->iqueue)); | ||
90 | xprintf(" Overrun error, queue size %d\n", size); | ||
91 | } | ||
92 | if (flags & SD_NOISE_ERROR) { | ||
93 | print(str); | ||
94 | print(" Noise error\n"); | ||
95 | } | ||
96 | if (flags & SD_BREAK_DETECTED) { | ||
97 | print(str); | ||
98 | print(" Break detected\n"); | ||
99 | } | ||
100 | #else | ||
101 | (void)str; | ||
102 | (void)flags; | ||
103 | (void)driver; | ||
104 | #endif | ||
105 | } | ||
106 | |||
107 | bool is_serial_link_master(void) { return is_master; } | ||
108 | |||
109 | // TODO: Optimize the stack size, this is probably way too big | ||
110 | static THD_WORKING_AREA(serialThreadStack, 1024); | ||
111 | static THD_FUNCTION(serialThread, arg) { | ||
112 | (void)arg; | ||
113 | event_listener_t new_data_listener; | ||
114 | event_listener_t sd1_listener; | ||
115 | event_listener_t sd2_listener; | ||
116 | chEvtRegister(&new_data_event, &new_data_listener, 0); | ||
117 | eventflags_t events = CHN_INPUT_AVAILABLE | SD_PARITY_ERROR | SD_FRAMING_ERROR | SD_OVERRUN_ERROR | SD_NOISE_ERROR | SD_BREAK_DETECTED; | ||
118 | chEvtRegisterMaskWithFlags(chnGetEventSource(&SD1), &sd1_listener, EVENT_MASK(1), events); | ||
119 | chEvtRegisterMaskWithFlags(chnGetEventSource(&SD2), &sd2_listener, EVENT_MASK(2), events); | ||
120 | bool need_wait = false; | ||
121 | while (true) { | ||
122 | eventflags_t flags1 = 0; | ||
123 | eventflags_t flags2 = 0; | ||
124 | if (need_wait) { | ||
125 | eventmask_t mask = chEvtWaitAnyTimeout(ALL_EVENTS, TIME_MS2I(1000)); | ||
126 | if (mask & EVENT_MASK(1)) { | ||
127 | flags1 = chEvtGetAndClearFlags(&sd1_listener); | ||
128 | print_error("DOWNLINK", flags1, &SD1); | ||
129 | } | ||
130 | if (mask & EVENT_MASK(2)) { | ||
131 | flags2 = chEvtGetAndClearFlags(&sd2_listener); | ||
132 | print_error("UPLINK", flags2, &SD2); | ||
133 | } | ||
134 | } | ||
135 | |||
136 | // Always stay as master, even if the USB goes into sleep mode | ||
137 | is_master |= usbGetDriverStateI(&USBD1) == USB_ACTIVE; | ||
138 | router_set_master(is_master); | ||
139 | |||
140 | need_wait = true; | ||
141 | need_wait &= read_from_serial(&SD2, UP_LINK) == 0; | ||
142 | need_wait &= read_from_serial(&SD1, DOWN_LINK) == 0; | ||
143 | update_transport(); | ||
144 | } | ||
145 | } | ||
146 | |||
147 | void send_data(uint8_t link, const uint8_t* data, uint16_t size) { | ||
148 | if (link == DOWN_LINK) { | ||
149 | sdWrite(&SD1, data, size); | ||
150 | } else { | ||
151 | sdWrite(&SD2, data, size); | ||
152 | } | ||
153 | } | ||
154 | |||
155 | static systime_t last_update = 0; | ||
156 | |||
157 | typedef struct { | ||
158 | matrix_row_t rows[MATRIX_ROWS]; | ||
159 | } matrix_object_t; | ||
160 | |||
161 | static matrix_object_t last_matrix = {}; | ||
162 | |||
163 | SLAVE_TO_MASTER_OBJECT(keyboard_matrix, matrix_object_t); | ||
164 | MASTER_TO_ALL_SLAVES_OBJECT(serial_link_connected, bool); | ||
165 | #ifndef DISABLE_SYNC_TIMER | ||
166 | MASTER_TO_ALL_SLAVES_OBJECT(sync_timer, uint32_t); | ||
167 | #endif | ||
168 | |||
169 | static remote_object_t* remote_objects[] = { | ||
170 | REMOTE_OBJECT(serial_link_connected), | ||
171 | REMOTE_OBJECT(keyboard_matrix), | ||
172 | #ifndef DISABLE_SYNC_TIMER | ||
173 | REMOTE_OBJECT(sync_timer), | ||
174 | #endif | ||
175 | }; | ||
176 | |||
177 | void init_serial_link(void) { | ||
178 | serial_link_connected = false; | ||
179 | init_serial_link_hal(); | ||
180 | add_remote_objects(remote_objects, sizeof(remote_objects) / sizeof(remote_object_t*)); | ||
181 | init_byte_stuffer(); | ||
182 | sdStart(&SD1, &config); | ||
183 | sdStart(&SD2, &config); | ||
184 | chEvtObjectInit(&new_data_event); | ||
185 | (void)chThdCreateStatic(serialThreadStack, sizeof(serialThreadStack), SERIAL_LINK_THREAD_PRIORITY, serialThread, NULL); | ||
186 | } | ||
187 | |||
188 | void matrix_set_remote(matrix_row_t* rows, uint8_t index); | ||
189 | |||
190 | void serial_link_update(void) { | ||
191 | if (read_serial_link_connected()) { | ||
192 | serial_link_connected = true; | ||
193 | } | ||
194 | |||
195 | matrix_object_t matrix; | ||
196 | bool changed = false; | ||
197 | for (uint8_t i = 0; i < MATRIX_ROWS; i++) { | ||
198 | matrix.rows[i] = matrix_get_row(i); | ||
199 | changed |= matrix.rows[i] != last_matrix.rows[i]; | ||
200 | } | ||
201 | |||
202 | systime_t current_time = chVTGetSystemTimeX(); | ||
203 | systime_t delta = current_time - last_update; | ||
204 | if (changed || delta > TIME_US2I(5000)) { | ||
205 | last_update = current_time; | ||
206 | last_matrix = matrix; | ||
207 | matrix_object_t* m = begin_write_keyboard_matrix(); | ||
208 | for (uint8_t i = 0; i < MATRIX_ROWS; i++) { | ||
209 | m->rows[i] = matrix.rows[i]; | ||
210 | } | ||
211 | end_write_keyboard_matrix(); | ||
212 | |||
213 | *begin_write_serial_link_connected() = true; | ||
214 | end_write_serial_link_connected(); | ||
215 | |||
216 | #ifndef DISABLE_SYNC_TIMER | ||
217 | *begin_write_sync_timer() = sync_timer_read32() + SYNC_TIMER_OFFSET; | ||
218 | end_write_sync_timer(); | ||
219 | #endif | ||
220 | } | ||
221 | |||
222 | matrix_object_t* m = read_keyboard_matrix(0); | ||
223 | if (m) { | ||
224 | matrix_set_remote(m->rows, 0); | ||
225 | } | ||
226 | |||
227 | #ifndef DISABLE_SYNC_TIMER | ||
228 | uint32_t* t = read_sync_timer(); | ||
229 | if (t) { | ||
230 | sync_timer_update(*t); | ||
231 | } | ||
232 | #endif | ||
233 | } | ||
234 | |||
235 | void signal_data_written(void) { chEvtBroadcast(&new_data_event); } | ||
236 | |||
237 | bool is_serial_link_connected(void) { return serial_link_connected; } | ||
238 | |||
239 | host_driver_t* get_serial_link_driver(void) { return &serial_driver; } | ||
240 | |||
241 | // NOTE: The driver does nothing, because the master handles everything | ||
242 | uint8_t keyboard_leds(void) { return 0; } | ||
243 | |||
244 | void send_keyboard(report_keyboard_t* report) { (void)report; } | ||
245 | |||
246 | void send_mouse(report_mouse_t* report) { (void)report; } | ||
247 | |||
248 | void send_system(uint16_t data) { (void)data; } | ||
249 | |||
250 | void send_consumer(uint16_t data) { (void)data; } | ||