Fix issue with checking if already in host mode

Duet3D · Sep 9, 2024 · d248022 · d248022
1 parent d97643e
commit d248022
Showing 1 changed file with 2 additions and 6 deletions.
diff --git a/src/TinyUsbInterface.cpp b/src/TinyUsbInterface.cpp
@@ -350,17 +350,13 @@ bool CoreUsbSetHostMode(bool hostMode, const StringRef& reply)
 		return false;
 	}
 
-	if (hostMode && digitalRead(UsbVbusDetect))
+	if (!CoreUsbIsHostMode() && hostMode && digitalRead(UsbVbusDetect))
 	{
 		reply.printf("Unable to change to host mode, board plugged in to computer\n");
 		return false;
 	}
 
-	if (hostMode == CoreUsbIsHostMode())
-	{
-		reply.printf("Already in %s mode\n", hostMode ? "host" : "device");
-	}
-	else
+	if (hostMode != CoreUsbIsHostMode())
 	{
 		CoreUsbStop();
 		changingMode = true;