ensure length accounts for frame header;

2 years ago · 6796d1c3f3
parent c7f1ea1cc6
commit 6796d1c3f3
1 changed files with 1 additions and 0 deletions
--- a/SerialPort.cpp
+++ b/SerialPort.cpp
@ -530,6 +530,7 @@ void SerialPort::writeP25Data(const uint8_t* data, uint16_t length)
        writeInt(1U, reply, length + 3U);
    }
    else {
+        length += 4U;
        reply[0U] = DVM_LONG_FRAME_START;
        reply[1U] = (length >> 8U) & 0xFFU;
        reply[2U] = (length & 0xFFU);