From cedeeb33dca40b2186b816f3d2281b71ec46f4d2 Mon Sep 17 00:00:00 2001
From: arsamus <arsamus.web@gmail.com>
Date: Thu, 12 May 2022 16:55:29 -0300
Subject: [PATCH] Update serialmididevice.cpp

---
 src/serialmididevice.cpp | 120 +++++++++++++++++++--------------------
 1 file changed, 58 insertions(+), 62 deletions(-)

diff --git a/src/serialmididevice.cpp b/src/serialmididevice.cpp
index fa43715..ec819d0 100644
--- a/src/serialmididevice.cpp
+++ b/src/serialmididevice.cpp
@@ -85,82 +85,78 @@ void CSerialMIDIDevice::Process (void)
 	{
 		u8 uchData = Buffer[i];
 
-		switch (m_nSerialState)
+		if(uchData == 0xF0)
 		{
-		case 0:
-		MIDIRestart:
-			if (   (uchData & 0x80) == 0x80		// status byte, all channels
-			    && (uchData & 0xF0) != 0xF0)	// ignore system messages
-			{
-				m_SerialMessage[m_nSerialState++] = uchData;
-			}
-			
-			if (uchData == 0xF0) // SysEx status Byte jumps to m_nSerialState=5 and iniciate reading
-			{
-				m_nSerialState = 5;
-				m_nSysEx = 0; 
-				goto MIDISysEx;
-			}
-			
-			break;
-
-		case 1:
-		case 2:
-		DATABytes:
-			if (uchData & 0x80)			// got status when parameter expected
-			{
-				m_nSerialState = 0;
-
-				goto MIDIRestart;
-			}
-
-			m_SerialMessage[m_nSerialState++] = uchData;
-
-			if (   (m_SerialMessage[0] & 0xE0) == 0xC0
-			    || m_nSerialState == 3)		// message is complete
-			{
-				MIDIMessageHandler (m_SerialMessage, m_nSerialState);
+			// SYSEX found
+			m_SerialMessage[m_nSysEx++]=uchData;
+			continue;
+		}
 
-				m_nSerialState = 4; // State 4 for test if 4th byte is a status byte or a data byte 
-			}
-			break;
-		case 4: // Running Status evaluation
-			
-			if ((uchData & 0x80) == 0)  // true data byte, false status byte
+		if(m_nSysEx > 0)
+		{
+			m_SerialMessage[m_nSysEx++]=uchData;
+			if ((uchData & 0x80) == 0x80 || m_nSysEx >= MAX_MIDI_MESSAGE)
 			{
-				m_nSerialState = 1; // Byte 0 not change on Running Status
-				goto DATABytes;
+				if(uchData == 0xF7)
+					MIDIMessageHandler (m_SerialMessage, m_nSysEx);
+				m_nSysEx = 0;
 			}
-			else 
+			continue;
+		}
+		else
+		{
+			switch (m_nSerialState)
 			{
-				m_nSerialState = 0;
-				goto MIDIRestart;  // This is necessary in order to not miss the first byte
+			case 0:
+			MIDIRestart:
+				if (   (uchData & 0x80) == 0x80		// status byte, all channels
+				    && (uchData & 0xF0) != 0xF0)	// ignore system messages
+				{
+					m_SerialMessage[m_nSerialState++] = uchData;
+				}
+				break;
+	
+			case 1:
+			case 2:
+			DATABytes:
+				if (uchData & 0x80)			// got status when parameter expected
+				{
+					m_nSerialState = 0;
+	
+					goto MIDIRestart;
+				}
+	
+				m_SerialMessage[m_nSerialState++] = uchData;
+	
+				if (   (m_SerialMessage[0] & 0xE0) == 0xC0
+				    || m_nSerialState == 3)		// message is complete
+				{
+					MIDIMessageHandler (m_SerialMessage, m_nSerialState);
+	
+					m_nSerialState = 4; // State 4 for test if 4th byte is a status byte or a data byte 
+				}
+	
+				break;
+			case 4:
 				
-			}
-			break;
-		case 5: // SyxEx reading
-			MIDISysEx:
-			m_SerialMessage[m_nSysEx++] = uchData;
-			if (((uchData & 0x80) && m_nSysEx > 1 ) || m_nSysEx >= MAX_MIDI_MESSAGE)		
-			{
-				m_nSerialState = 0; //New Status byte ends SerialState 5 (SysEx reading)
-				if (uchData == 0xF7)
+				if ((uchData & 0x80) == 0)  // true data byte, false status byte
 				{
-					MIDIMessageHandler (m_SerialMessage, m_nSysEx);
+					m_nSerialState = 1;
+					goto DATABytes;
 				}
-				else
+				else 
 				{
-					goto MIDIRestart; //other status byte abort SysEx process and jump to MIDIRestart in order to not miss the byte
+					m_nSerialState = 0;
+					goto MIDIRestart; 
 				}
+				break;
+			default:
+				assert (0);
+				break;
 			}
-			break;
-		default:
-			assert (0);
-			break;
 		}
 	}
 }
-
 void CSerialMIDIDevice::Send (const u8 *pMessage, size_t nLength, unsigned nCable)
 {
 	m_SendBuffer.Write (pMessage, nLength);