Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-07 00:13:59 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_HAL_SITL: correct return values on UARTDriver write call

Browse Source
This commit is contained in:
Peter Barker 2023-07-13 17:13:51 +10:00 committed by Andrew Tridgell
parent 0b20328756
commit 32659fd3b6
1 changed files with 5 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
libraries/AP_HAL_SITL/UARTDriver.cpp
View File

@ -269,29 +269,27 @@ size_t UARTDriver::_write(const uint8_t *buffer, size_t size)
close(_fd);
_fd = -1;
_connected = false;
return 0;
}
// these have no effect
tcdrain(_fd);
return nwritten;
} else {
/*
simulate byte loss at the link layer
*/
size_t nwrite = size;
uint8_t lost_byte = 0;
#if !defined(HAL_BUILD_AP_PERIPH)
SITL::SIM *_sitl = AP::sitl();
if (_sitl && _sitl->uart_byte_loss_pct > 0) {
if (fabsf(rand_float()) < _sitl->uart_byte_loss_pct.get() * 0.01 * size) {
nwrite--;
}
if (nwrite == 0) {
return size;
lost_byte = 1;
}
}
#endif // HAL_BUILD_AP_PERIPH
_writebuffer.write(buffer, nwrite);
return _writebuffer.write(buffer, size - lost_byte) + lost_byte;
}
return size;
}