www.超碰,欧美日韩一区二区三区在线观看,国产一区二区三区色淫影院

/*
* RFID.cpp - Library to use ARDUINO RFID MODULE KIT 13.56 MHZ WITH TAGS SPI W AND R BY COOQROBOT.
* Based on code Dr.Leong
* Created by Miguel Balboa, Jan, 2012.
* Released into the public domain.
* TIDY BY YFRobot
*/
/******************************************************************************
* 包含文件
******************************************************************************/
#include <Arduino.h>
#include <RFID.h>
/******************************************************************************
* 構造 RFID
* int chipSelectPin RFID /ENABLE pin
******************************************************************************/
RFID::RFID(int chipSelectPin, int NRSTPD)
{
_chipSelectPin = chipSelectPin;
_NRSTPD = NRSTPD;
pinMode(_chipSelectPin,OUTPUT); // 設置管腳_chipSelectPin為輸出并連接到模塊使能口
digitalWrite(_chipSelectPin, LOW);
pinMode(_NRSTPD,OUTPUT); // 設置管腳NRSTPD為輸出，非重置或掉電
digitalWrite(_NRSTPD, HIGH);
}
/******************************************************************************
* 用戶 API
******************************************************************************/
/******************************************************************************
* 函數名：init
* 功能描述：初始化RC522
* 輸入參數：無
* 返回值：無
******************************************************************************/
void RFID::init()
{
digitalWrite(_NRSTPD,HIGH);
reset();
//Timer: TPrescaler*TreloadVal/6.78MHz = 24ms
writeMFRC522(TModeReg, 0x8D); //Tauto=1; f(Timer) = 6.78MHz/TPreScaler
writeMFRC522(TPrescalerReg, 0x3E); //TModeReg[3..0] + TPrescalerReg
writeMFRC522(TReloadRegL, 30);
writeMFRC522(TReloadRegH, 0);
writeMFRC522(TxAutoReg, 0x40); //100%ASK
writeMFRC522(ModeReg, 0x3D); // CRC valor inicial de 0x6363
//ClearBitMask(Status2Reg, 0x08); //MFCrypto1On=0
//writeMFRC522(RxSelReg, 0x86); //RxWait = RxSelReg[5..0]
//writeMFRC522(RFCfgReg, 0x7F); //RxGain = 48dB
antennaOn(); //打開天線
}
/******************************************************************************
* 函數名：reset
* 功能描述：復位RC522
* 輸入參數：無
* 返回值：無
******************************************************************************/
void RFID::reset()
{
writeMFRC522(CommandReg, PCD_RESETPHASE);
}
/******************************************************************************
* 函數名：writeMFRC522
* 功能描述：向MFRC522的某一寄存器寫一個字節數據
* 輸入參數：addr--寄存器地址；val--要寫入的值
* 返回值：無
******************************************************************************/
void RFID::writeMFRC522(unsigned char addr, unsigned char val)
{
digitalWrite(_chipSelectPin, LOW);
//地址格式：0XXXXXX0
SPI.transfer((addr<<1)&0x7E);
SPI.transfer(val);
digitalWrite(_chipSelectPin, HIGH);
}
/******************************************************************************
* 函數名：readMFRC522
* 功能描述：從MFRC522的某一寄存器讀一個字節數據
* 輸入參數：addr--寄存器地址
* 返回值：返回讀取到的一個字節數據
******************************************************************************/
unsigned char RFID::readMFRC522(unsigned char addr)
{
unsigned char val;
digitalWrite(_chipSelectPin, LOW);
SPI.transfer(((addr<<1)&0x7E) | 0x80);
val =SPI.transfer(0x00);
digitalWrite(_chipSelectPin, HIGH);
return val;
}
/******************************************************************************
* 函數名：setBitMask
* 功能描述：置RC522寄存器位
* 輸入參數：reg--寄存器地址;mask--置位值
* 返回值：無
******************************************************************************/
void RFID::setBitMask(unsigned char reg, unsigned char mask)
{
unsigned char tmp;
tmp = readMFRC522(reg);
writeMFRC522(reg, tmp | mask); // set bit mask
}
/******************************************************************************
* 函數名：clearBitMask
* 功能描述：清RC522寄存器位
* 輸入參數：reg--寄存器地址;mask--清位值
* 返回值：無
******************************************************************************/
void RFID::clearBitMask(unsigned char reg, unsigned char mask)
{
unsigned char tmp;
tmp = readMFRC522(reg);
writeMFRC522(reg, tmp & (~mask)); // clear bit mask
}
/******************************************************************************
* 函數名：antennaOn
* 功能描述：開啟天線,每次啟動或關閉天險發射之間應至少有1ms的間隔
* 輸入參數：無
* 返回值：無
******************************************************************************/
void RFID::antennaOn(void)
{
unsigned char temp;
temp = readMFRC522(TxControlReg);
if (!(temp & 0x03))
{
setBitMask(TxControlReg, 0x03);
}
}
/******************************************************************************
* 函數名：antennaOff
* 功能描述：關閉天線,每次啟動或關閉天險發射之間應至少有1ms的間隔
* 輸入參數：無
* 返回值：無
******************************************************************************/
void RFID::antennaOff(void)
{
unsigned char temp;
temp = readMFRC522(TxControlReg);
if (!(temp & 0x03))
{
clearBitMask(TxControlReg, 0x03);
}
}
/******************************************************************************
* 函數名：calculateCRC
* 功能描述：用MF522計算CRC
* 輸入參數：pIndata--要讀數CRC的數據，len--數據長度，pOutData--計算的CRC結果
* 返回值：無
******************************************************************************/
void RFID::calculateCRC(unsigned char *pIndata, unsigned char len, unsigned char *pOutData)
{
unsigned char i, n;
clearBitMask(DivIrqReg, 0x04); //CRCIrq = 0
setBitMask(FIFOLevelReg, 0x80); //清FIFO指針
//Write_MFRC522(CommandReg, PCD_IDLE);
//向FIFO中寫入數據
for (i=0; i<len; i++)
writeMFRC522(FIFODataReg, *(pIndata+i));
writeMFRC522(CommandReg, PCD_CALCCRC);
//等待CRC計算完成
i = 0xFF;
do
{
n = readMFRC522(DivIrqReg);
i--;
}
while ((i!=0) && !(n&0x04)); //CRCIrq = 1
//讀取CRC計算結果
pOutData[0] = readMFRC522(CRCResultRegL);
pOutData[1] = readMFRC522(CRCResultRegM);
}
/******************************************************************************
* 函數名：MFRC522ToCard
* 功能描述：RC522和ISO14443卡通訊
* 輸入參數：command--MF522命令字，
* sendData--通過RC522發送到卡片的數據,
* sendLen--發送的數據長度
* backData--接收到的卡片返回數據，
* backLen--返回數據的位長度
* 返回值：成功返回MI_OK
******************************************************************************/
unsigned char RFID::MFRC522ToCard(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: //發送FIFO中數據
{
irqEn = 0x77;
waitIRq = 0x30;
break;
}
default:
break;
}
writeMFRC522(CommIEnReg, irqEn|0x80); //允許中斷請求
clearBitMask(CommIrqReg, 0x80); //清除所有中斷請求位
setBitMask(FIFOLevelReg, 0x80); //FlushBuffer=1, FIFO初始化
writeMFRC522(CommandReg, PCD_IDLE); //無動作，取消當前命令
//向FIFO中寫入數據
for (i=0; i<sendLen; i++)
writeMFRC522(FIFODataReg, sendData[i]);
//執行命令
writeMFRC522(CommandReg, command);
if (command == PCD_TRANSCEIVE)
setBitMask(BitFramingReg, 0x80); //StartSend=1,transmission of data starts
//等待接收數據完成
i = 2000; //i根據時鐘頻率調整，操作M1卡最大等待時間25ms
do
{
//CommIrqReg[7..0]
//Set1 TxIRq RxIRq IdleIRq HiAlerIRq LoAlertIRq ErrIRq TimerIRq
n = readMFRC522(CommIrqReg);
i--;
}
while ((i!=0) && !(n&0x01) && !(n&waitIRq));
clearBitMask(BitFramingReg, 0x80); //StartSend=0
if (i != 0)
{
if(!(readMFRC522(ErrorReg) & 0x1B)) //BufferOvfl Collerr CRCErr ProtecolErr
{
status = MI_OK;
if (n & irqEn & 0x01)
status = MI_NOTAGERR; //??
if (command == PCD_TRANSCEIVE)
{
n = readMFRC522(FIFOLevelReg);
lastBits = readMFRC522(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;
//讀取FIFO中接收到的數據
for (i=0; i<n; i++)
backData[i] = readMFRC522(FIFODataReg);
}
}
else
status = MI_ERR;
}
//SetBitMask(ControlReg,0x80); //timer stops
//Write_MFRC522(CommandReg, PCD_IDLE);
return status;
}
/******************************************************************************
* 函數名：findCard
* 功能描述：尋卡，讀取卡類型號
* 輸入參數：reqMode--尋卡方式，
* TagType--返回卡片類型
* 0x4400 = Mifare_UltraLight
* 0x0400 = Mifare_One(S50)
* 0x0200 = Mifare_One(S70)
* 0x0800 = Mifare_Pro(X)
* 0x4403 = Mifare_DESFire
* 返回值：成功返回MI_OK
******************************************************************************/
unsigned char RFID::findCard(unsigned char reqMode, unsigned char *TagType)
{
unsigned char status;
unsigned int backBits; //接收到的數據位數
writeMFRC522(BitFramingReg, 0x07); //TxLastBists = BitFramingReg[2..0] ???
TagType[0] = reqMode;
status = MFRC522ToCard(PCD_TRANSCEIVE, TagType, 1, TagType, &backBits);
if ((status != MI_OK) || (backBits != 0x10))
status = MI_ERR;
return status;
}
/******************************************************************************
* 函數名：anticoll
* 功能描述：防沖突檢測，讀取選中卡片的卡序列號
* 輸入參數：serNum--返回4字節卡序列號,第5字節為校驗字節
* 返回值：成功返回MI_OK
******************************************************************************/
unsigned char RFID::anticoll(unsigned char *serNum)
{
unsigned char status;
unsigned char i;
unsigned char serNumCheck=0;
unsigned int unLen;
clearBitMask(Status2Reg, 0x08); //TempSensclear
clearBitMask(CollReg,0x80); //ValuesAfterColl
writeMFRC522(BitFramingReg, 0x00); //TxLastBists = BitFramingReg[2..0]
serNum[0] = PICC_ANTICOLL;
serNum[1] = 0x20;
status = MFRC522ToCard(PCD_TRANSCEIVE, serNum, 2, serNum, &unLen);
if (status == MI_OK)
{
//校驗卡序列號
for (i=0; i<4; i++){
*(serNum+i) = serNum[i];
serNumCheck ^= serNum[i];
}
if (serNumCheck != serNum[i]){
status = MI_ERR;
}
}
setBitMask(CollReg, 0x80); //ValuesAfterColl=1
return status;
}
/******************************************************************************
* 函數名：auth
* 功能描述：驗證卡片密碼
* 輸入參數：authMode--密碼驗證模式
* 0x60 = 驗證A密鑰
* 0x61 = 驗證B密鑰
* BlockAddr--塊地址
* Sectorkey--扇區密碼
* serNum--卡片序列號，4字節
* 返回值：成功返回MI_OK
******************************************************************************/
unsigned char RFID::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 = MFRC522ToCard(PCD_AUTHENT, buff, 12, buff, &recvBits);
if ((status != MI_OK) || (!(readMFRC522(Status2Reg) & 0x08)))
status = MI_ERR;
return status;
}
/******************************************************************************
* 函數名：read
* 功能描述：讀塊數據
* 輸入參數：blockAddr--塊地址;recvData--讀出的塊數據
* 返回值：成功返回MI_OK
******************************************************************************/
unsigned char RFID::read(unsigned char blockAddr, unsigned char *recvData)
{
unsigned char status;
unsigned int unLen;
recvData[0] = PICC_READ;
recvData[1] = blockAddr;
calculateCRC(recvData,2, &recvData[2]);
status = MFRC522ToCard(PCD_TRANSCEIVE, recvData, 4, recvData, &unLen);
if ((status != MI_OK) || (unLen != 0x90))
status = MI_ERR;
return status;
}
/******************************************************************************
* 函數名：write
* 功能描述：寫塊數據
* 輸入參數：blockAddr--塊地址;writeData--向塊寫16字節數據
* 返回值：成功返回MI_OK
******************************************************************************/
unsigned char RFID::write(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;
calculateCRC(buff, 2, &buff[2]);
status = MFRC522ToCard(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++) //?FIFO?16Byte?? Datos a la FIFO 16Byte escribir
buff[i] = *(writeData+i);
calculateCRC(buff, 16, &buff[16]);
status = MFRC522ToCard(PCD_TRANSCEIVE, buff, 18, buff, &recvBits);
if ((status != MI_OK) || (recvBits != 4) || ((buff[0] & 0x0F) != 0x0A))
status = MI_ERR;
}
return status;
}
/******************************************************************************
* 函數名：selectTag
* 功能描述：選卡，讀取卡存儲器容量
* 輸入參數：serNum--傳入卡序列號
* 返回值：成功返回卡容量
******************************************************************************/
unsigned char RFID::selectTag(unsigned char *serNum)
{
unsigned char i;
unsigned char status;
unsigned char size;
unsigned int recvBits;
unsigned char buffer[9];
//ClearBitMask(Status2Reg, 0x08); //MFCrypto1On=0
buffer[0] = PICC_SElECTTAG;
buffer[1] = 0x70;
for (i=0; i<5; i++)
buffer[i+2] = *(serNum+i);
calculateCRC(buffer, 7, &buffer[7]);
status = MFRC522ToCard(PCD_TRANSCEIVE, buffer, 9, buffer, &recvBits);
if ((status == MI_OK) && (recvBits == 0x18))
size = buffer[i];
else
size = 0;
return size;
}
/******************************************************************************
* 函數名：Halt
* 功能描述：命令卡片進入休眠狀態
* 輸入參數：無
* 返回值：無
******************************************************************************/
void RFID::halt()
{
unsigned char status;
unsigned int unLen;
unsigned char buff[4];
buff[0] = PICC_HALT;
buff[1] = 0;
calculateCRC(buff, 2, &buff[2]);
status = MFRC522ToCard(PCD_TRANSCEIVE, buff, 4, buff,&unLen);
}

復制代碼

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费