fix crc calc
This commit is contained in:
13
mfrc522.cpp
13
mfrc522.cpp
@ -98,8 +98,17 @@ uint8_t Mfrc522::calculateCrc(uint8_t *data, uint8_t length, uint16_t *result)
|
||||
return ERR;
|
||||
write(CommandReg, IDLE);
|
||||
|
||||
if(serial)
|
||||
{
|
||||
serial->write_p(PSTR("Calculated CRC "));
|
||||
serial->write((int)read(CRCResultRegL));
|
||||
serial->putChar(' ');
|
||||
serial->write((int)read(CRCResultRegH));
|
||||
serial->putChar('\n');
|
||||
}
|
||||
|
||||
*result = read(CRCResultRegL);
|
||||
*result = read(CRCResultRegH) << 8;
|
||||
*result |= read(CRCResultRegH) << 8;
|
||||
return 0;
|
||||
}
|
||||
|
||||
@ -439,7 +448,7 @@ uint8_t Mfrc522::selectTag(Uid *uid)
|
||||
} // End of while ( ! uidComplete)
|
||||
|
||||
// Set correct uid->size
|
||||
uid->size = 3 * cascadeLevel + 2;
|
||||
uid->size = 3 * (cascadeLevel+1) + 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
Reference in New Issue
Block a user