|
|
|
@ -36,14 +36,14 @@ static SerialConfig config = { |
|
|
|
|
.sc_speed = 38400 |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
static uint32_t read_from_serial(SerialDriver* driver) { |
|
|
|
|
static uint32_t read_from_serial(SerialDriver* driver, uint8_t link) { |
|
|
|
|
const uint32_t buffer_size = 16; |
|
|
|
|
uint8_t buffer[buffer_size]; |
|
|
|
|
uint32_t bytes_read = sdAsynchronousRead(driver, buffer, buffer_size); |
|
|
|
|
uint8_t* current = buffer; |
|
|
|
|
uint8_t* end = current + bytes_read; |
|
|
|
|
while(current < end) { |
|
|
|
|
byte_stuffer_recv_byte(0, *current); |
|
|
|
|
byte_stuffer_recv_byte(link, *current); |
|
|
|
|
current++; |
|
|
|
|
} |
|
|
|
|
return bytes_read; |
|
|
|
@ -74,14 +74,14 @@ static THD_FUNCTION(serialThread, arg) { |
|
|
|
|
router_set_master(is_master); |
|
|
|
|
|
|
|
|
|
need_wait = true; |
|
|
|
|
need_wait &= read_from_serial(&SD1) == 0; |
|
|
|
|
need_wait &= read_from_serial(&SD2) == 0; |
|
|
|
|
need_wait &= read_from_serial(&SD2, UP_LINK) == 0; |
|
|
|
|
need_wait &= read_from_serial(&SD1, DOWN_LINK) == 0; |
|
|
|
|
update_transport(); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void send_data(uint8_t link, const uint8_t* data, uint16_t size) { |
|
|
|
|
if (link == 0) { |
|
|
|
|
if (link == DOWN_LINK) { |
|
|
|
|
sdWrite(&SD1, data, size); |
|
|
|
|
} |
|
|
|
|
else { |
|
|
|
|