Sensors/Microstrain3DMGX3: Fix for writing calibration parameters to …

…device.
LSTS · Sep 27, 2024 · 55865c7 · 55865c7
1 parent 9808c87
commit 55865c7
Showing 1 changed file with 8 additions and 0 deletions.
diff --git a/src/Sensors/Microstrain3DMGX3/Task.cpp b/src/Sensors/Microstrain3DMGX3/Task.cpp
@@ -308,6 +308,13 @@ namespace Sensors
         m_uart->setMinimumRead(max_data);
       }
 
+      bool
+      resetUart()
+      {
+        delete(m_uart);
+        return onConnect();
+      }
+
       void
       consume(const IMC::MagneticField* msg)
       {
@@ -484,6 +491,7 @@ namespace Sensors
             setEntityState(IMC::EntityState::ESTA_NORMAL, Status::CODE_CALIBRATING);
             inf(DTR("resetting device"));
             poll(CMD_DEVICE_RESET, CMD_DEVICE_RESET_SIZE, 0, 0);
+            resetUart();
           }
         }
       }