562 lines
13 KiB
C
562 lines
13 KiB
C
/*
|
||
File: Mfrc522.cpp
|
||
Mfrc522 - Library for communicating with MFRC522 based NFC Reader/Writers
|
||
Created by Eelco Rouw - Mainly based on code from Grant Gibson (www.grantgibson.co.uk) and Dr.Leong ( WWW.B2CQSHOP.COM )
|
||
Lightly modified by Frank Milburn
|
||
Lightly modified by Roy Bakker C++ --> C
|
||
Released into the public domain
|
||
Lightly modified by Mats van Reenen: use other SPI interface
|
||
*/
|
||
|
||
#include <msp430.h>
|
||
#include <Mfrc522.h>
|
||
#include <SPI.h>
|
||
//#include <SPI2.h>
|
||
|
||
void RC522_init(int chipSelectPin, int NRSTPD)
|
||
{
|
||
_chipSelectPin = chipSelectPin;
|
||
P1DIR |= _chipSelectPin;
|
||
P1OUT |= _chipSelectPin;
|
||
|
||
_NRSTPD = NRSTPD;
|
||
P1DIR |= _NRSTPD;
|
||
P1OUT |= _NRSTPD;
|
||
|
||
RC522_reset();
|
||
|
||
//Timer: TPrescaler*TreloadVal/6.78MHz = 24ms
|
||
RC522_writeReg(TModeReg, 0x8D); //Tauto=1; f(Timer) = 6.78MHz/TPreScaler
|
||
RC522_writeReg(TPrescalerReg, 0x3E); //TModeReg[3..0] + TPrescalerReg
|
||
RC522_writeReg(TReloadRegL, 30);
|
||
RC522_writeReg(TReloadRegH, 0);
|
||
|
||
RC522_writeReg(TxAutoReg, 0x40); //100%ASK
|
||
RC522_writeReg(ModeReg, 0x3D);
|
||
|
||
//RC522_clearBitMask(Status2Reg, 0x08); //MFCrypto1On=0
|
||
//RC522_writeReg(RxSelReg, 0x86); //RxWait = RxSelReg[5..0]
|
||
//RC522_writeReg(RFCfgReg, 0x7F); //RxGain = 48dB
|
||
|
||
RC522_antennaOn();
|
||
}
|
||
|
||
/*
|
||
* Function: WriteReg
|
||
* Description: write a byte data into one register of MR RC522
|
||
* Input parameter: addr--register addressï¼›val--the value that need to write in
|
||
* Return: Null
|
||
*/
|
||
void RC522_writeReg(unsigned char addr, unsigned char val)
|
||
{
|
||
SPIInitSend(_chipSelectPin, SPI_Mode0, SPI_Clock_4MHz);
|
||
|
||
SPI_packet[3] = (addr<<1)&0x7E;
|
||
SPI_packet[4] = val;
|
||
SPI_packetC = 3;
|
||
|
||
SPISend();
|
||
|
||
// P1OUT &= ~(_chipSelectPin);
|
||
|
||
// SPI_transfer((addr<<1)&0x7E);
|
||
// SPI_transfer(val);
|
||
|
||
// P1OUT |= _chipSelectPin;
|
||
}
|
||
|
||
/*
|
||
* Function: ReadReg
|
||
* Description: read a byte data into one register of MR RC522
|
||
* Input parameter: addr--register address
|
||
* Return: return the read value
|
||
*/
|
||
unsigned char RC522_readReg(unsigned char addr)
|
||
{
|
||
SPIInitSend(_chipSelectPin, SPI_Mode0, SPI_Clock_4MHz);
|
||
|
||
SPI_packet[3] = ((addr<<1)&0x7E) | 0x80;
|
||
SPI_packet[4] = 0;
|
||
SPI_packetC = 3;
|
||
|
||
SPISend();
|
||
|
||
return SPI_packet[4];
|
||
|
||
// unsigned char val;
|
||
// P1OUT &= ~(_chipSelectPin);
|
||
|
||
// SPI_transfer(((addr<<1)&0x7E) | 0x80);
|
||
// val = SPI_transfer(0x00);
|
||
|
||
// P1OUT |= _chipSelectPin;
|
||
|
||
// return val;
|
||
}
|
||
|
||
/*
|
||
* Function: SetBitMask
|
||
* Description: set RC522 register bit
|
||
* Input parameter: reg--register address;mask--value
|
||
* Return: null
|
||
*/
|
||
void RC522_setBitMask(unsigned char reg, unsigned char mask)
|
||
{
|
||
unsigned char tmp;
|
||
tmp = RC522_readReg(reg);
|
||
RC522_writeReg(reg, tmp | mask); // set bit mask
|
||
}
|
||
|
||
/*
|
||
* Function: ClearBitMask
|
||
* Description: clear RC522 register bit
|
||
* Input parameter: reg--register address;mask--value
|
||
* Return: null
|
||
*/
|
||
void RC522_clearBitMask(unsigned char reg, unsigned char mask)
|
||
{
|
||
unsigned char tmp;
|
||
tmp = RC522_readReg(reg);
|
||
RC522_writeReg(reg, tmp & (~mask)); // clear bit mask
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: AntennaOn
|
||
* Description: Turn on antenna, every time turn on or shut down antenna need at least 1ms delay
|
||
* Input parameter: null
|
||
* Return: null
|
||
*/
|
||
void RC522_antennaOn(void)
|
||
{
|
||
unsigned char temp;
|
||
|
||
temp = RC522_readReg(TxControlReg);
|
||
if (!(temp & 0x03))
|
||
{
|
||
RC522_setBitMask(TxControlReg, 0x03);
|
||
}
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: AntennaOff
|
||
* Description: Turn off antenna, every time turn on or shut down antenna need at least 1ms delay
|
||
* Input parameter: null
|
||
* Return: null
|
||
*/
|
||
void RC522_antennaOff(void)
|
||
{
|
||
RC522_clearBitMask(TxControlReg, 0x03);
|
||
}
|
||
|
||
/**
|
||
* Set the MFRC522 Receiver Gain (RxGain) to value specified by given mask.
|
||
* See 9.3.3.6 / table 98 in http://www.nxp.com/documents/data_sheet/MFRC522.pdf
|
||
* NOTE: Given mask is scrubbed with (0x07<<4)=01110000b as RCFfgReg may use reserved bits.
|
||
*/
|
||
void RC522_setAntennaGain(unsigned char mask) {
|
||
RC522_clearBitMask(RFCfgReg, (0x07<<4)); // clear needed to allow 000 pattern
|
||
RC522_setBitMask(RFCfgReg, (mask & 0x07)<<4); // only set RxGain[2:0] bits
|
||
}
|
||
|
||
/*
|
||
* Function: Reset
|
||
* Description: reset RC522
|
||
* Input parameter: null
|
||
* Return: null
|
||
*/
|
||
void RC522_reset(void)
|
||
{
|
||
RC522_writeReg(CommandReg, PCD_RESETPHASE);
|
||
}
|
||
|
||
/*
|
||
* Function: Request
|
||
* Description: Searching card, read card type
|
||
* Input parameter: reqMode--search methods，
|
||
* TagType--return card types
|
||
* 0x4400 = Mifare_UltraLight
|
||
* 0x0400 = Mifare_One(S50)
|
||
* 0x0200 = Mifare_One(S70)
|
||
* 0x0800 = Mifare_Pro(X)
|
||
* 0x4403 = Mifare_DESFire
|
||
* Return: return MI_OK if successed
|
||
*/
|
||
unsigned char RC522_request(unsigned char reqMode, unsigned char *TagType)
|
||
{
|
||
unsigned char status;
|
||
unsigned int backBits;
|
||
|
||
RC522_writeReg(BitFramingReg, 0x07); //TxLastBists = BitFramingReg[2..0] ???
|
||
|
||
TagType[0] = reqMode;
|
||
status = RC522_toCard(PCD_TRANSCEIVE, TagType, 1, TagType, &backBits);
|
||
|
||
if ((status != MI_OK) || (backBits != 0x10))
|
||
{
|
||
status = MI_ERR;
|
||
}
|
||
|
||
return status;
|
||
}
|
||
|
||
/*
|
||
* Function: ToCard
|
||
* Description: communicate between RC522 and ISO14443
|
||
* Input parameter: command--MF522 command bits
|
||
* sendData--send data to card via rc522
|
||
* sendLen--send data length
|
||
* backData--the return data from card
|
||
* backLen--the length of return data
|
||
* Return: return MI_OK if successed
|
||
*/
|
||
unsigned char RC522_toCard(unsigned char command, unsigned char *sendData, unsigned char sendLen, unsigned char *backData, unsigned int *backLen)
|
||
{
|
||
unsigned char status = MI_ERR;
|
||
unsigned char irqEn = 0x00;
|
||
unsigned char waitIRq = 0x00;
|
||
unsigned char lastBits;
|
||
unsigned char n;
|
||
unsigned int i;
|
||
|
||
switch (command)
|
||
{
|
||
case PCD_AUTHENT:
|
||
{
|
||
irqEn = 0x12;
|
||
waitIRq = 0x10;
|
||
break;
|
||
}
|
||
case PCD_TRANSCEIVE:
|
||
{
|
||
irqEn = 0x77;
|
||
waitIRq = 0x30;
|
||
break;
|
||
}
|
||
default:
|
||
break;
|
||
}
|
||
|
||
RC522_writeReg(CommIEnReg, irqEn|0x80);
|
||
RC522_clearBitMask(CommIrqReg, 0x80);
|
||
RC522_setBitMask(FIFOLevelReg, 0x80);
|
||
|
||
RC522_writeReg(CommandReg, PCD_IDLE);
|
||
|
||
for (i=0; i<sendLen; i++)
|
||
{
|
||
RC522_writeReg(FIFODataReg, sendData[i]);
|
||
}
|
||
|
||
RC522_writeReg(CommandReg, command);
|
||
if (command == PCD_TRANSCEIVE)
|
||
{
|
||
RC522_setBitMask(BitFramingReg, 0x80); //StartSend=1,transmission of data starts
|
||
}
|
||
|
||
i = 2000;
|
||
do
|
||
{
|
||
n = RC522_readReg(CommIrqReg);
|
||
i--;
|
||
}
|
||
while ((i!=0) && !(n&0x01) && !(n&waitIRq));
|
||
|
||
RC522_clearBitMask(BitFramingReg, 0x80); //StartSend=0
|
||
|
||
if (i != 0)
|
||
{
|
||
if(!(RC522_readReg(ErrorReg) & 0x1B)) //BufferOvfl Collerr CRCErr ProtecolErr
|
||
{
|
||
status = MI_OK;
|
||
if (n & irqEn & 0x01)
|
||
{
|
||
status = MI_NOTAGERR; //??
|
||
}
|
||
|
||
if (command == PCD_TRANSCEIVE)
|
||
{
|
||
n = RC522_readReg(FIFOLevelReg);
|
||
lastBits = RC522_readReg(ControlReg) & 0x07;
|
||
if (lastBits)
|
||
{
|
||
*backLen = (n-1)*8 + lastBits;
|
||
}
|
||
else
|
||
{
|
||
*backLen = n*8;
|
||
}
|
||
if (n == 0)
|
||
{
|
||
n = 1;
|
||
}
|
||
if (n > MAX_LEN)
|
||
{
|
||
n = MAX_LEN;
|
||
}
|
||
|
||
for (i=0; i<n; i++)
|
||
{
|
||
backData[i] = RC522_readReg(FIFODataReg);
|
||
}
|
||
}
|
||
}
|
||
else
|
||
{
|
||
status = MI_ERR;
|
||
}
|
||
}
|
||
|
||
//RC522_setBitMask(ControlReg,0x80); //timer stops
|
||
//RC522_writeReg(CommandReg, PCD_IDLE);
|
||
|
||
return status;
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: MFRC522_Anticoll
|
||
* Description: Prevent conflict, read the card serial number
|
||
* Input parameter: serNum--return the 4 bytes card serial number, the 5th byte is recheck byte
|
||
* Return: return MI_OK if successed
|
||
*/
|
||
unsigned char RC522_anticoll(unsigned char *serNum)
|
||
{
|
||
unsigned char status;
|
||
unsigned char i;
|
||
unsigned char serNumCheck=0;
|
||
unsigned int unLen;
|
||
|
||
|
||
//RC522_clearBitMask(Status2Reg, 0x08); //TempSensclear
|
||
//RC522_clearBitMask(CollReg,0x80); //ValuesAfterColl
|
||
RC522_writeReg(BitFramingReg, 0x00); //TxLastBists = BitFramingReg[2..0]
|
||
serNum[0] = PICC_ANTICOLL;
|
||
serNum[1] = 0x20;
|
||
status = RC522_toCard(PCD_TRANSCEIVE, serNum, 2, serNum, &unLen);
|
||
|
||
if (status == MI_OK)
|
||
{
|
||
for (i=0; i<4; i++)
|
||
{
|
||
serNumCheck ^= serNum[i];
|
||
}
|
||
if (serNumCheck != serNum[i])
|
||
{
|
||
status = MI_ERR;
|
||
}
|
||
}
|
||
|
||
//RC522_setBitMask(CollReg, 0x80); //ValuesAfterColl=1
|
||
|
||
return status;
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: CalulateCRC
|
||
* Description: Use MF522 to calculate CRC
|
||
* Input parameter: pIndata--the CRC data need to be read，len--data length，pOutData-- the caculated result of CRC
|
||
* Return: Null
|
||
*/
|
||
void RC522_calculateCRC(unsigned char *pIndata, unsigned char len, unsigned char *pOutData)
|
||
{
|
||
unsigned char i, n;
|
||
|
||
RC522_clearBitMask(DivIrqReg, 0x04); //CRCIrq = 0
|
||
RC522_setBitMask(FIFOLevelReg, 0x80);
|
||
//RC522_writeReg(CommandReg, PCD_IDLE);
|
||
|
||
for (i=0; i<len; i++)
|
||
{
|
||
RC522_writeReg(FIFODataReg, *(pIndata+i));
|
||
}
|
||
RC522_writeReg(CommandReg, PCD_CALCCRC);
|
||
|
||
i = 0xFF;
|
||
do
|
||
{
|
||
n = RC522_readReg(DivIrqReg);
|
||
i--;
|
||
}
|
||
while ((i!=0) && !(n&0x04)); //CRCIrq = 1
|
||
|
||
pOutData[0] = RC522_readReg(CRCResultRegL);
|
||
pOutData[1] = RC522_readReg(CRCResultRegM);
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: SelectTag
|
||
* Description: Select card, read card storage volume
|
||
* Input parameter: serNum--Send card serial number
|
||
* Return: return the card storage volume
|
||
*/
|
||
unsigned char RC522_selectTag(unsigned char *serNum)
|
||
{
|
||
unsigned char i;
|
||
unsigned char status;
|
||
unsigned char size;
|
||
unsigned int recvBits;
|
||
unsigned char buffer[9];
|
||
|
||
//RC522_clearBitMask(Status2Reg, 0x08); //MFCrypto1On=0
|
||
|
||
buffer[0] = PICC_SElECTTAG;
|
||
buffer[1] = 0x70;
|
||
for (i=0; i<5; i++)
|
||
{
|
||
buffer[i+2] = *(serNum+i);
|
||
}
|
||
RC522_calculateCRC(buffer, 7, &buffer[7]); //??
|
||
status = RC522_toCard(PCD_TRANSCEIVE, buffer, 9, buffer, &recvBits);
|
||
|
||
if ((status == MI_OK) && (recvBits == 0x18))
|
||
{
|
||
size = buffer[0];
|
||
}
|
||
else
|
||
{
|
||
size = 0;
|
||
}
|
||
|
||
return size;
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: Auth
|
||
* Description: verify card password
|
||
* Input parameters：authMode--password verify mode
|
||
0x60 = verify A password key
|
||
0x61 = verify B password key
|
||
BlockAddr--Block address
|
||
Sectorkey--Block password
|
||
serNum--Card serial number ，4 bytes
|
||
* Return: return MI_OK if successed
|
||
*/
|
||
unsigned char RC522_auth(unsigned char authMode, unsigned char BlockAddr, unsigned char *Sectorkey, unsigned char *serNum)
|
||
{
|
||
unsigned char status;
|
||
unsigned int recvBits;
|
||
unsigned char i;
|
||
unsigned char buff[12];
|
||
|
||
buff[0] = authMode;
|
||
buff[1] = BlockAddr;
|
||
for (i=0; i<6; i++)
|
||
{
|
||
buff[i+2] = *(Sectorkey+i);
|
||
}
|
||
for (i=0; i<4; i++)
|
||
{
|
||
buff[i+8] = *(serNum+i);
|
||
}
|
||
status = RC522_toCard(PCD_AUTHENT, buff, 12, buff, &recvBits);
|
||
|
||
if ((status != MI_OK) || (!(RC522_readReg(Status2Reg) & 0x08)))
|
||
{
|
||
status = MI_ERR;
|
||
}
|
||
|
||
return status;
|
||
}
|
||
|
||
/**
|
||
* Used to exit card from authenticated state.
|
||
* Remember to call this function after communicating with an authenticated card, otherwise no new communications can start.
|
||
*/
|
||
void RC522_stopCrypto() {
|
||
// Clear MFCrypto1On bit
|
||
RC522_clearBitMask(Status2Reg, 0x08); // Status2Reg[7..0] bits are: TempSensClear I2CForceHS reserved reserved MFCrypto1On ModemState[2:0]
|
||
}
|
||
|
||
/*
|
||
* Function: ReadBlock
|
||
* Description: Read data
|
||
* Input parameters：blockAddr--block address;recvData--the block data which are read
|
||
* Return: return MI_OK if successed
|
||
*/
|
||
unsigned char RC522_readBlock(unsigned char blockAddr, unsigned char *recvData)
|
||
{
|
||
unsigned char status;
|
||
unsigned int unLen;
|
||
|
||
recvData[0] = PICC_READ;
|
||
recvData[1] = blockAddr;
|
||
RC522_calculateCRC(recvData,2, &recvData[2]);
|
||
status = RC522_toCard(PCD_TRANSCEIVE, recvData, 4, recvData, &unLen);
|
||
|
||
if ((status != MI_OK) || (unLen != 0x90))
|
||
{
|
||
status = MI_ERR;
|
||
}
|
||
|
||
return status;
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: WriteBlock
|
||
* Description: write block data
|
||
* Input parameters：blockAddr--block address;writeData--Write 16 bytes data into block
|
||
* Return: return MI_OK if successed
|
||
*/
|
||
unsigned char RC522_writeBlock(unsigned char blockAddr, unsigned char *writeData)
|
||
{
|
||
unsigned char status;
|
||
unsigned int recvBits;
|
||
unsigned char i;
|
||
unsigned char buff[18];
|
||
|
||
buff[0] = PICC_WRITE;
|
||
buff[1] = blockAddr;
|
||
RC522_calculateCRC(buff, 2, &buff[2]);
|
||
status = RC522_toCard(PCD_TRANSCEIVE, buff, 4, buff, &recvBits);
|
||
|
||
if ((status != MI_OK) || (recvBits != 4) || ((buff[0] & 0x0F) != 0x0A))
|
||
{
|
||
status = MI_ERR;
|
||
}
|
||
|
||
if (status == MI_OK)
|
||
{
|
||
for (i=0; i<16; i++)
|
||
{
|
||
buff[i] = *(writeData+i);
|
||
}
|
||
RC522_calculateCRC(buff, 16, &buff[16]);
|
||
status = RC522_toCard(PCD_TRANSCEIVE, buff, 18, buff, &recvBits);
|
||
|
||
if ((status != MI_OK) || (recvBits != 4) || ((buff[0] & 0x0F) != 0x0A))
|
||
{
|
||
status = MI_ERR;
|
||
}
|
||
}
|
||
|
||
return status;
|
||
}
|
||
|
||
|
||
/*
|
||
* Function: Halt
|
||
* Description: Command the cards into sleep mode
|
||
* Input parameters: null
|
||
* Return: status
|
||
*/
|
||
unsigned char RC522_halt(void)
|
||
{
|
||
unsigned char status;
|
||
unsigned int unLen;
|
||
unsigned char buff[4];
|
||
|
||
buff[0] = PICC_HALT;
|
||
buff[1] = 0;
|
||
RC522_calculateCRC(buff, 2, &buff[2]);
|
||
|
||
status = RC522_toCard(PCD_TRANSCEIVE, buff, 4, buff,&unLen);
|
||
|
||
return status;
|
||
}
|