ArduinoTest: Fixes for writing numbers

geekprojects · Jun 20, 2024 · a6cd5a7 · a6cd5a7
1 parent e5499de
commit a6cd5a7
Show file tree

Hide file tree

Showing 2 changed files with 8 additions and 5 deletions.
diff --git a/src/libufc/devices/arduinotest.cpp b/src/libufc/devices/arduinotest.cpp
@@ -165,13 +165,16 @@ void ArduinoTest::update(UFC::AircraftState state)
     writeNumber(2, (int)state.autopilot.altitude);
 }
 
-void ArduinoTest::writeNumber(const int id, const int value) const
+void ArduinoTest::writeNumber(const int id, const int value)
 {
     char buffer[1024];
     snprintf(buffer, 1024, "NUMBER:%d:%d\n", id, value);
-    //printf("ArduinoTest::update: %s", buffer);
-    const int len = strlen(buffer);
-    write(m_fd, buffer, len);
+    const unsigned int len = strlen(buffer);
+    ssize_t res = write(m_fd, buffer, len);
+    if (res == -1)
+    {
+        log(WARN, "Failed to write to device");
+    }
 }
 
 void ArduinoTest::readMain()

diff --git a/src/libufc/devices/arduinotest.h b/src/libufc/devices/arduinotest.h
@@ -18,7 +18,7 @@ class ArduinoTest : public UFC::Device
 
     void handleLine(const std::string &line) const;
 
-    void writeNumber(int id, int value) const;
+    void writeNumber(int id, int value);
 
  public:
     ArduinoTest(UFC::FlightConnector* flightConnector);