Fixed PX4IO uploader debug output

This commit is contained in:
David Sidrane 2020-11-19 06:06:27 -08:00 committed by Daniel Agar
parent 65e1b702c9
commit ee3285a34f
1 changed files with 12 additions and 2 deletions

View File

@ -268,7 +268,7 @@ PX4IO_Uploader::recv_byte_with_timeout(uint8_t *c, unsigned timeout)
read(_io_fd, c, 1);
#ifdef UDEBUG
log("recv_bytes 0x%02x", c);
log("recv_bytes 0x%02x", *c);
#endif
return OK;
}
@ -315,7 +315,17 @@ int
PX4IO_Uploader::send(uint8_t c)
{
#ifdef UDEBUG
log("send 0x%02x", c);
static uint8_t cnt = 0;
if (c == 0) {
if (cnt == 0 || cnt == 32 || cnt == 64 || cnt == 128) { log("send+ 0x%02x", c); }
cnt++;
} else {
log("send 0x%02x", c);
}
#endif
if (write(_io_fd, &c, 1) != 1) {