diff --git a/src/main/telemetry/msp.c b/src/main/telemetry/msp.c
index 4055b38a8..d7762e7c0 100644
--- a/src/main/telemetry/msp.c
+++ b/src/main/telemetry/msp.c
@@ -84,6 +84,7 @@ void handleMSPTelemetry(void)
 
 void freeMSPTelemetryPort(void)
 {
+    mspReleasePortIfAllocated(mspTelemetryPort);
     closeSerialPort(mspTelemetryPort);
     mspTelemetryPort = NULL;
     mspTelemetryEnabled = false;