init
commit
8a017cc14f
|
|
@ -0,0 +1,678 @@
|
|||
#include <SPI.h>
|
||||
#define uchar unsigned char
|
||||
#define uint unsigned int
|
||||
#define MAX_LEN 16
|
||||
#define PCD_IDLE 0x00
|
||||
#define PCD_AUTHENT 0x0E
|
||||
#define PCD_RECEIVE 0x08
|
||||
#define PCD_TRANSMIT 0x04
|
||||
#define PCD_TRANSCEIVE 0x0C
|
||||
#define PCD_RESETPHASE 0x0F
|
||||
#define PCD_CALCCRC 0x03
|
||||
#define PICC_REQIDL 0x26
|
||||
#define PICC_REQALL 0x52
|
||||
#define PICC_ANTICOLL 0x93
|
||||
#define PICC_SElECTTAG 0x93
|
||||
#define PICC_AUTHENT1A 0x60
|
||||
#define PICC_AUTHENT1B 0x61
|
||||
#define PICC_READ 0x30
|
||||
#define PICC_WRITE 0xA0
|
||||
#define PICC_DECREMENT 0xC0
|
||||
#define PICC_INCREMENT 0xC1
|
||||
#define PICC_RESTORE 0xC2
|
||||
#define PICC_TRANSFER 0xB0
|
||||
#define PICC_HALT 0x50
|
||||
#define MI_OK 0
|
||||
#define MI_NOTAGERR 1
|
||||
#define MI_ERR 2
|
||||
#define Reserved00 0x00
|
||||
#define CommandReg 0x01
|
||||
#define CommIEnReg 0x02
|
||||
#define DivlEnReg 0x03
|
||||
#define CommIrqReg 0x04
|
||||
#define DivIrqReg 0x05
|
||||
#define ErrorReg 0x06
|
||||
#define Status1Reg 0x07
|
||||
#define Status2Reg 0x08
|
||||
#define FIFODataReg 0x09
|
||||
#define FIFOLevelReg 0x0A
|
||||
#define WaterLevelReg 0x0B
|
||||
#define ControlReg 0x0C
|
||||
#define BitFramingReg 0x0D
|
||||
#define CollReg 0x0E
|
||||
#define Reserved01 0x0F
|
||||
#define Reserved10 0x10
|
||||
#define ModeReg 0x11
|
||||
#define TxModeReg 0x12
|
||||
#define RxModeReg 0x13
|
||||
#define TxControlReg 0x14
|
||||
#define TxAutoReg 0x15
|
||||
#define TxSelReg 0x16
|
||||
#define RxSelReg 0x17
|
||||
#define RxThresholdReg 0x18
|
||||
#define DemodReg 0x19
|
||||
#define Reserved11 0x1A
|
||||
#define Reserved12 0x1B
|
||||
#define MifareReg 0x1C
|
||||
#define Reserved13 0x1D
|
||||
#define Reserved14 0x1E
|
||||
#define SerialSpeedReg 0x1F
|
||||
#define Reserved20 0x20
|
||||
#define CRCResultRegM 0x21
|
||||
#define CRCResultRegL 0x22
|
||||
#define Reserved21 0x23
|
||||
#define ModWidthReg 0x24
|
||||
#define Reserved22 0x25
|
||||
#define RFCfgReg 0x26
|
||||
#define GsNReg 0x27
|
||||
#define CWGsPReg 0x28
|
||||
#define ModGsPReg 0x29
|
||||
#define TModeReg 0x2A
|
||||
#define TPrescalerReg 0x2B
|
||||
#define TReloadRegH 0x2C
|
||||
#define TReloadRegL 0x2D
|
||||
#define TCounterValueRegH 0x2E
|
||||
#define TCounterValueRegL 0x2F
|
||||
#define Reserved30 0x30
|
||||
#define TestSel1Reg 0x31
|
||||
#define TestSel2Reg 0x32
|
||||
#define TestPinEnReg 0x33
|
||||
#define TestPinValueReg 0x34
|
||||
#define TestBusReg 0x35
|
||||
#define AutoTestReg 0x36
|
||||
#define VersionReg 0x37
|
||||
#define AnalogTestReg 0x38
|
||||
#define TestDAC1Reg 0x39
|
||||
#define TestDAC2Reg 0x3A
|
||||
#define TestADCReg 0x3B
|
||||
#define Reserved31 0x3C
|
||||
#define Reserved32 0x3D
|
||||
#define Reserved33 0x3E
|
||||
#define Reserved34 0x3F
|
||||
//-----------------------------------------------
|
||||
const int chipSelectPin = 10;
|
||||
const int NRSTPD = 5;
|
||||
/*
|
||||
* 函 数 名：Write_MFRC5200
|
||||
* 功能描述：向MFRC522的某一寄存器写一个字节数据
|
||||
* 输入参数：addr--寄存器地址；val--要写入的值
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void Write_MFRC522(uchar addr, uchar val)
|
||||
{
|
||||
digitalWrite(chipSelectPin, LOW);
|
||||
|
||||
//地址格式：0XXXXXX0
|
||||
SPI.transfer((addr<<1)&0x7E);
|
||||
SPI.transfer(val);
|
||||
|
||||
digitalWrite(chipSelectPin, HIGH);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：Read_MFRC522
|
||||
* 功能描述：从MFRC522的某一寄存器读一个字节数据
|
||||
* 输入参数：addr--寄存器地址
|
||||
* 返 回 值：返回读取到的一个字节数据
|
||||
*/
|
||||
uchar Read_MFRC522(uchar addr)
|
||||
{
|
||||
uchar val;
|
||||
|
||||
digitalWrite(chipSelectPin, LOW);
|
||||
|
||||
//地址格式：1XXXXXX0
|
||||
SPI.transfer(((addr<<1)&0x7E) | 0x80);
|
||||
val =SPI.transfer(0x00);
|
||||
|
||||
digitalWrite(chipSelectPin, HIGH);
|
||||
|
||||
return val;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函 数 名：SetBitMask
|
||||
* 功能描述：置RC522寄存器位
|
||||
* 输入参数：reg--寄存器地址;mask--置位值
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void SetBitMask(uchar reg, uchar mask)
|
||||
{
|
||||
uchar tmp;
|
||||
tmp = Read_MFRC522(reg);
|
||||
Write_MFRC522(reg, tmp | mask); // set bit mask
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：ClearBitMask
|
||||
* 功能描述：清RC522寄存器位
|
||||
* 输入参数：reg--寄存器地址;mask--清位值
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void ClearBitMask(uchar reg, uchar mask)
|
||||
{
|
||||
uchar tmp;
|
||||
tmp = Read_MFRC522(reg);
|
||||
Write_MFRC522(reg, tmp & (~mask)); // clear bit mask
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：AntennaOn
|
||||
* 功能描述：开启天线,每次启动或关闭天险发射之间应至少有1ms的间隔
|
||||
* 输入参数：无
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void AntennaOn(void)
|
||||
{
|
||||
uchar temp;
|
||||
|
||||
temp = Read_MFRC522(TxControlReg);
|
||||
if (!(temp & 0x03))
|
||||
{
|
||||
SetBitMask(TxControlReg, 0x03);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：AntennaOff
|
||||
* 功能描述：关闭天线,每次启动或关闭天险发射之间应至少有1ms的间隔
|
||||
* 输入参数：无
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void AntennaOff(void)
|
||||
{
|
||||
ClearBitMask(TxControlReg, 0x03);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：ResetMFRC522
|
||||
* 功能描述：复位RC522
|
||||
* 输入参数：无
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void MFRC522_Reset(void)
|
||||
{
|
||||
Write_MFRC522(CommandReg, PCD_RESETPHASE);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：InitMFRC522
|
||||
* 功能描述：初始化RC522
|
||||
* 输入参数：无
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void MFRC522_Init(void)
|
||||
{
|
||||
digitalWrite(NRSTPD,HIGH);
|
||||
|
||||
MFRC522_Reset();
|
||||
|
||||
//Timer: TPrescaler*TreloadVal/6.78MHz = 24ms
|
||||
Write_MFRC522(TModeReg, 0x8D); //Tauto=1; f(Timer) = 6.78MHz/TPreScaler
|
||||
Write_MFRC522(TPrescalerReg, 0x3E); //TModeReg[3..0] + TPrescalerReg
|
||||
Write_MFRC522(TReloadRegL, 30);
|
||||
Write_MFRC522(TReloadRegH, 0);
|
||||
|
||||
Write_MFRC522(TxAutoReg, 0x40); //100%ASK
|
||||
Write_MFRC522(ModeReg, 0x3D); //CRC初始值0x6363 ???
|
||||
|
||||
//ClearBitMask(Status2Reg, 0x08); //MFCrypto1On=0
|
||||
//Write_MFRC522(RxSelReg, 0x86); //RxWait = RxSelReg[5..0]
|
||||
//Write_MFRC522(RFCfgReg, 0x7F); //RxGain = 48dB
|
||||
|
||||
AntennaOn(); //打开天线
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_Request
|
||||
* 功能描述：寻卡，读取卡类型号
|
||||
* 输入参数：reqMode--寻卡方式，
|
||||
* TagType--返回卡片类型
|
||||
* 0x4400 = Mifare_UltraLight
|
||||
* 0x0400 = Mifare_One(S50)
|
||||
* 0x0200 = Mifare_One(S70)
|
||||
* 0x0800 = Mifare_Pro(X)
|
||||
* 0x4403 = Mifare_DESFire
|
||||
* 返 回 值：成功返回MI_OK
|
||||
*/
|
||||
uchar MFRC522_Request(uchar reqMode, uchar *TagType)
|
||||
{
|
||||
uchar status;
|
||||
uint backBits; //接收到的数据位数
|
||||
|
||||
Write_MFRC522(BitFramingReg, 0x07); //TxLastBists = BitFramingReg[2..0] ???
|
||||
|
||||
TagType[0] = reqMode;
|
||||
status = MFRC522_ToCard(PCD_TRANSCEIVE, TagType, 1, TagType, &backBits);
|
||||
|
||||
if ((status != MI_OK) || (backBits != 0x10))
|
||||
{
|
||||
status = MI_ERR;
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_ToCard
|
||||
* 功能描述：RC522和ISO14443卡通讯
|
||||
* 输入参数：command--MF522命令字，
|
||||
* sendData--通过RC522发送到卡片的数据,
|
||||
* sendLen--发送的数据长度
|
||||
* backData--接收到的卡片返回数据，
|
||||
* backLen--返回数据的位长度
|
||||
* 返 回 值：成功返回MI_OK
|
||||
*/
|
||||
uchar MFRC522_ToCard(uchar command, uchar *sendData, uchar sendLen, uchar *backData, uint *backLen)
|
||||
{
|
||||
uchar status = MI_ERR;
|
||||
uchar irqEn = 0x00;
|
||||
uchar waitIRq = 0x00;
|
||||
uchar lastBits;
|
||||
uchar n;
|
||||
uint i;
|
||||
|
||||
switch (command)
|
||||
{
|
||||
case PCD_AUTHENT: //认证卡密
|
||||
{
|
||||
irqEn = 0x12;
|
||||
waitIRq = 0x10;
|
||||
break;
|
||||
}
|
||||
case PCD_TRANSCEIVE: //发送FIFO中数据
|
||||
{
|
||||
irqEn = 0x77;
|
||||
waitIRq = 0x30;
|
||||
break;
|
||||
}
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
Write_MFRC522(CommIEnReg, irqEn|0x80); //允许中断请求
|
||||
ClearBitMask(CommIrqReg, 0x80); //清除所有中断请求位
|
||||
SetBitMask(FIFOLevelReg, 0x80); //FlushBuffer=1, FIFO初始化
|
||||
|
||||
Write_MFRC522(CommandReg, PCD_IDLE); //NO action;取消当前命令 ???
|
||||
|
||||
//向FIFO中写入数据
|
||||
for (i=0; i<sendLen; i++)
|
||||
{
|
||||
Write_MFRC522(FIFODataReg, sendData[i]);
|
||||
}
|
||||
|
||||
//执行命令
|
||||
Write_MFRC522(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 = Read_MFRC522(CommIrqReg);
|
||||
i--;
|
||||
}
|
||||
while ((i!=0) && !(n&0x01) && !(n&waitIRq));
|
||||
|
||||
ClearBitMask(BitFramingReg, 0x80); //StartSend=0
|
||||
|
||||
if (i != 0)
|
||||
{
|
||||
if(!(Read_MFRC522(ErrorReg) & 0x1B)) //BufferOvfl Collerr CRCErr ProtecolErr
|
||||
{
|
||||
status = MI_OK;
|
||||
if (n & irqEn & 0x01)
|
||||
{
|
||||
status = MI_NOTAGERR; //??
|
||||
}
|
||||
|
||||
if (command == PCD_TRANSCEIVE)
|
||||
{
|
||||
n = Read_MFRC522(FIFOLevelReg);
|
||||
lastBits = Read_MFRC522(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] = Read_MFRC522(FIFODataReg);
|
||||
}
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
status = MI_ERR;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//SetBitMask(ControlReg,0x80); //timer stops
|
||||
//Write_MFRC522(CommandReg, PCD_IDLE);
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_Anticoll
|
||||
* 功能描述：防冲突检测，读取选中卡片的卡序列号
|
||||
* 输入参数：serNum--返回4字节卡序列号,第5字节为校验字节
|
||||
* 返 回 值：成功返回MI_OK
|
||||
*/
|
||||
uchar MFRC522_Anticoll(uchar *serNum)
|
||||
{
|
||||
uchar status;
|
||||
uchar i;
|
||||
uchar serNumCheck=0;
|
||||
uint unLen;
|
||||
|
||||
|
||||
//ClearBitMask(Status2Reg, 0x08); //TempSensclear
|
||||
//ClearBitMask(CollReg,0x80); //ValuesAfterColl
|
||||
Write_MFRC522(BitFramingReg, 0x00); //TxLastBists = BitFramingReg[2..0]
|
||||
|
||||
serNum[0] = PICC_ANTICOLL;
|
||||
serNum[1] = 0x20;
|
||||
status = MFRC522_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;
|
||||
}
|
||||
}
|
||||
|
||||
//SetBitMask(CollReg, 0x80); //ValuesAfterColl=1
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：CalulateCRC
|
||||
* 功能描述：用MF522计算CRC
|
||||
* 输入参数：pIndata--要读数CRC的数据，len--数据长度，pOutData--计算的CRC结果
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void CalulateCRC(uchar *pIndata, uchar len, uchar *pOutData)
|
||||
{
|
||||
uchar i, n;
|
||||
|
||||
ClearBitMask(DivIrqReg, 0x04); //CRCIrq = 0
|
||||
SetBitMask(FIFOLevelReg, 0x80); //清FIFO指针
|
||||
//Write_MFRC522(CommandReg, PCD_IDLE);
|
||||
|
||||
//向FIFO中写入数据
|
||||
for (i=0; i<len; i++)
|
||||
{
|
||||
Write_MFRC522(FIFODataReg, *(pIndata+i));
|
||||
}
|
||||
Write_MFRC522(CommandReg, PCD_CALCCRC);
|
||||
|
||||
//等待CRC计算完成
|
||||
i = 0xFF;
|
||||
do
|
||||
{
|
||||
n = Read_MFRC522(DivIrqReg);
|
||||
i--;
|
||||
}
|
||||
while ((i!=0) && !(n&0x04)); //CRCIrq = 1
|
||||
|
||||
//读取CRC计算结果
|
||||
pOutData[0] = Read_MFRC522(CRCResultRegL);
|
||||
pOutData[1] = Read_MFRC522(CRCResultRegM);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_SelectTag
|
||||
* 功能描述：选卡，读取卡存储器容量
|
||||
* 输入参数：serNum--传入卡序列号
|
||||
* 返 回 值：成功返回卡容量
|
||||
*/
|
||||
uchar MFRC522_SelectTag(uchar *serNum)
|
||||
{
|
||||
uchar i;
|
||||
uchar status;
|
||||
uchar size;
|
||||
uint recvBits;
|
||||
uchar 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);
|
||||
}
|
||||
CalulateCRC(buffer, 7, &buffer[7]); //??
|
||||
status = MFRC522_ToCard(PCD_TRANSCEIVE, buffer, 9, buffer, &recvBits);
|
||||
|
||||
if ((status == MI_OK) && (recvBits == 0x18))
|
||||
{
|
||||
size = buffer[0];
|
||||
}
|
||||
else
|
||||
{
|
||||
size = 0;
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_Auth
|
||||
* 功能描述：验证卡片密码
|
||||
* 输入参数：authMode--密码验证模式
|
||||
0x60 = 验证A密钥
|
||||
0x61 = 验证B密钥
|
||||
BlockAddr--块地址
|
||||
Sectorkey--扇区密码
|
||||
serNum--卡片序列号，4字节
|
||||
* 返 回 值：成功返回MI_OK
|
||||
*/
|
||||
uchar MFRC522_Auth(uchar authMode, uchar BlockAddr, uchar *Sectorkey, uchar *serNum)
|
||||
{
|
||||
uchar status;
|
||||
uint recvBits;
|
||||
uchar i;
|
||||
uchar 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 = MFRC522_ToCard(PCD_AUTHENT, buff, 12, buff, &recvBits);
|
||||
|
||||
if ((status != MI_OK) || (!(Read_MFRC522(Status2Reg) & 0x08)))
|
||||
{
|
||||
status = MI_ERR;
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_Read
|
||||
* 功能描述：读块数据
|
||||
* 输入参数：blockAddr--块地址;recvData--读出的块数据
|
||||
* 返 回 值：成功返回MI_OK
|
||||
*/
|
||||
uchar MFRC522_Read(uchar blockAddr, uchar *recvData)
|
||||
{
|
||||
uchar status;
|
||||
uint unLen;
|
||||
|
||||
recvData[0] = PICC_READ;
|
||||
recvData[1] = blockAddr;
|
||||
CalulateCRC(recvData,2, &recvData[2]);
|
||||
status = MFRC522_ToCard(PCD_TRANSCEIVE, recvData, 4, recvData, &unLen);
|
||||
|
||||
if ((status != MI_OK) || (unLen != 0x90))
|
||||
{
|
||||
status = MI_ERR;
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_Write
|
||||
* 功能描述：写块数据
|
||||
* 输入参数：blockAddr--块地址;writeData--向块写16字节数据
|
||||
* 返 回 值：成功返回MI_OK
|
||||
*/
|
||||
uchar MFRC522_Write(uchar blockAddr, uchar *writeData)
|
||||
{
|
||||
uchar status;
|
||||
uint recvBits;
|
||||
uchar i;
|
||||
uchar buff[18];
|
||||
|
||||
buff[0] = PICC_WRITE;
|
||||
buff[1] = blockAddr;
|
||||
CalulateCRC(buff, 2, &buff[2]);
|
||||
status = MFRC522_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++) //向FIFO写16Byte数据
|
||||
{
|
||||
buff[i] = *(writeData+i);
|
||||
}
|
||||
CalulateCRC(buff, 16, &buff[16]);
|
||||
status = MFRC522_ToCard(PCD_TRANSCEIVE, buff, 18, buff, &recvBits);
|
||||
|
||||
if ((status != MI_OK) || (recvBits != 4) || ((buff[0] & 0x0F) != 0x0A))
|
||||
{
|
||||
status = MI_ERR;
|
||||
}
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* 函 数 名：MFRC522_Halt
|
||||
* 功能描述：命令卡片进入休眠状态
|
||||
* 输入参数：无
|
||||
* 返 回 值：无
|
||||
*/
|
||||
void MFRC522_Halt(void)
|
||||
{
|
||||
uchar status;
|
||||
uint unLen;
|
||||
uchar buff[4];
|
||||
|
||||
buff[0] = PICC_HALT;
|
||||
buff[1] = 0;
|
||||
CalulateCRC(buff, 2, &buff[2]);
|
||||
|
||||
status = MFRC522_ToCard(PCD_TRANSCEIVE, buff, 4, buff,&unLen);
|
||||
}
|
||||
|
||||
|
||||
const int scalePin = A0;
|
||||
|
||||
uchar serNum[5];
|
||||
|
||||
void setup() {
|
||||
Serial.begin(9600);
|
||||
SPI.begin();
|
||||
pinMode(chipSelectPin,OUTPUT); // Set digital pin 10 as OUTPUT to connect it to the RFID /ENABLE pin
|
||||
digitalWrite(chipSelectPin, LOW); // Activate the RFID reader
|
||||
pinMode(NRSTPD,OUTPUT); // Set digital pin 10 , Not Reset and Power-down
|
||||
digitalWrite(NRSTPD, HIGH);
|
||||
MFRC522_Init();
|
||||
}
|
||||
|
||||
int sample = 120; // Próbka (średnia z n pomiarów)
|
||||
int stp = 0; // Numer pomiaru
|
||||
unsigned long int sum = 0; // Suma w n-tym pomiarze
|
||||
|
||||
void loop()
|
||||
{
|
||||
uchar status;
|
||||
uchar str[MAX_LEN];
|
||||
uchar RC_size;
|
||||
uchar blockAddr;
|
||||
|
||||
// Zbieranie i uśrdnianie wyników
|
||||
if (stp == sample) {
|
||||
Serial.print(sum/sample);
|
||||
sum = 0;
|
||||
stp = 0;
|
||||
|
||||
// Całe to gówno z RFIDami
|
||||
status = MFRC522_Request(PICC_REQIDL, str);
|
||||
status = MFRC522_Anticoll(str);
|
||||
memcpy(serNum, str, 5);
|
||||
if (status == MI_OK)
|
||||
{
|
||||
Serial.print("; " );
|
||||
Serial.print(serNum[0],HEX);
|
||||
Serial.print(serNum[1],HEX);
|
||||
Serial.print(serNum[2],HEX);
|
||||
Serial.println(serNum[3],HEX);
|
||||
} else {
|
||||
Serial.println("");
|
||||
}
|
||||
MFRC522_Halt();
|
||||
} else {
|
||||
sum += analogRead(scalePin);
|
||||
stp += 1;
|
||||
}
|
||||
}
|
||||
|
|
@ -0,0 +1,65 @@
|
|||
"""
|
||||
Listen to serial, return most recent numeric values
|
||||
Lots of help from here:
|
||||
http://stackoverflow.com/questions/1093598/pyserial-how-to-read-last-line-sent-from-serial-device
|
||||
"""
|
||||
from threading import Thread
|
||||
import time
|
||||
import serial
|
||||
|
||||
last_received = ''
|
||||
def receiving(ser):
|
||||
global last_received
|
||||
buffer = ''
|
||||
while True:
|
||||
buffer = buffer + ser.read(ser.inWaiting())
|
||||
if '\n' in buffer:
|
||||
lines = buffer.split('\n') # Guaranteed to have at least 2 entries
|
||||
last_received = lines[-2]
|
||||
#If the Arduino sends lots of empty lines, you'll lose the
|
||||
#last filled line, so you could make the above statement conditional
|
||||
#like so: if lines[-2]: last_received = lines[-2]
|
||||
buffer = lines[-1]
|
||||
|
||||
|
||||
class SerialData(object):
|
||||
def __init__(self, init=50):
|
||||
try:
|
||||
self.ser = ser = serial.Serial(
|
||||
port='/dev/ttyACM0',
|
||||
baudrate=9600,
|
||||
bytesize=serial.EIGHTBITS,
|
||||
parity=serial.PARITY_NONE,
|
||||
stopbits=serial.STOPBITS_ONE,
|
||||
timeout=0.1,
|
||||
xonxoff=0,
|
||||
rtscts=0,
|
||||
interCharTimeout=None
|
||||
)
|
||||
except serial.serialutil.SerialException:
|
||||
#no serial connection
|
||||
self.ser = None
|
||||
else:
|
||||
Thread(target=receiving, args=(self.ser,)).start()
|
||||
|
||||
def next(self):
|
||||
if not self.ser:
|
||||
return 100 #return anything so we can test when Arduino isn't connected
|
||||
#return a float value or try a few times until we get one
|
||||
for i in range(40):
|
||||
raw_line = last_received
|
||||
try:
|
||||
return float(raw_line.strip())
|
||||
except ValueError:
|
||||
print 'bogus data',raw_line
|
||||
time.sleep(.005)
|
||||
return 0.
|
||||
def __del__(self):
|
||||
if self.ser:
|
||||
self.ser.close()
|
||||
|
||||
if __name__=='__main__':
|
||||
s = SerialData()
|
||||
for i in range(500):
|
||||
time.sleep(.015)
|
||||
print s.next()
|
||||
|
|
@ -0,0 +1,320 @@
|
|||
"""
|
||||
GP:
|
||||
Changed datasource, title, and refresh interval to use
|
||||
as a poor man's Arduino oscilliscope.
|
||||
|
||||
This demo demonstrates how to draw a dynamic mpl (matplotlib)
|
||||
plot in a wxPython application.
|
||||
|
||||
It allows "live" plotting as well as manual zooming to specific
|
||||
regions.
|
||||
|
||||
Both X and Y axes allow "auto" or "manual" settings. For Y, auto
|
||||
mode sets the scaling of the graph to see all the data points.
|
||||
For X, auto mode makes the graph "follow" the data. Set it X min
|
||||
to manual 0 to always see the whole data from the beginning.
|
||||
|
||||
Note: press Enter in the 'manual' text box to make a new value
|
||||
affect the plot.
|
||||
|
||||
Eli Bendersky (eliben@gmail.com)
|
||||
License: this code is in the public domain
|
||||
Last modified: 31.07.2008
|
||||
"""
|
||||
import os
|
||||
import pprint
|
||||
import random
|
||||
import sys
|
||||
import wx
|
||||
|
||||
REFRESH_INTERVAL_MS = 1000
|
||||
|
||||
# The recommended way to use wx with mpl is with the WXAgg
|
||||
# backend.
|
||||
#
|
||||
import matplotlib
|
||||
matplotlib.use('WXAgg')
|
||||
from matplotlib.figure import Figure
|
||||
from matplotlib.backends.backend_wxagg import \
|
||||
FigureCanvasWxAgg as FigCanvas, \
|
||||
NavigationToolbar2WxAgg as NavigationToolbar
|
||||
import numpy as np
|
||||
import pylab
|
||||
#Data comes from here
|
||||
from Arduino_Monitor import SerialData as DataGen
|
||||
|
||||
|
||||
class BoundControlBox(wx.Panel):
|
||||
""" A static box with a couple of radio buttons and a text
|
||||
box. Allows to switch between an automatic mode and a
|
||||
manual mode with an associated value.
|
||||
"""
|
||||
def __init__(self, parent, ID, label, initval):
|
||||
wx.Panel.__init__(self, parent, ID)
|
||||
|
||||
self.value = initval
|
||||
|
||||
box = wx.StaticBox(self, -1, label)
|
||||
sizer = wx.StaticBoxSizer(box, wx.VERTICAL)
|
||||
|
||||
self.radio_auto = wx.RadioButton(self, -1,
|
||||
label="Auto", style=wx.RB_GROUP)
|
||||
self.radio_manual = wx.RadioButton(self, -1,
|
||||
label="Manual")
|
||||
self.manual_text = wx.TextCtrl(self, -1,
|
||||
size=(35,-1),
|
||||
value=str(initval),
|
||||
style=wx.TE_PROCESS_ENTER)
|
||||
|
||||
self.Bind(wx.EVT_UPDATE_UI, self.on_update_manual_text, self.manual_text)
|
||||
self.Bind(wx.EVT_TEXT_ENTER, self.on_text_enter, self.manual_text)
|
||||
|
||||
manual_box = wx.BoxSizer(wx.HORIZONTAL)
|
||||
manual_box.Add(self.radio_manual, flag=wx.ALIGN_CENTER_VERTICAL)
|
||||
manual_box.Add(self.manual_text, flag=wx.ALIGN_CENTER_VERTICAL)
|
||||
|
||||
sizer.Add(self.radio_auto, 0, wx.ALL, 10)
|
||||
sizer.Add(manual_box, 0, wx.ALL, 10)
|
||||
|
||||
self.SetSizer(sizer)
|
||||
sizer.Fit(self)
|
||||
|
||||
def on_update_manual_text(self, event):
|
||||
self.manual_text.Enable(self.radio_manual.GetValue())
|
||||
|
||||
def on_text_enter(self, event):
|
||||
self.value = self.manual_text.GetValue()
|
||||
|
||||
def is_auto(self):
|
||||
return self.radio_auto.GetValue()
|
||||
|
||||
def manual_value(self):
|
||||
return self.value
|
||||
|
||||
|
||||
class GraphFrame(wx.Frame):
|
||||
""" The main frame of the application
|
||||
"""
|
||||
title = 'Waga piwa w kegach:'
|
||||
|
||||
def __init__(self):
|
||||
wx.Frame.__init__(self, None, -1, self.title)
|
||||
|
||||
self.datagen = DataGen()
|
||||
self.data = [self.datagen.next()]
|
||||
self.paused = False
|
||||
|
||||
#self.create_menu()
|
||||
#self.create_status_bar()
|
||||
self.create_main_panel()
|
||||
|
||||
self.redraw_timer = wx.Timer(self)
|
||||
self.Bind(wx.EVT_TIMER, self.on_redraw_timer, self.redraw_timer)
|
||||
self.redraw_timer.Start(REFRESH_INTERVAL_MS)
|
||||
|
||||
def create_menu(self):
|
||||
self.menubar = wx.MenuBar()
|
||||
|
||||
menu_file = wx.Menu()
|
||||
m_expt = menu_file.Append(-1, "&Save plot\tCtrl-S", "Save plot to file")
|
||||
self.Bind(wx.EVT_MENU, self.on_save_plot, m_expt)
|
||||
menu_file.AppendSeparator()
|
||||
m_exit = menu_file.Append(-1, "E&xit\tCtrl-X", "Exit")
|
||||
self.Bind(wx.EVT_MENU, self.on_exit, m_exit)
|
||||
|
||||
self.menubar.Append(menu_file, "&File")
|
||||
self.SetMenuBar(self.menubar)
|
||||
|
||||
def create_main_panel(self):
|
||||
self.panel = wx.Panel(self)
|
||||
|
||||
self.init_plot()
|
||||
self.canvas = FigCanvas(self.panel, -1, self.fig)
|
||||
"""
|
||||
self.xmin_control = BoundControlBox(self.panel, -1, "X min", 0)
|
||||
self.xmax_control = BoundControlBox(self.panel, -1, "X max", 50)
|
||||
self.ymin_control = BoundControlBox(self.panel, -1, "Y min", 0)
|
||||
self.ymax_control = BoundControlBox(self.panel, -1, "Y max", 100)
|
||||
|
||||
self.pause_button = wx.Button(self.panel, -1, "Pause")
|
||||
self.Bind(wx.EVT_BUTTON, self.on_pause_button, self.pause_button)
|
||||
self.Bind(wx.EVT_UPDATE_UI, self.on_update_pause_button, self.pause_button)
|
||||
|
||||
self.cb_grid = wx.CheckBox(self.panel, -1,
|
||||
"Show Grid",
|
||||
style=wx.ALIGN_RIGHT)
|
||||
self.Bind(wx.EVT_CHECKBOX, self.on_cb_grid, self.cb_grid)
|
||||
self.cb_grid.SetValue(True)
|
||||
|
||||
self.cb_xlab = wx.CheckBox(self.panel, -1,
|
||||
"Show X labels",
|
||||
style=wx.ALIGN_RIGHT)
|
||||
self.Bind(wx.EVT_CHECKBOX, self.on_cb_xlab, self.cb_xlab)
|
||||
self.cb_xlab.SetValue(True)
|
||||
|
||||
self.hbox1 = wx.BoxSizer(wx.HORIZONTAL)
|
||||
self.hbox1.Add(self.pause_button, border=5, flag=wx.ALL | wx.ALIGN_CENTER_VERTICAL)
|
||||
self.hbox1.AddSpacer(20)
|
||||
self.hbox1.Add(self.cb_grid, border=5, flag=wx.ALL | wx.ALIGN_CENTER_VERTICAL)
|
||||
self.hbox1.AddSpacer(10)
|
||||
self.hbox1.Add(self.cb_xlab, border=5, flag=wx.ALL | wx.ALIGN_CENTER_VERTICAL)
|
||||
|
||||
self.hbox2 = wx.BoxSizer(wx.HORIZONTAL)
|
||||
self.hbox2.Add(self.xmin_control, border=5, flag=wx.ALL)
|
||||
self.hbox2.Add(self.xmax_control, border=5, flag=wx.ALL)
|
||||
self.hbox2.AddSpacer(24)
|
||||
self.hbox2.Add(self.ymin_control, border=5, flag=wx.ALL)
|
||||
self.hbox2.Add(self.ymax_control, border=5, flag=wx.ALL)
|
||||
"""
|
||||
self.vbox = wx.BoxSizer(wx.VERTICAL)
|
||||
self.vbox.Add(self.canvas, 1, flag=wx.LEFT | wx.TOP | wx.GROW)
|
||||
#self.vbox.Add(self.hbox1, 0, flag=wx.ALIGN_LEFT | wx.TOP)
|
||||
#self.vbox.Add(self.hbox2, 0, flag=wx.ALIGN_LEFT | wx.TOP)
|
||||
|
||||
self.panel.SetSizer(self.vbox)
|
||||
self.vbox.Fit(self)
|
||||
|
||||
def create_status_bar(self):
|
||||
self.statusbar = self.CreateStatusBar()
|
||||
|
||||
def init_plot(self):
|
||||
self.dpi = 100
|
||||
self.fig = Figure((3.0, 3.0), dpi=self.dpi)
|
||||
|
||||
self.axes = self.fig.add_subplot(111)
|
||||
self.axes.set_axis_bgcolor('black')
|
||||
self.axes.set_title("Waga kegow w bu", size=12)
|
||||
|
||||
pylab.setp(self.axes.get_xticklabels(), fontsize=8)
|
||||
pylab.setp(self.axes.get_yticklabels(), fontsize=8)
|
||||
|
||||
# plot the data as a line series, and save the reference
|
||||
# to the plotted line series
|
||||
#
|
||||
self.plot_data = self.axes.plot(
|
||||
self.data,
|
||||
linewidth=1,
|
||||
color=(1, 1, 0),
|
||||
)[0]
|
||||
|
||||
def draw_plot(self):
|
||||
""" Redraws the plot
|
||||
"""
|
||||
# when xmin is on auto, it "follows" xmax to produce a
|
||||
# sliding window effect. therefore, xmin is assigned after
|
||||
# xmax.
|
||||
#
|
||||
#if self.xmax_control.is_auto():
|
||||
xmax = len(self.data) if len(self.data) > 80 else 80
|
||||
#else:
|
||||
# xmax = int(self.xmax_control.manual_value())
|
||||
|
||||
#if self.xmin_control.is_auto():
|
||||
xmin = xmax - 80
|
||||
#else:
|
||||
# xmin = int(self.xmin_control.manual_value())
|
||||
|
||||
# for ymin and ymax, find the minimal and maximal values
|
||||
# in the data set and add a mininal margin.
|
||||
#
|
||||
# note that it's easy to change this scheme to the
|
||||
# minimal/maximal value in the current display, and not
|
||||
# the whole data set.
|
||||
#
|
||||
"""if self.ymin_control.is_auto():
|
||||
ymin = round(min(self.data), 0) - 1
|
||||
else:
|
||||
ymin = int(self.ymin_control.manual_value())
|
||||
|
||||
if self.ymax_control.is_auto():
|
||||
ymax = round(max(self.data), 0) + 1
|
||||
else:
|
||||
ymax = int(self.ymax_control.manual_value())
|
||||
"""
|
||||
ymin = 380
|
||||
ymax = 450
|
||||
self.axes.set_xbound(lower=xmin, upper=xmax)
|
||||
self.axes.set_ybound(lower=ymin, upper=ymax)
|
||||
|
||||
# anecdote: axes.grid assumes b=True if any other flag is
|
||||
# given even if b is set to False.
|
||||
# so just passing the flag into the first statement won't
|
||||
# work.
|
||||
#
|
||||
#if self.cb_grid.IsChecked():
|
||||
self.axes.grid(True, color='gray')
|
||||
#else:
|
||||
# self.axes.grid(False)
|
||||
|
||||
# Using setp here is convenient, because get_xticklabels
|
||||
# returns a list over which one needs to explicitly
|
||||
# iterate, and setp already handles this.
|
||||
#
|
||||
# pylab.setp(self.axes.get_xticklabels(),
|
||||
# visible=self.cb_xlab.IsChecked())
|
||||
|
||||
self.plot_data.set_xdata(np.arange(len(self.data)))
|
||||
self.plot_data.set_ydata(np.array(self.data))
|
||||
|
||||
self.canvas.draw()
|
||||
|
||||
def on_pause_button(self, event):
|
||||
self.paused = not self.paused
|
||||
|
||||
def on_update_pause_button(self, event):
|
||||
label = "Resume" if self.paused else "Pause"
|
||||
self.pause_button.SetLabel(label)
|
||||
|
||||
def on_cb_grid(self, event):
|
||||
self.draw_plot()
|
||||
|
||||
def on_cb_xlab(self, event):
|
||||
self.draw_plot()
|
||||
|
||||
def on_save_plot(self, event):
|
||||
file_choices = "PNG (*.png)|*.png"
|
||||
|
||||
dlg = wx.FileDialog(
|
||||
self,
|
||||
message="Save plot as...",
|
||||
defaultDir=os.getcwd(),
|
||||
defaultFile="plot.png",
|
||||
wildcard=file_choices,
|
||||
style=wx.SAVE)
|
||||
|
||||
if dlg.ShowModal() == wx.ID_OK:
|
||||
path = dlg.GetPath()
|
||||
self.canvas.print_figure(path, dpi=self.dpi)
|
||||
self.flash_status_message("Saved to %s" % path)
|
||||
|
||||
def on_redraw_timer(self, event):
|
||||
# if paused do not add data, but still redraw the plot
|
||||
# (to respond to scale modifications, grid change, etc.)
|
||||
#
|
||||
if not self.paused:
|
||||
self.data.append(self.datagen.next())
|
||||
|
||||
self.draw_plot()
|
||||
|
||||
def on_exit(self, event):
|
||||
self.Destroy()
|
||||
|
||||
def flash_status_message(self, msg, flash_len_ms=1500):
|
||||
self.statusbar.SetStatusText(msg)
|
||||
self.timeroff = wx.Timer(self)
|
||||
self.Bind(
|
||||
wx.EVT_TIMER,
|
||||
self.on_flash_status_off,
|
||||
self.timeroff)
|
||||
self.timeroff.Start(flash_len_ms, oneShot=True)
|
||||
|
||||
def on_flash_status_off(self, event):
|
||||
self.statusbar.SetStatusText('')
|
||||
|
||||
|
||||
if __name__ == '__main__':
|
||||
app = wx.PySimpleApp()
|
||||
app.frame = GraphFrame()
|
||||
app.frame.Show()
|
||||
app.MainLoop()
|
||||
|
||||
Loading…
Reference in New Issue