From c0ac75ba2f6ef411de8c169b48148b52c2733d07 Mon Sep 17 00:00:00 2001
From: Jonathan Naylor <naylorjs@yahoo.com>
Date: Thu, 29 Sep 2016 17:45:38 +0100
Subject: [PATCH] Fix P25 network infinite recursion.

---
 P25Control.cpp | 24 ++++++++++++------------
 1 file changed, 12 insertions(+), 12 deletions(-)

diff --git a/P25Control.cpp b/P25Control.cpp
index 139626e..00039f3 100644
--- a/P25Control.cpp
+++ b/P25Control.cpp
@@ -337,8 +337,13 @@ void CP25Control::writeNetwork()
 		break;
 	case 0x6AU:
 		::memcpy(m_netLDU1 + 200U, data, 16U);
-		if (m_netState != RS_NET_IDLE)
+		if (m_netState != RS_NET_IDLE) {
+			// Check for an unflushed LDU2
+			void* p = ::memchr(m_netLDU2, 0x02U, 9U * 25U);
+			if (p != NULL)
+				createNetLDU2();
 			createNetLDU1();
+		}
 		break;
 	case 0x6BU:
 		::memcpy(m_netLDU2 + 0U, data, 22U);
@@ -366,9 +371,14 @@ void CP25Control::writeNetwork()
 		break;
 	case 0x73U:
 		::memcpy(m_netLDU2 + 200U, data, 16U);
-		if (m_netState != RS_NET_IDLE) {
+		if (m_netState == RS_NET_IDLE) {
 			createNetHeader();
 			createNetLDU1();
+		} else {
+			// Check for an unflushed LDU1
+			void* p = ::memchr(m_netLDU1, 0x02U, 9U * 25U);
+			if (p != NULL)
+				createNetLDU1();
 		}
 		createNetLDU2();
 		break;
@@ -641,11 +651,6 @@ void CP25Control::createNetHeader()
 
 void CP25Control::createNetLDU1()
 {
-	// Check for an unflushed LDU2
-	void* p = ::memchr(m_netLDU2, 0x02U, 9U * 25U);
-	if (p != NULL)
-		createNetLDU2();
-
 	insertMissingAudio(m_netLDU1);
 
 	unsigned char buffer[P25_LDU_FRAME_LENGTH_BYTES + 2U];
@@ -695,11 +700,6 @@ void CP25Control::createNetLDU1()
 
 void CP25Control::createNetLDU2()
 {
-	// Check for an unflushed LDU1
-	void* p = ::memchr(m_netLDU1, 0x02U, 9U * 25U);
-	if (p != NULL)
-		createNetLDU1();
-
 	insertMissingAudio(m_netLDU2);
 
 	unsigned char buffer[P25_LDU_FRAME_LENGTH_BYTES + 2U];