diff --git a/channels/telemetry/server/telemetry_main.c b/channels/telemetry/server/telemetry_main.c
index d7e1042ca..4df94c556 100644
--- a/channels/telemetry/server/telemetry_main.c
+++ b/channels/telemetry/server/telemetry_main.c
@@ -183,10 +183,10 @@ static UINT telemetry_process_message(telemetry_server* telemetry)
 		goto out;
 	}
 
+	Stream_Seek(s, BytesReturned);
 	if (!Stream_CheckAndLogRequiredLength(TAG, s, 2))
 		return ERROR_NO_DATA;
 
-	Stream_SetLength(s, BytesReturned);
 	Stream_Read_UINT8(s, MessageId);
 	Stream_Read_UINT8(s, Length);