fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

mavlink: fix potential busy loop upon USB disconnect

Browse Source 
When disconnecting USB poll returns successfully, but the read returns
-1 with ENOTCONN.
In addition this also ensures there's no busy loop when poll returns an
error.

MAVLink continues to work after reconnecting USB.
This commit is contained in:
Beat Küng 2020-04-06 11:32:34 +02:00 committed by Daniel Agar
parent 4cdc58ce8d
commit 08bfeb3dc7
1 changed files with 10 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
src/modules/mavlink/mavlink_receiver.cpp
View File

@ -2809,10 +2809,16 @@ MavlinkReceiver::Run()
updateParams();
}
if (poll(&fds[0], 1, timeout) > 0) {
int ret = poll(&fds[0], 1, timeout);
if (ret > 0) {
if (_mavlink->get_protocol() == Protocol::SERIAL) {
/* non-blocking read. read may return negative values */
nread = ::read(fds[0].fd, buf, sizeof(buf));
if (nread == -1 && errno == ENOTCONN) { // Not connected (can happen for USB)
usleep(100000);
}
}
#if defined(MAVLINK_UDP)
@ -2895,6 +2901,9 @@ MavlinkReceiver::Run()
}
#endif // MAVLINK_UDP
} else if (ret == -1) {
usleep(10000);
}
hrt_abstime t = hrt_absolute_time();