From 40f9083e6117c48761f61d3a873a167e1f74b0b4 Mon Sep 17 00:00:00 2001 From: Bryan Biedenkapp Date: Wed, 31 Jul 2024 13:19:36 -0400 Subject: [PATCH] fix issue with double length frames not being correct; --- SerialPort.cpp | 8 +++++++- 1 file changed, 7 insertions(+), 1 deletion(-) diff --git a/SerialPort.cpp b/SerialPort.cpp index a70c8ed..0e4f2a8 100644 --- a/SerialPort.cpp +++ b/SerialPort.cpp @@ -97,8 +97,14 @@ void SerialPort::process() // The full packet has been received, process it if (m_ptr == m_len) { uint8_t err = 2U; + uint8_t offset = 2U; + if (m_dblFrame) + offset = 3U; - switch (m_buffer[2U]) { + // DEBUG4("m_buffer [b0 - b2]", m_buffer[0], m_buffer[1], m_buffer[2]); + // DEBUG4("m_buffer [b3 - b5]", m_buffer[3], m_buffer[4], m_buffer[5]); + + switch (m_buffer[offset]) { case CMD_GET_STATUS: getStatus(); break;