Add badCrc for SBF and SPARTN

Author: PaulZC

src/Parse_SBF.cpp

@@ -33,7 +33,8 @@ bool sempSbfReadBytes(SEMP_PARSE_STATE *parse, uint8_t data)
     {
         parse->state = sempFirstByte;
 
-        if (scratchPad->sbf.computedCRC == scratchPad->sbf.expectedCRC)
+        if ((scratchPad->sbf.computedCRC == scratchPad->sbf.expectedCRC)
+            || (parse->badCrc && (!parse->badCrc(parse))))
         {
             parse->eomCallback(parse, parse->type); // Pass parser array index
         }

src/Parse_SPARTN.cpp

@@ -36,15 +36,19 @@ bool sempSpartnReadTF018(SEMP_PARSE_STATE *parse, uint8_t data)
         case 0:
         {
             uint8_t expected = *ptr;
-            valid = (semp_uSpartnCrc8(&parse->buffer[1], numBytes - 1) == expected); // Don't include the preamble in the CRC
+            // Don't include the preamble in the CRC
+            valid =  ((semp_uSpartnCrc8(&parse->buffer[1], numBytes - 1) == expected)
+                      || (parse->badCrc && (!parse->badCrc(parse))));
         }
         break;
         case 1:
         {
             uint16_t expected = *ptr++;
             expected <<= 8;
             expected |= *ptr;
-            valid = (semp_uSpartnCrc16(&parse->buffer[1], numBytes - 1) == expected); // Don't include the preamble in the CRC
+            // Don't include the preamble in the CRC
+            valid =  ((semp_uSpartnCrc16(&parse->buffer[1], numBytes - 1) == expected)
+                      || (parse->badCrc && (!parse->badCrc(parse))));
         }
         break;
         case 2:
@@ -54,7 +58,9 @@ bool sempSpartnReadTF018(SEMP_PARSE_STATE *parse, uint8_t data)
             expected |= *ptr++;
             expected <<= 8;
             expected |= *ptr;
-            valid = (semp_uSpartnCrc24(&parse->buffer[1], numBytes - 1) == expected); // Don't include the preamble in the CRC
+            // Don't include the preamble in the CRC
+            valid =  ((semp_uSpartnCrc24(&parse->buffer[1], numBytes - 1) == expected)
+                      || (parse->badCrc && (!parse->badCrc(parse))));
         }
         break;
         default:
@@ -66,7 +72,9 @@ bool sempSpartnReadTF018(SEMP_PARSE_STATE *parse, uint8_t data)
             expected |= *ptr++;
             expected <<= 8;
             expected |= *ptr;
-            valid = (semp_uSpartnCrc32(&parse->buffer[1], numBytes - 1) == expected); // Don't include the preamble in the CRC
+            // Don't include the preamble in the CRC
+            valid =  ((semp_uSpartnCrc32(&parse->buffer[1], numBytes - 1) == expected)
+                      || (parse->badCrc && (!parse->badCrc(parse))));
         }
         break;
         }