From a7e727a7ec17065a8d8ea7bf55553013aa3561b9 Mon Sep 17 00:00:00 2001
From: Bryan Biedenkapp <gatekeep@gmail.com>
Date: Sun, 26 May 2024 12:06:27 -0400
Subject: [PATCH] ensure we don't end up with badness;

---
 src/host/modem/Modem.cpp | 5 ++++-
 1 file changed, 4 insertions(+), 1 deletion(-)

diff --git a/src/host/modem/Modem.cpp b/src/host/modem/Modem.cpp
index a1e16781..566674e5 100644
--- a/src/host/modem/Modem.cpp
+++ b/src/host/modem/Modem.cpp
@@ -735,7 +735,10 @@ void Modem::clock(uint32_t ms)
                 //    Utils::dump(1U, "RX P25 Data", m_buffer, m_length);
 
                 uint8_t length[2U];
-                length[0U] = ((m_length - cmdOffset) >> 8U) & 0xFFU;
+                if (m_length > 255U)
+                    length[0U] = ((m_length - cmdOffset) >> 8U) & 0xFFU;
+                else
+                    length[0U] = 0x00U;
                 length[1U] = (m_length - cmdOffset) & 0xFFU;
                 m_rxP25Queue.addData(length, 2U);