LinuxSerialDriver: Check for errors when setting interface speed

nasa · Aug 31, 2021 · 5cb1e2e · 5cb1e2e
1 parent da3bd77
commit 5cb1e2e
Showing 1 changed file with 16 additions and 0 deletions.
diff --git a/Drv/LinuxSerialDriver/LinuxSerialDriverComponentImpl.cpp b/Drv/LinuxSerialDriver/LinuxSerialDriverComponentImpl.cpp
@@ -231,7 +231,23 @@ namespace Drv {
 
       // Set baud rate:
       stat = cfsetispeed(&newtio, relayRate);
+      if (stat) {
+          DEBUG_PRINT("cfsetispeed failed\n");
+          close(fd);
+          Fw::LogStringArg _arg = device;
+          Fw::LogStringArg _err = strerror(errno);
+          this->log_WARNING_HI_DR_OpenError(_arg,fd,_err);
+          return false;
+      }
       stat = cfsetospeed(&newtio, relayRate);
+      if (stat) {
+          DEBUG_PRINT("cfsetospeed failed\n");
+          close(fd);
+          Fw::LogStringArg _arg = device;
+          Fw::LogStringArg _err = strerror(errno);
+          this->log_WARNING_HI_DR_OpenError(_arg,fd,_err);
+          return false;
+      }
 
       // Raw output:
       newtio.c_oflag = 0;