Some small fixes for the serial update loop

pull/482/head
Fred Sundvik 9 years ago
parent 9cb139adc4
commit 46482460fa

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

Loading…
Cancel
Save