findUbxMessageLen was returning wrong length in case startIdx!=0

Signed-off-by: Cervenka Dusan <[email protected]>
ACRIOS-Systems · Mar 4, 2024 · 23f9d94 · 23f9d94
1 parent 33f88d5
commit 23f9d94
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/lang/cpp/src/parseUbxMessageBase.cpp b/lang/cpp/src/parseUbxMessageBase.cpp
@@ -27,7 +27,7 @@ int32_t ParseUbxMessageBase::findUbxMessageLen(const uint8_t *buf, uint16_t len,
     {
         if ((startIdx + IDX_LEN_H + 1U) <= len)
         {
-            ret = startIdx + SerializeCommon::UbxControlBytesSize + buf[startIdx + IDX_LEN_L] + (buf[startIdx + IDX_LEN_H] << 8U);
+            ret = SerializeCommon::UbxControlBytesSize + buf[startIdx + IDX_LEN_L] + (buf[startIdx + IDX_LEN_H] << 8U);
         }
     }