105 lines
2.6 KiB
C
105 lines
2.6 KiB
C
//-----------------------------------------------------------------------------
|
|
// This code is licensed to you under the terms of the GNU GPL, version 2 or,
|
|
// at your option, any later version. See the LICENSE.txt file for the text of
|
|
// the license.
|
|
//-----------------------------------------------------------------------------
|
|
// ISO15693 CRC & other commons
|
|
//-----------------------------------------------------------------------------
|
|
|
|
#include "iso15693tools.h"
|
|
|
|
// The CRC as described in ISO 15693-Part 3-Annex C
|
|
// v buffer with data
|
|
// n length
|
|
// returns crc as 16bit value
|
|
/*
|
|
uint16_t Iso15693Crc(uint8_t *v, int n)
|
|
{
|
|
uint32_t reg;
|
|
int i, j;
|
|
|
|
reg = 0xffff;
|
|
for(i = 0; i < n; i++) {
|
|
reg = reg ^ ((uint32_t)v[i]);
|
|
for (j = 0; j < 8; j++) {
|
|
if (reg & 0x0001) {
|
|
reg = (reg >> 1) ^ 0x8408;
|
|
} else {
|
|
reg = (reg >> 1);
|
|
}
|
|
}
|
|
}
|
|
return ~(uint16_t)(reg & 0xffff);
|
|
}
|
|
*/
|
|
uint16_t Iso15693Crc(uint8_t *d, size_t n){
|
|
init_table(CRC_15);
|
|
return crc16_x25(d, n);
|
|
}
|
|
|
|
// adds a CRC to a dataframe
|
|
// d[] iso15963 frame without crc
|
|
// n length without crc
|
|
// returns the new length of the dataframe.
|
|
int Iso15693AddCrc(uint8_t *d, size_t n) {
|
|
uint16_t crc = Iso15693Crc(d, n);
|
|
d[n] = crc & 0xff;
|
|
d[n+1] = crc >> 8;
|
|
return n + 2;
|
|
}
|
|
|
|
// check the CRC as described in ISO 15693-Part 3-Annex C
|
|
// v buffer with data
|
|
// n length (including crc)
|
|
// If calculated with crc bytes, the residue should be 0xF0B8
|
|
bool Iso15693CheckCrc(uint8_t *d, size_t n) {
|
|
return (Iso15693Crc(d, n) == ISO15_CRC_CHECK );
|
|
//uint16_t crc = Iso15693Crc(v, n-2);
|
|
// if ( (( crc & 0xff ) == v[n-2]) && (( crc >> 8 ) == v[n-1]) )
|
|
// return true;
|
|
// return false;
|
|
}
|
|
|
|
int sprintf(char *str, const char *format, ...);
|
|
|
|
// returns a string representation of the UID
|
|
// UID is transmitted and stored LSB first, displayed MSB first
|
|
// target char* buffer, where to put the UID, if NULL a static buffer is returned
|
|
// uid[] the UID in transmission order
|
|
// return: ptr to string
|
|
char* Iso15693sprintUID(char *target, uint8_t *uid) {
|
|
|
|
static char tempbuf[2*8+1] = {0};
|
|
if (target == NULL)
|
|
target = tempbuf;
|
|
sprintf(target, "%02X %02X %02X %02X %02X %02X %02X %02X",
|
|
uid[7], uid[6], uid[5], uid[4],
|
|
uid[3], uid[2], uid[1], uid[0]
|
|
);
|
|
return target;
|
|
}
|
|
|
|
uint16_t iclass_crc16(uint8_t *d, uint16_t n) {
|
|
|
|
unsigned int data;
|
|
uint16_t crc = 0xffff;
|
|
|
|
|
|
if (n == 0)
|
|
return (~crc);
|
|
|
|
do {
|
|
for (uint8_t i=0, data = *d++; i < 8; i++, data >>= 1) {
|
|
if ((crc & 0x0001) ^ (data & 0x0001))
|
|
crc = (crc >> 1) ^ ISO15_CRC_POLY;
|
|
else
|
|
crc >>= 1;
|
|
}
|
|
} while (--n);
|
|
|
|
crc = ~crc;
|
|
data = crc;
|
|
crc = (crc << 8) | (data >> 8 & 0xff);
|
|
crc = crc ^ 0xBC3;
|
|
return crc;
|
|
} |