Skip to content

Commit 414c1f5

Browse files
committed
spartnParserNeeded is needed in more places
1 parent dbcf941 commit 414c1f5

File tree

1 file changed

+5
-4
lines changed

1 file changed

+5
-4
lines changed

Firmware/RTK_Everywhere/Tasks.ino

Lines changed: 5 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -392,6 +392,7 @@ void gnssReadTask(void *e)
392392
sempEnableDebugOutput(rtkParse);
393393

394394
bool sbfParserNeeded = present.gnss_mosaicX5;
395+
bool spartnParserNeeded = present.gnss_mosaicX5 && (productVariant != RTK_FLEX);
395396

396397
if (sbfParserNeeded)
397398
{
@@ -408,8 +409,6 @@ void gnssReadTask(void *e)
408409
// But be careful - you get a lot of "SEMP: Sbf SBF, 0x0002 (2) bytes, invalid preamble2"
409410
// if (settings.debugGnss) sempEnableDebugOutput(sbfParse);
410411

411-
bool spartnParserNeeded = present.gnss_mosaicX5 && (productVariant != RTK_FLEX);
412-
413412
if (spartnParserNeeded)
414413
{
415414
// Any data which is not SBF will be passed to the SPARTN parser via the invalid data callback
@@ -519,7 +518,8 @@ void gnssReadTask(void *e)
519518
if (!expected) // SBF is not expected so restart the parsers
520519
{
521520
sbfParse->state = sempFirstByte;
522-
spartnParse->state = sempFirstByte;
521+
if (spartnParserNeeded)
522+
spartnParse->state = sempFirstByte;
523523
if (settings.debugGnss)
524524
systemPrintf("Unexpected SBF block %d - rejected on ID or length\r\n",
525525
scratchPad->sbf.sbfID);
@@ -559,7 +559,8 @@ void gnssReadTask(void *e)
559559
if (!expected) // SBF is not expected so restart the parsers
560560
{
561561
sbfParse->state = sempFirstByte;
562-
spartnParse->state = sempFirstByte;
562+
if (spartnParserNeeded)
563+
spartnParse->state = sempFirstByte;
563564
if (settings.debugGnss)
564565
systemPrintf("Unexpected EncapsulatedOutput block - rejected\r\n");
565566
// We could pass the rejected bytes to the SPARTN parser but this is ~risky

0 commit comments

Comments
 (0)