Retry blocking writes.

paparazzi · Sep 8, 2013 · 1b46a38 · 1b46a38
1 parent c37b9ae
commit 1b46a38
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/sw/airborne/boards/ardrone/navdata.c b/sw/airborne/boards/ardrone/navdata.c
@@ -34,6 +34,7 @@
 #include <unistd.h>
 #include <string.h>
 #include <math.h>
+#include <errno.h>
 #include "navdata.h"
 
 #define NAVDATA_PACKET_SIZE 60
@@ -61,6 +62,8 @@ static void navdata_write(const uint8_t *buf, size_t count)
     ssize_t n = write(nav_fd, buf + written, count - written);
     if (n < 0)
     {
+      if (errno == EAGAIN || errno == EWOULDBLOCK)
+	continue;
       perror("navdata_write: Write failed");
       // FIXME: what's sensible to do at this point?
       return;