1
0
Fork 0

Some small fixes for the serial update loop

This commit is contained in:
Fred Sundvik 2016-02-28 15:52:03 +02:00
parent 9cb139adc4
commit 46482460fa

View file

@ -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 {