@@ -587,18 +587,54 @@ void SFE_UBLOX_GPS::processUBX(uint8_t incoming, ubxPacket *incomingUBX, uint8_t
587587 if (incomingUBX->counter == 0 )
588588 {
589589 incomingUBX->cls = incoming;
590+ if (_printDebug == true )
591+ {
592+ _debugSerial->print (F (" processUBX: Class : 0x" ));
593+ _debugSerial->print (incomingUBX->cls , HEX);
594+ _debugSerial->print (F (" CSUMA: 0x" ));
595+ _debugSerial->print (rollingChecksumA, HEX);
596+ _debugSerial->print (F (" CSUMB: 0x" ));
597+ _debugSerial->println (rollingChecksumB, HEX);
598+ }
590599 }
591600 else if (incomingUBX->counter == 1 )
592601 {
593602 incomingUBX->id = incoming;
603+ if (_printDebug == true )
604+ {
605+ _debugSerial->print (F (" processUBX: ID : 0x" ));
606+ _debugSerial->print (incomingUBX->id , HEX);
607+ _debugSerial->print (F (" CSUMA: 0x" ));
608+ _debugSerial->print (rollingChecksumA, HEX);
609+ _debugSerial->print (F (" CSUMB: 0x" ));
610+ _debugSerial->println (rollingChecksumB, HEX);
611+ }
594612 }
595613 else if (incomingUBX->counter == 2 ) // Len LSB
596614 {
597615 incomingUBX->len = incoming;
616+ if (_printDebug == true )
617+ {
618+ _debugSerial->print (F (" processUBX: LEN_LSB: 0x" ));
619+ _debugSerial->print (incomingUBX->len , HEX);
620+ _debugSerial->print (F (" CSUMA: 0x" ));
621+ _debugSerial->print (rollingChecksumA, HEX);
622+ _debugSerial->print (F (" CSUMB: 0x" ));
623+ _debugSerial->println (rollingChecksumB, HEX);
624+ }
598625 }
599626 else if (incomingUBX->counter == 3 ) // Len MSB
600627 {
601628 incomingUBX->len |= incoming << 8 ;
629+ if (_printDebug == true )
630+ {
631+ _debugSerial->print (F (" processUBX: LEN_MSB: 0x" ));
632+ _debugSerial->print (incoming, HEX);
633+ _debugSerial->print (F (" CSUMA: 0x" ));
634+ _debugSerial->print (rollingChecksumA, HEX);
635+ _debugSerial->print (F (" CSUMB: 0x" ));
636+ _debugSerial->println (rollingChecksumB, HEX);
637+ }
602638 }
603639 else if (incomingUBX->counter == incomingUBX->len + 4 ) // ChecksumA
604640 {
0 commit comments