[icue-link] handle reconnect and change mode when necessary

src/devices/icue_link/ICueLinkHubDevice.cs

@@ -44,6 +44,7 @@ private static class DataTypes
     private readonly IHidDeviceProxy _device;
     private readonly IDeviceGuardManager _guardManager;
     private readonly byte _pumpPowerMinimum;
+    private bool _isChangingDeviceMode;
     private readonly ChannelTrackingStore _requestedChannelPower = new();
     private readonly Dictionary<int, SpeedSensor> _speedSensors = new();
     private readonly Dictionary<int, TemperatureSensor> _temperatureSensors = new();
@@ -78,6 +79,7 @@ public override bool Connect()
         if (opened)
         {
             Initialize();
+            _device.OnReconnect(() => _ = TryChangeDeviceMode());
             return true;
         }
 
@@ -89,19 +91,34 @@ public override bool Connect()
         return false;
     }
 
-    private void Initialize()
+    private bool TryChangeDeviceMode()
     {
-        if (CanLogDebug)
+        if (_isChangingDeviceMode)
         {
-            var fw = GetFirmwareVersion();
-            LogDebug($"FW: {fw}");
+            LogWarning("Device mode change requested during device mode change.");
+            return false;
         }
 
         using (_guardManager.AwaitExclusiveAccess())
         {
+            _isChangingDeviceMode = true;
+            LogInfo("Changing device mode to software-controlled");
             SendCommand(Commands.EnterSoftwareMode);
+            _isChangingDeviceMode = false;
+        }
+
+        return true;
+    }
+
+    private void Initialize()
+    {
+        if (CanLogDebug)
+        {
+            var fw = GetFirmwareVersion();
+            LogDebug($"FW: {fw}");
         }
 
+        TryChangeDeviceMode();
         RefreshImpl(initialize: true);
     }
 
@@ -375,12 +392,32 @@ private void Write(byte[] buffer)
             LogDebug($"WRITE: {buffer.ToHexString()}");
         }
 
-        _device.Write(buffer);
+        try
+        {
+            _device.Write(buffer);
+        }
+        catch (TimeoutException)
+        {
+            if (!TryChangeDeviceMode())
+            {
+                throw;
+            }
+        }
     }
 
     private void Read(byte[] buffer)
     {
-        _device.Read(buffer);
+        try
+        {
+            _device.Read(buffer);
+        }
+        catch (TimeoutException)
+        {
+            if (!TryChangeDeviceMode())
+            {
+                throw;
+            }
+        }
 
         if (CanLogDebug)
         {