| User | Revision | Line number | New contents of line |
|---|
| Amyrctdp |
0:c735c66e37d3
|
1
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
2
|
* MFRC522.cpp - Library to use ARDUINO RFID MODULE KIT 13.56 MHZ WITH TAGS SPI W AND R BY COOQROBOT.
|
| Amyrctdp |
0:c735c66e37d3
|
3
|
* _Please_ see the comments in MFRC522.h - they give useful hints and background.
|
| Amyrctdp |
0:c735c66e37d3
|
4
|
* Released into the public domain.
|
| Amyrctdp |
0:c735c66e37d3
|
5
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
6
|
|
| Amyrctdp |
0:c735c66e37d3
|
7
|
#include "MFRC522.h"
|
| Amyrctdp |
0:c735c66e37d3
|
8
|
|
| Amyrctdp |
0:c735c66e37d3
|
9
|
static const char* const _TypeNamePICC[] =
|
| Amyrctdp |
0:c735c66e37d3
|
10
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
11
|
"Unknown type",
|
| Amyrctdp |
0:c735c66e37d3
|
12
|
"PICC compliant with ISO/IEC 14443-4",
|
| Amyrctdp |
0:c735c66e37d3
|
13
|
"PICC compliant with ISO/IEC 18092 (NFC)",
|
| Amyrctdp |
0:c735c66e37d3
|
14
|
"MIFARE Mini, 320 bytes",
|
| Amyrctdp |
0:c735c66e37d3
|
15
|
"MIFARE 1KB",
|
| Amyrctdp |
0:c735c66e37d3
|
16
|
"MIFARE 4KB",
|
| Amyrctdp |
0:c735c66e37d3
|
17
|
"MIFARE Ultralight or Ultralight C",
|
| Amyrctdp |
0:c735c66e37d3
|
18
|
"MIFARE Plus",
|
| Amyrctdp |
0:c735c66e37d3
|
19
|
"MIFARE TNP3XXX",
|
| Amyrctdp |
0:c735c66e37d3
|
20
|
|
| Amyrctdp |
0:c735c66e37d3
|
21
|
/* not complete UID */
|
| Amyrctdp |
0:c735c66e37d3
|
22
|
"SAK indicates UID is not complete"
|
| Amyrctdp |
0:c735c66e37d3
|
23
|
};
|
| Amyrctdp |
0:c735c66e37d3
|
24
|
|
| Amyrctdp |
0:c735c66e37d3
|
25
|
static const char* const _ErrorMessage[] =
|
| Amyrctdp |
0:c735c66e37d3
|
26
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
27
|
"Unknown error",
|
| Amyrctdp |
0:c735c66e37d3
|
28
|
"Success",
|
| Amyrctdp |
0:c735c66e37d3
|
29
|
"Error in communication",
|
| Amyrctdp |
0:c735c66e37d3
|
30
|
"Collision detected",
|
| Amyrctdp |
0:c735c66e37d3
|
31
|
"Timeout in communication",
|
| Amyrctdp |
0:c735c66e37d3
|
32
|
"A buffer is not big enough",
|
| Amyrctdp |
0:c735c66e37d3
|
33
|
"Internal error in the code, should not happen",
|
| Amyrctdp |
0:c735c66e37d3
|
34
|
"Invalid argument",
|
| Amyrctdp |
0:c735c66e37d3
|
35
|
"The CRC_A does not match",
|
| Amyrctdp |
0:c735c66e37d3
|
36
|
"A MIFARE PICC responded with NAK"
|
| Amyrctdp |
0:c735c66e37d3
|
37
|
};
|
| Amyrctdp |
0:c735c66e37d3
|
38
|
|
| Amyrctdp |
0:c735c66e37d3
|
39
|
#define MFRC522_MaxPICCs (sizeof(_TypeNamePICC)/sizeof(_TypeNamePICC[0]))
|
| Amyrctdp |
0:c735c66e37d3
|
40
|
#define MFRC522_MaxError (sizeof(_ErrorMessage)/sizeof(_ErrorMessage[0]))
|
| Amyrctdp |
0:c735c66e37d3
|
41
|
|
| Amyrctdp |
0:c735c66e37d3
|
42
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
43
|
// Functions for setting up the driver
|
| Amyrctdp |
0:c735c66e37d3
|
44
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
45
|
|
| Amyrctdp |
0:c735c66e37d3
|
46
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
47
|
* Constructor.
|
| Amyrctdp |
0:c735c66e37d3
|
48
|
* Prepares the output pins.
|
| Amyrctdp |
0:c735c66e37d3
|
49
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
50
|
MFRC522::MFRC522(PinName mosi,
|
| Amyrctdp |
0:c735c66e37d3
|
51
|
PinName miso,
|
| Amyrctdp |
0:c735c66e37d3
|
52
|
PinName sclk,
|
| Amyrctdp |
0:c735c66e37d3
|
53
|
PinName cs,
|
| Amyrctdp |
0:c735c66e37d3
|
54
|
PinName reset) : m_SPI(mosi, miso, sclk), m_CS(cs), m_RESET(reset)
|
| Amyrctdp |
0:c735c66e37d3
|
55
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
56
|
/* Configure SPI bus */
|
| Amyrctdp |
0:c735c66e37d3
|
57
|
m_SPI.format(8, 0);
|
| Amyrctdp |
0:c735c66e37d3
|
58
|
m_SPI.frequency(8000000);
|
| Amyrctdp |
0:c735c66e37d3
|
59
|
|
| Amyrctdp |
0:c735c66e37d3
|
60
|
/* Release SPI-CS pin */
|
| Amyrctdp |
0:c735c66e37d3
|
61
|
m_CS = 1;
|
| Amyrctdp |
0:c735c66e37d3
|
62
|
|
| Amyrctdp |
0:c735c66e37d3
|
63
|
/* Release RESET pin */
|
| Amyrctdp |
0:c735c66e37d3
|
64
|
m_RESET = 1;
|
| Amyrctdp |
0:c735c66e37d3
|
65
|
} // End constructor
|
| Amyrctdp |
0:c735c66e37d3
|
66
|
|
| Amyrctdp |
0:c735c66e37d3
|
67
|
|
| Amyrctdp |
0:c735c66e37d3
|
68
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
69
|
* Destructor.
|
| Amyrctdp |
0:c735c66e37d3
|
70
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
71
|
MFRC522::~MFRC522()
|
| Amyrctdp |
0:c735c66e37d3
|
72
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
73
|
|
| Amyrctdp |
0:c735c66e37d3
|
74
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
75
|
|
| Amyrctdp |
0:c735c66e37d3
|
76
|
|
| Amyrctdp |
0:c735c66e37d3
|
77
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
78
|
// Basic interface functions for communicating with the MFRC522
|
| Amyrctdp |
0:c735c66e37d3
|
79
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
80
|
|
| Amyrctdp |
0:c735c66e37d3
|
81
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
82
|
* Writes a byte to the specified register in the MFRC522 chip.
|
| Amyrctdp |
0:c735c66e37d3
|
83
|
* The interface is described in the datasheet section 8.1.2.
|
| Amyrctdp |
0:c735c66e37d3
|
84
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
85
|
void MFRC522::PCD_WriteRegister(uint8_t reg, uint8_t value)
|
| Amyrctdp |
0:c735c66e37d3
|
86
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
87
|
m_CS = 0; /* Select SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
88
|
|
| Amyrctdp |
0:c735c66e37d3
|
89
|
// MSB == 0 is for writing. LSB is not used in address. Datasheet section 8.1.2.3.
|
| Amyrctdp |
0:c735c66e37d3
|
90
|
(void) m_SPI.write(reg & 0x7E);
|
| Amyrctdp |
0:c735c66e37d3
|
91
|
(void) m_SPI.write(value);
|
| Amyrctdp |
0:c735c66e37d3
|
92
|
|
| Amyrctdp |
0:c735c66e37d3
|
93
|
m_CS = 1; /* Release SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
94
|
} // End PCD_WriteRegister()
|
| Amyrctdp |
0:c735c66e37d3
|
95
|
|
| Amyrctdp |
0:c735c66e37d3
|
96
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
97
|
* Writes a number of bytes to the specified register in the MFRC522 chip.
|
| Amyrctdp |
0:c735c66e37d3
|
98
|
* The interface is described in the datasheet section 8.1.2.
|
| Amyrctdp |
0:c735c66e37d3
|
99
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
100
|
void MFRC522::PCD_WriteRegister(uint8_t reg, uint8_t count, uint8_t *values)
|
| Amyrctdp |
0:c735c66e37d3
|
101
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
102
|
m_CS = 0; /* Select SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
103
|
|
| Amyrctdp |
0:c735c66e37d3
|
104
|
// MSB == 0 is for writing. LSB is not used in address. Datasheet section 8.1.2.3.
|
| Amyrctdp |
0:c735c66e37d3
|
105
|
(void) m_SPI.write(reg & 0x7E);
|
| Amyrctdp |
0:c735c66e37d3
|
106
|
for (uint8_t index = 0; index < count; index++)
|
| Amyrctdp |
0:c735c66e37d3
|
107
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
108
|
(void) m_SPI.write(values[index]);
|
| Amyrctdp |
0:c735c66e37d3
|
109
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
110
|
|
| Amyrctdp |
0:c735c66e37d3
|
111
|
m_CS = 1; /* Release SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
112
|
} // End PCD_WriteRegister()
|
| Amyrctdp |
0:c735c66e37d3
|
113
|
|
| Amyrctdp |
0:c735c66e37d3
|
114
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
115
|
* Reads a byte from the specified register in the MFRC522 chip.
|
| Amyrctdp |
0:c735c66e37d3
|
116
|
* The interface is described in the datasheet section 8.1.2.
|
| Amyrctdp |
0:c735c66e37d3
|
117
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
118
|
uint8_t MFRC522::PCD_ReadRegister(uint8_t reg)
|
| Amyrctdp |
0:c735c66e37d3
|
119
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
120
|
uint8_t value;
|
| Amyrctdp |
0:c735c66e37d3
|
121
|
m_CS = 0; /* Select SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
122
|
|
| Amyrctdp |
0:c735c66e37d3
|
123
|
// MSB == 1 is for reading. LSB is not used in address. Datasheet section 8.1.2.3.
|
| Amyrctdp |
0:c735c66e37d3
|
124
|
(void) m_SPI.write(0x80 | reg);
|
| Amyrctdp |
0:c735c66e37d3
|
125
|
|
| Amyrctdp |
0:c735c66e37d3
|
126
|
// Read the value back. Send 0 to stop reading.
|
| Amyrctdp |
0:c735c66e37d3
|
127
|
value = m_SPI.write(0);
|
| Amyrctdp |
0:c735c66e37d3
|
128
|
|
| Amyrctdp |
0:c735c66e37d3
|
129
|
m_CS = 1; /* Release SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
130
|
|
| Amyrctdp |
0:c735c66e37d3
|
131
|
return value;
|
| Amyrctdp |
0:c735c66e37d3
|
132
|
} // End PCD_ReadRegister()
|
| Amyrctdp |
0:c735c66e37d3
|
133
|
|
| Amyrctdp |
0:c735c66e37d3
|
134
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
135
|
* Reads a number of bytes from the specified register in the MFRC522 chip.
|
| Amyrctdp |
0:c735c66e37d3
|
136
|
* The interface is described in the datasheet section 8.1.2.
|
| Amyrctdp |
0:c735c66e37d3
|
137
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
138
|
void MFRC522::PCD_ReadRegister(uint8_t reg, uint8_t count, uint8_t *values, uint8_t rxAlign)
|
| Amyrctdp |
0:c735c66e37d3
|
139
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
140
|
if (count == 0) { return; }
|
| Amyrctdp |
0:c735c66e37d3
|
141
|
|
| Amyrctdp |
0:c735c66e37d3
|
142
|
uint8_t address = 0x80 | reg; // MSB == 1 is for reading. LSB is not used in address. Datasheet section 8.1.2.3.
|
| Amyrctdp |
0:c735c66e37d3
|
143
|
uint8_t index = 0; // Index in values array.
|
| Amyrctdp |
0:c735c66e37d3
|
144
|
|
| Amyrctdp |
0:c735c66e37d3
|
145
|
m_CS = 0; /* Select SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
146
|
count--; // One read is performed outside of the loop
|
| Amyrctdp |
0:c735c66e37d3
|
147
|
(void) m_SPI.write(address); // Tell MFRC522 which address we want to read
|
| Amyrctdp |
0:c735c66e37d3
|
148
|
|
| Amyrctdp |
0:c735c66e37d3
|
149
|
while (index < count)
|
| Amyrctdp |
0:c735c66e37d3
|
150
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
151
|
if ((index == 0) && rxAlign) // Only update bit positions rxAlign..7 in values[0]
|
| Amyrctdp |
0:c735c66e37d3
|
152
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
153
|
// Create bit mask for bit positions rxAlign..7
|
| Amyrctdp |
0:c735c66e37d3
|
154
|
uint8_t mask = 0;
|
| Amyrctdp |
0:c735c66e37d3
|
155
|
for (uint8_t i = rxAlign; i <= 7; i++)
|
| Amyrctdp |
0:c735c66e37d3
|
156
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
157
|
mask |= (1 << i);
|
| Amyrctdp |
0:c735c66e37d3
|
158
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
159
|
|
| Amyrctdp |
0:c735c66e37d3
|
160
|
// Read value and tell that we want to read the same address again.
|
| Amyrctdp |
0:c735c66e37d3
|
161
|
uint8_t value = m_SPI.write(address);
|
| Amyrctdp |
0:c735c66e37d3
|
162
|
|
| Amyrctdp |
0:c735c66e37d3
|
163
|
// Apply mask to both current value of values[0] and the new data in value.
|
| Amyrctdp |
0:c735c66e37d3
|
164
|
values[0] = (values[index] & ~mask) | (value & mask);
|
| Amyrctdp |
0:c735c66e37d3
|
165
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
166
|
else
|
| Amyrctdp |
0:c735c66e37d3
|
167
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
168
|
// Read value and tell that we want to read the same address again.
|
| Amyrctdp |
0:c735c66e37d3
|
169
|
values[index] = m_SPI.write(address);
|
| Amyrctdp |
0:c735c66e37d3
|
170
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
171
|
|
| Amyrctdp |
0:c735c66e37d3
|
172
|
index++;
|
| Amyrctdp |
0:c735c66e37d3
|
173
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
174
|
|
| Amyrctdp |
0:c735c66e37d3
|
175
|
values[index] = m_SPI.write(0); // Read the final byte. Send 0 to stop reading.
|
| Amyrctdp |
0:c735c66e37d3
|
176
|
|
| Amyrctdp |
0:c735c66e37d3
|
177
|
m_CS = 1; /* Release SPI Chip MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
178
|
} // End PCD_ReadRegister()
|
| Amyrctdp |
0:c735c66e37d3
|
179
|
|
| Amyrctdp |
0:c735c66e37d3
|
180
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
181
|
* Sets the bits given in mask in register reg.
|
| Amyrctdp |
0:c735c66e37d3
|
182
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
183
|
void MFRC522::PCD_SetRegisterBits(uint8_t reg, uint8_t mask)
|
| Amyrctdp |
0:c735c66e37d3
|
184
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
185
|
uint8_t tmp = PCD_ReadRegister(reg);
|
| Amyrctdp |
0:c735c66e37d3
|
186
|
PCD_WriteRegister(reg, tmp | mask); // set bit mask
|
| Amyrctdp |
0:c735c66e37d3
|
187
|
} // End PCD_SetRegisterBitMask()
|
| Amyrctdp |
0:c735c66e37d3
|
188
|
|
| Amyrctdp |
0:c735c66e37d3
|
189
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
190
|
* Clears the bits given in mask from register reg.
|
| Amyrctdp |
0:c735c66e37d3
|
191
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
192
|
void MFRC522::PCD_ClrRegisterBits(uint8_t reg, uint8_t mask)
|
| Amyrctdp |
0:c735c66e37d3
|
193
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
194
|
uint8_t tmp = PCD_ReadRegister(reg);
|
| Amyrctdp |
0:c735c66e37d3
|
195
|
PCD_WriteRegister(reg, tmp & (~mask)); // clear bit mask
|
| Amyrctdp |
0:c735c66e37d3
|
196
|
} // End PCD_ClearRegisterBitMask()
|
| Amyrctdp |
0:c735c66e37d3
|
197
|
|
| Amyrctdp |
0:c735c66e37d3
|
198
|
|
| Amyrctdp |
0:c735c66e37d3
|
199
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
200
|
* Use the CRC coprocessor in the MFRC522 to calculate a CRC_A.
|
| Amyrctdp |
0:c735c66e37d3
|
201
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
202
|
uint8_t MFRC522::PCD_CalculateCRC(uint8_t *data, uint8_t length, uint8_t *result)
|
| Amyrctdp |
0:c735c66e37d3
|
203
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
204
|
PCD_WriteRegister(CommandReg, PCD_Idle); // Stop any active command.
|
| Amyrctdp |
0:c735c66e37d3
|
205
|
PCD_WriteRegister(DivIrqReg, 0x04); // Clear the CRCIRq interrupt request bit
|
| Amyrctdp |
0:c735c66e37d3
|
206
|
PCD_SetRegisterBits(FIFOLevelReg, 0x80); // FlushBuffer = 1, FIFO initialization
|
| Amyrctdp |
0:c735c66e37d3
|
207
|
PCD_WriteRegister(FIFODataReg, length, data); // Write data to the FIFO
|
| Amyrctdp |
0:c735c66e37d3
|
208
|
PCD_WriteRegister(CommandReg, PCD_CalcCRC); // Start the calculation
|
| Amyrctdp |
0:c735c66e37d3
|
209
|
|
| Amyrctdp |
0:c735c66e37d3
|
210
|
// Wait for the CRC calculation to complete. Each iteration of the while-loop takes 17.73us.
|
| Amyrctdp |
0:c735c66e37d3
|
211
|
uint16_t i = 5000;
|
| Amyrctdp |
0:c735c66e37d3
|
212
|
uint8_t n;
|
| Amyrctdp |
0:c735c66e37d3
|
213
|
while (1)
|
| Amyrctdp |
0:c735c66e37d3
|
214
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
215
|
n = PCD_ReadRegister(DivIrqReg); // DivIrqReg[7..0] bits are: Set2 reserved reserved MfinActIRq reserved CRCIRq reserved reserved
|
| Amyrctdp |
0:c735c66e37d3
|
216
|
if (n & 0x04)
|
| Amyrctdp |
0:c735c66e37d3
|
217
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
218
|
// CRCIRq bit set - calculation done
|
| Amyrctdp |
0:c735c66e37d3
|
219
|
break;
|
| Amyrctdp |
0:c735c66e37d3
|
220
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
221
|
|
| Amyrctdp |
0:c735c66e37d3
|
222
|
if (--i == 0)
|
| Amyrctdp |
0:c735c66e37d3
|
223
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
224
|
// The emergency break. We will eventually terminate on this one after 89ms.
|
| Amyrctdp |
0:c735c66e37d3
|
225
|
// Communication with the MFRC522 might be down.
|
| Amyrctdp |
0:c735c66e37d3
|
226
|
return STATUS_TIMEOUT;
|
| Amyrctdp |
0:c735c66e37d3
|
227
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
228
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
229
|
|
| Amyrctdp |
0:c735c66e37d3
|
230
|
// Stop calculating CRC for new content in the FIFO.
|
| Amyrctdp |
0:c735c66e37d3
|
231
|
PCD_WriteRegister(CommandReg, PCD_Idle);
|
| Amyrctdp |
0:c735c66e37d3
|
232
|
|
| Amyrctdp |
0:c735c66e37d3
|
233
|
// Transfer the result from the registers to the result buffer
|
| Amyrctdp |
0:c735c66e37d3
|
234
|
result[0] = PCD_ReadRegister(CRCResultRegL);
|
| Amyrctdp |
0:c735c66e37d3
|
235
|
result[1] = PCD_ReadRegister(CRCResultRegH);
|
| Amyrctdp |
0:c735c66e37d3
|
236
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
237
|
} // End PCD_CalculateCRC()
|
| Amyrctdp |
0:c735c66e37d3
|
238
|
|
| Amyrctdp |
0:c735c66e37d3
|
239
|
|
| Amyrctdp |
0:c735c66e37d3
|
240
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
241
|
// Functions for manipulating the MFRC522
|
| Amyrctdp |
0:c735c66e37d3
|
242
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
243
|
|
| Amyrctdp |
0:c735c66e37d3
|
244
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
245
|
* Initializes the MFRC522 chip.
|
| Amyrctdp |
0:c735c66e37d3
|
246
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
247
|
void MFRC522::PCD_Init()
|
| Amyrctdp |
0:c735c66e37d3
|
248
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
249
|
/* Reset MFRC522 */
|
| Amyrctdp |
0:c735c66e37d3
|
250
|
m_RESET = 0;
|
| Amyrctdp |
0:c735c66e37d3
|
251
|
wait_ms(10);
|
| Amyrctdp |
0:c735c66e37d3
|
252
|
m_RESET = 1;
|
| Amyrctdp |
0:c735c66e37d3
|
253
|
|
| Amyrctdp |
0:c735c66e37d3
|
254
|
// Section 8.8.2 in the datasheet says the oscillator start-up time is the start up time of the crystal + 37,74us. Let us be generous: 50ms.
|
| Amyrctdp |
0:c735c66e37d3
|
255
|
wait_ms(50);
|
| Amyrctdp |
0:c735c66e37d3
|
256
|
|
| Amyrctdp |
0:c735c66e37d3
|
257
|
// When communicating with a PICC we need a timeout if something goes wrong.
|
| Amyrctdp |
0:c735c66e37d3
|
258
|
// f_timer = 13.56 MHz / (2*TPreScaler+1) where TPreScaler = [TPrescaler_Hi:TPrescaler_Lo].
|
| Amyrctdp |
0:c735c66e37d3
|
259
|
// TPrescaler_Hi are the four low bits in TModeReg. TPrescaler_Lo is TPrescalerReg.
|
| Amyrctdp |
0:c735c66e37d3
|
260
|
PCD_WriteRegister(TModeReg, 0x80); // TAuto=1; timer starts automatically at the end of the transmission in all communication modes at all speeds
|
| Amyrctdp |
0:c735c66e37d3
|
261
|
PCD_WriteRegister(TPrescalerReg, 0xA9); // TPreScaler = TModeReg[3..0]:TPrescalerReg, ie 0x0A9 = 169 => f_timer=40kHz, ie a timer period of 25us.
|
| Amyrctdp |
0:c735c66e37d3
|
262
|
PCD_WriteRegister(TReloadRegH, 0x03); // Reload timer with 0x3E8 = 1000, ie 25ms before timeout.
|
| Amyrctdp |
0:c735c66e37d3
|
263
|
PCD_WriteRegister(TReloadRegL, 0xE8);
|
| Amyrctdp |
0:c735c66e37d3
|
264
|
|
| Amyrctdp |
0:c735c66e37d3
|
265
|
PCD_WriteRegister(TxASKReg, 0x40); // Default 0x00. Force a 100 % ASK modulation independent of the ModGsPReg register setting
|
| Amyrctdp |
0:c735c66e37d3
|
266
|
PCD_WriteRegister(ModeReg, 0x3D); // Default 0x3F. Set the preset value for the CRC coprocessor for the CalcCRC command to 0x6363 (ISO 14443-3 part 6.2.4)
|
| Amyrctdp |
0:c735c66e37d3
|
267
|
|
| Amyrctdp |
0:c735c66e37d3
|
268
|
PCD_WriteRegister(RFCfgReg, (0x07<<4)); // Set Rx Gain to max
|
| Amyrctdp |
0:c735c66e37d3
|
269
|
|
| Amyrctdp |
0:c735c66e37d3
|
270
|
PCD_AntennaOn(); // Enable the antenna driver pins TX1 and TX2 (they were disabled by the reset)
|
| Amyrctdp |
0:c735c66e37d3
|
271
|
} // End PCD_Init()
|
| Amyrctdp |
0:c735c66e37d3
|
272
|
|
| Amyrctdp |
0:c735c66e37d3
|
273
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
274
|
* Performs a soft reset on the MFRC522 chip and waits for it to be ready again.
|
| Amyrctdp |
0:c735c66e37d3
|
275
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
276
|
void MFRC522::PCD_Reset()
|
| Amyrctdp |
0:c735c66e37d3
|
277
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
278
|
PCD_WriteRegister(CommandReg, PCD_SoftReset); // Issue the SoftReset command.
|
| Amyrctdp |
0:c735c66e37d3
|
279
|
// The datasheet does not mention how long the SoftRest command takes to complete.
|
| Amyrctdp |
0:c735c66e37d3
|
280
|
// But the MFRC522 might have been in soft power-down mode (triggered by bit 4 of CommandReg)
|
| Amyrctdp |
0:c735c66e37d3
|
281
|
// Section 8.8.2 in the datasheet says the oscillator start-up time is the start up time of the crystal + 37,74us. Let us be generous: 50ms.
|
| Amyrctdp |
0:c735c66e37d3
|
282
|
wait_ms(50);
|
| Amyrctdp |
0:c735c66e37d3
|
283
|
|
| Amyrctdp |
0:c735c66e37d3
|
284
|
// Wait for the PowerDown bit in CommandReg to be cleared
|
| Amyrctdp |
0:c735c66e37d3
|
285
|
while (PCD_ReadRegister(CommandReg) & (1<<4))
|
| Amyrctdp |
0:c735c66e37d3
|
286
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
287
|
// PCD still restarting - unlikely after waiting 50ms, but better safe than sorry.
|
| Amyrctdp |
0:c735c66e37d3
|
288
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
289
|
} // End PCD_Reset()
|
| Amyrctdp |
0:c735c66e37d3
|
290
|
|
| Amyrctdp |
0:c735c66e37d3
|
291
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
292
|
* Turns the antenna on by enabling pins TX1 and TX2.
|
| Amyrctdp |
0:c735c66e37d3
|
293
|
* After a reset these pins disabled.
|
| Amyrctdp |
0:c735c66e37d3
|
294
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
295
|
void MFRC522::PCD_AntennaOn()
|
| Amyrctdp |
0:c735c66e37d3
|
296
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
297
|
uint8_t value = PCD_ReadRegister(TxControlReg);
|
| Amyrctdp |
0:c735c66e37d3
|
298
|
if ((value & 0x03) != 0x03)
|
| Amyrctdp |
0:c735c66e37d3
|
299
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
300
|
PCD_WriteRegister(TxControlReg, value | 0x03);
|
| Amyrctdp |
0:c735c66e37d3
|
301
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
302
|
} // End PCD_AntennaOn()
|
| Amyrctdp |
0:c735c66e37d3
|
303
|
|
| Amyrctdp |
0:c735c66e37d3
|
304
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
305
|
// Functions for communicating with PICCs
|
| Amyrctdp |
0:c735c66e37d3
|
306
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
307
|
|
| Amyrctdp |
0:c735c66e37d3
|
308
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
309
|
* Executes the Transceive command.
|
| Amyrctdp |
0:c735c66e37d3
|
310
|
* CRC validation can only be done if backData and backLen are specified.
|
| Amyrctdp |
0:c735c66e37d3
|
311
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
312
|
uint8_t MFRC522::PCD_TransceiveData(uint8_t *sendData,
|
| Amyrctdp |
0:c735c66e37d3
|
313
|
uint8_t sendLen,
|
| Amyrctdp |
0:c735c66e37d3
|
314
|
uint8_t *backData,
|
| Amyrctdp |
0:c735c66e37d3
|
315
|
uint8_t *backLen,
|
| Amyrctdp |
0:c735c66e37d3
|
316
|
uint8_t *validBits,
|
| Amyrctdp |
0:c735c66e37d3
|
317
|
uint8_t rxAlign,
|
| Amyrctdp |
0:c735c66e37d3
|
318
|
bool checkCRC)
|
| Amyrctdp |
0:c735c66e37d3
|
319
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
320
|
uint8_t waitIRq = 0x30; // RxIRq and IdleIRq
|
| Amyrctdp |
0:c735c66e37d3
|
321
|
return PCD_CommunicateWithPICC(PCD_Transceive, waitIRq, sendData, sendLen, backData, backLen, validBits, rxAlign, checkCRC);
|
| Amyrctdp |
0:c735c66e37d3
|
322
|
} // End PCD_TransceiveData()
|
| Amyrctdp |
0:c735c66e37d3
|
323
|
|
| Amyrctdp |
0:c735c66e37d3
|
324
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
325
|
* Transfers data to the MFRC522 FIFO, executes a commend, waits for completion and transfers data back from the FIFO.
|
| Amyrctdp |
0:c735c66e37d3
|
326
|
* CRC validation can only be done if backData and backLen are specified.
|
| Amyrctdp |
0:c735c66e37d3
|
327
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
328
|
uint8_t MFRC522::PCD_CommunicateWithPICC(uint8_t command,
|
| Amyrctdp |
0:c735c66e37d3
|
329
|
uint8_t waitIRq,
|
| Amyrctdp |
0:c735c66e37d3
|
330
|
uint8_t *sendData,
|
| Amyrctdp |
0:c735c66e37d3
|
331
|
uint8_t sendLen,
|
| Amyrctdp |
0:c735c66e37d3
|
332
|
uint8_t *backData,
|
| Amyrctdp |
0:c735c66e37d3
|
333
|
uint8_t *backLen,
|
| Amyrctdp |
0:c735c66e37d3
|
334
|
uint8_t *validBits,
|
| Amyrctdp |
0:c735c66e37d3
|
335
|
uint8_t rxAlign,
|
| Amyrctdp |
0:c735c66e37d3
|
336
|
bool checkCRC)
|
| Amyrctdp |
0:c735c66e37d3
|
337
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
338
|
uint8_t n, _validBits = 0;
|
| Amyrctdp |
0:c735c66e37d3
|
339
|
uint32_t i;
|
| Amyrctdp |
0:c735c66e37d3
|
340
|
|
| Amyrctdp |
0:c735c66e37d3
|
341
|
// Prepare values for BitFramingReg
|
| Amyrctdp |
0:c735c66e37d3
|
342
|
uint8_t txLastBits = validBits ? *validBits : 0;
|
| Amyrctdp |
0:c735c66e37d3
|
343
|
uint8_t bitFraming = (rxAlign << 4) + txLastBits; // RxAlign = BitFramingReg[6..4]. TxLastBits = BitFramingReg[2..0]
|
| Amyrctdp |
0:c735c66e37d3
|
344
|
|
| Amyrctdp |
0:c735c66e37d3
|
345
|
PCD_WriteRegister(CommandReg, PCD_Idle); // Stop any active command.
|
| Amyrctdp |
0:c735c66e37d3
|
346
|
PCD_WriteRegister(ComIrqReg, 0x7F); // Clear all seven interrupt request bits
|
| Amyrctdp |
0:c735c66e37d3
|
347
|
PCD_SetRegisterBits(FIFOLevelReg, 0x80); // FlushBuffer = 1, FIFO initialization
|
| Amyrctdp |
0:c735c66e37d3
|
348
|
PCD_WriteRegister(FIFODataReg, sendLen, sendData); // Write sendData to the FIFO
|
| Amyrctdp |
0:c735c66e37d3
|
349
|
PCD_WriteRegister(BitFramingReg, bitFraming); // Bit adjustments
|
| Amyrctdp |
0:c735c66e37d3
|
350
|
PCD_WriteRegister(CommandReg, command); // Execute the command
|
| Amyrctdp |
0:c735c66e37d3
|
351
|
if (command == PCD_Transceive)
|
| Amyrctdp |
0:c735c66e37d3
|
352
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
353
|
PCD_SetRegisterBits(BitFramingReg, 0x80); // StartSend=1, transmission of data starts
|
| Amyrctdp |
0:c735c66e37d3
|
354
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
355
|
|
| Amyrctdp |
0:c735c66e37d3
|
356
|
// Wait for the command to complete.
|
| Amyrctdp |
0:c735c66e37d3
|
357
|
// In PCD_Init() we set the TAuto flag in TModeReg. This means the timer automatically starts when the PCD stops transmitting.
|
| Amyrctdp |
0:c735c66e37d3
|
358
|
// Each iteration of the do-while-loop takes 17.86us.
|
| Amyrctdp |
0:c735c66e37d3
|
359
|
i = 2000;
|
| Amyrctdp |
0:c735c66e37d3
|
360
|
while (1)
|
| Amyrctdp |
0:c735c66e37d3
|
361
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
362
|
n = PCD_ReadRegister(ComIrqReg); // ComIrqReg[7..0] bits are: Set1 TxIRq RxIRq IdleIRq HiAlertIRq LoAlertIRq ErrIRq TimerIRq
|
| Amyrctdp |
0:c735c66e37d3
|
363
|
if (n & waitIRq)
|
| Amyrctdp |
0:c735c66e37d3
|
364
|
{ // One of the interrupts that signal success has been set.
|
| Amyrctdp |
0:c735c66e37d3
|
365
|
break;
|
| Amyrctdp |
0:c735c66e37d3
|
366
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
367
|
|
| Amyrctdp |
0:c735c66e37d3
|
368
|
if (n & 0x01)
|
| Amyrctdp |
0:c735c66e37d3
|
369
|
{ // Timer interrupt - nothing received in 25ms
|
| Amyrctdp |
0:c735c66e37d3
|
370
|
return STATUS_TIMEOUT;
|
| Amyrctdp |
0:c735c66e37d3
|
371
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
372
|
|
| Amyrctdp |
0:c735c66e37d3
|
373
|
if (--i == 0)
|
| Amyrctdp |
0:c735c66e37d3
|
374
|
{ // The emergency break. If all other condions fail we will eventually terminate on this one after 35.7ms. Communication with the MFRC522 might be down.
|
| Amyrctdp |
0:c735c66e37d3
|
375
|
return STATUS_TIMEOUT;
|
| Amyrctdp |
0:c735c66e37d3
|
376
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
377
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
378
|
|
| Amyrctdp |
0:c735c66e37d3
|
379
|
// Stop now if any errors except collisions were detected.
|
| Amyrctdp |
0:c735c66e37d3
|
380
|
uint8_t errorRegValue = PCD_ReadRegister(ErrorReg); // ErrorReg[7..0] bits are: WrErr TempErr reserved BufferOvfl CollErr CRCErr ParityErr ProtocolErr
|
| Amyrctdp |
0:c735c66e37d3
|
381
|
if (errorRegValue & 0x13)
|
| Amyrctdp |
0:c735c66e37d3
|
382
|
{ // BufferOvfl ParityErr ProtocolErr
|
| Amyrctdp |
0:c735c66e37d3
|
383
|
return STATUS_ERROR;
|
| Amyrctdp |
0:c735c66e37d3
|
384
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
385
|
|
| Amyrctdp |
0:c735c66e37d3
|
386
|
// If the caller wants data back, get it from the MFRC522.
|
| Amyrctdp |
0:c735c66e37d3
|
387
|
if (backData && backLen)
|
| Amyrctdp |
0:c735c66e37d3
|
388
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
389
|
n = PCD_ReadRegister(FIFOLevelReg); // Number of bytes in the FIFO
|
| Amyrctdp |
0:c735c66e37d3
|
390
|
if (n > *backLen)
|
| Amyrctdp |
0:c735c66e37d3
|
391
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
392
|
return STATUS_NO_ROOM;
|
| Amyrctdp |
0:c735c66e37d3
|
393
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
394
|
|
| Amyrctdp |
0:c735c66e37d3
|
395
|
*backLen = n; // Number of bytes returned
|
| Amyrctdp |
0:c735c66e37d3
|
396
|
PCD_ReadRegister(FIFODataReg, n, backData, rxAlign); // Get received data from FIFO
|
| Amyrctdp |
0:c735c66e37d3
|
397
|
_validBits = PCD_ReadRegister(ControlReg) & 0x07; // RxLastBits[2:0] indicates the number of valid bits in the last received byte. If this value is 000b, the whole byte is valid.
|
| Amyrctdp |
0:c735c66e37d3
|
398
|
if (validBits)
|
| Amyrctdp |
0:c735c66e37d3
|
399
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
400
|
*validBits = _validBits;
|
| Amyrctdp |
0:c735c66e37d3
|
401
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
402
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
403
|
|
| Amyrctdp |
0:c735c66e37d3
|
404
|
// Tell about collisions
|
| Amyrctdp |
0:c735c66e37d3
|
405
|
if (errorRegValue & 0x08)
|
| Amyrctdp |
0:c735c66e37d3
|
406
|
{ // CollErr
|
| Amyrctdp |
0:c735c66e37d3
|
407
|
return STATUS_COLLISION;
|
| Amyrctdp |
0:c735c66e37d3
|
408
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
409
|
|
| Amyrctdp |
0:c735c66e37d3
|
410
|
// Perform CRC_A validation if requested.
|
| Amyrctdp |
0:c735c66e37d3
|
411
|
if (backData && backLen && checkCRC)
|
| Amyrctdp |
0:c735c66e37d3
|
412
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
413
|
// In this case a MIFARE Classic NAK is not OK.
|
| Amyrctdp |
0:c735c66e37d3
|
414
|
if ((*backLen == 1) && (_validBits == 4))
|
| Amyrctdp |
0:c735c66e37d3
|
415
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
416
|
return STATUS_MIFARE_NACK;
|
| Amyrctdp |
0:c735c66e37d3
|
417
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
418
|
|
| Amyrctdp |
0:c735c66e37d3
|
419
|
// We need at least the CRC_A value and all 8 bits of the last byte must be received.
|
| Amyrctdp |
0:c735c66e37d3
|
420
|
if ((*backLen < 2) || (_validBits != 0))
|
| Amyrctdp |
0:c735c66e37d3
|
421
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
422
|
return STATUS_CRC_WRONG;
|
| Amyrctdp |
0:c735c66e37d3
|
423
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
424
|
|
| Amyrctdp |
0:c735c66e37d3
|
425
|
// Verify CRC_A - do our own calculation and store the control in controlBuffer.
|
| Amyrctdp |
0:c735c66e37d3
|
426
|
uint8_t controlBuffer[2];
|
| Amyrctdp |
0:c735c66e37d3
|
427
|
n = PCD_CalculateCRC(&backData[0], *backLen - 2, &controlBuffer[0]);
|
| Amyrctdp |
0:c735c66e37d3
|
428
|
if (n != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
429
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
430
|
return n;
|
| Amyrctdp |
0:c735c66e37d3
|
431
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
432
|
|
| Amyrctdp |
0:c735c66e37d3
|
433
|
if ((backData[*backLen - 2] != controlBuffer[0]) || (backData[*backLen - 1] != controlBuffer[1]))
|
| Amyrctdp |
0:c735c66e37d3
|
434
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
435
|
return STATUS_CRC_WRONG;
|
| Amyrctdp |
0:c735c66e37d3
|
436
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
437
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
438
|
|
| Amyrctdp |
0:c735c66e37d3
|
439
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
440
|
} // End PCD_CommunicateWithPICC()
|
| Amyrctdp |
0:c735c66e37d3
|
441
|
|
| Amyrctdp |
0:c735c66e37d3
|
442
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
443
|
* Transmits a REQuest command, Type A. Invites PICCs in state IDLE to go to READY and prepare for anticollision or selection. 7 bit frame.
|
| Amyrctdp |
0:c735c66e37d3
|
444
|
* Beware: When two PICCs are in the field at the same time I often get STATUS_TIMEOUT - probably due do bad antenna design.
|
| Amyrctdp |
0:c735c66e37d3
|
445
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
446
|
uint8_t MFRC522::PICC_RequestA(uint8_t *bufferATQA, uint8_t *bufferSize)
|
| Amyrctdp |
0:c735c66e37d3
|
447
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
448
|
return PICC_REQA_or_WUPA(PICC_CMD_REQA, bufferATQA, bufferSize);
|
| Amyrctdp |
0:c735c66e37d3
|
449
|
} // End PICC_RequestA()
|
| Amyrctdp |
0:c735c66e37d3
|
450
|
|
| Amyrctdp |
0:c735c66e37d3
|
451
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
452
|
* Transmits a Wake-UP command, Type A. Invites PICCs in state IDLE and HALT to go to READY(*) and prepare for anticollision or selection. 7 bit frame.
|
| Amyrctdp |
0:c735c66e37d3
|
453
|
* Beware: When two PICCs are in the field at the same time I often get STATUS_TIMEOUT - probably due do bad antenna design.
|
| Amyrctdp |
0:c735c66e37d3
|
454
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
455
|
uint8_t MFRC522::PICC_WakeupA(uint8_t *bufferATQA, uint8_t *bufferSize)
|
| Amyrctdp |
0:c735c66e37d3
|
456
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
457
|
return PICC_REQA_or_WUPA(PICC_CMD_WUPA, bufferATQA, bufferSize);
|
| Amyrctdp |
0:c735c66e37d3
|
458
|
} // End PICC_WakeupA()
|
| Amyrctdp |
0:c735c66e37d3
|
459
|
|
| Amyrctdp |
0:c735c66e37d3
|
460
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
461
|
* Transmits REQA or WUPA commands.
|
| Amyrctdp |
0:c735c66e37d3
|
462
|
* Beware: When two PICCs are in the field at the same time I often get STATUS_TIMEOUT - probably due do bad antenna design.
|
| Amyrctdp |
0:c735c66e37d3
|
463
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
464
|
uint8_t MFRC522::PICC_REQA_or_WUPA(uint8_t command, uint8_t *bufferATQA, uint8_t *bufferSize)
|
| Amyrctdp |
0:c735c66e37d3
|
465
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
466
|
uint8_t validBits;
|
| Amyrctdp |
0:c735c66e37d3
|
467
|
uint8_t status;
|
| Amyrctdp |
0:c735c66e37d3
|
468
|
|
| Amyrctdp |
0:c735c66e37d3
|
469
|
if (bufferATQA == NULL || *bufferSize < 2)
|
| Amyrctdp |
0:c735c66e37d3
|
470
|
{ // The ATQA response is 2 bytes long.
|
| Amyrctdp |
0:c735c66e37d3
|
471
|
return STATUS_NO_ROOM;
|
| Amyrctdp |
0:c735c66e37d3
|
472
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
473
|
|
| Amyrctdp |
0:c735c66e37d3
|
474
|
// ValuesAfterColl=1 => Bits received after collision are cleared.
|
| Amyrctdp |
0:c735c66e37d3
|
475
|
PCD_ClrRegisterBits(CollReg, 0x80);
|
| Amyrctdp |
0:c735c66e37d3
|
476
|
|
| Amyrctdp |
0:c735c66e37d3
|
477
|
// For REQA and WUPA we need the short frame format
|
| Amyrctdp |
0:c735c66e37d3
|
478
|
// - transmit only 7 bits of the last (and only) byte. TxLastBits = BitFramingReg[2..0]
|
| Amyrctdp |
0:c735c66e37d3
|
479
|
validBits = 7;
|
| Amyrctdp |
0:c735c66e37d3
|
480
|
|
| Amyrctdp |
0:c735c66e37d3
|
481
|
status = PCD_TransceiveData(&command, 1, bufferATQA, bufferSize, &validBits);
|
| Amyrctdp |
0:c735c66e37d3
|
482
|
if (status != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
483
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
484
|
return status;
|
| Amyrctdp |
0:c735c66e37d3
|
485
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
486
|
|
| Amyrctdp |
0:c735c66e37d3
|
487
|
if ((*bufferSize != 2) || (validBits != 0))
|
| Amyrctdp |
0:c735c66e37d3
|
488
|
{ // ATQA must be exactly 16 bits.
|
| Amyrctdp |
0:c735c66e37d3
|
489
|
return STATUS_ERROR;
|
| Amyrctdp |
0:c735c66e37d3
|
490
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
491
|
|
| Amyrctdp |
0:c735c66e37d3
|
492
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
493
|
} // End PICC_REQA_or_WUPA()
|
| Amyrctdp |
0:c735c66e37d3
|
494
|
|
| Amyrctdp |
0:c735c66e37d3
|
495
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
496
|
* Transmits SELECT/ANTICOLLISION commands to select a single PICC.
|
| Amyrctdp |
0:c735c66e37d3
|
497
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
498
|
uint8_t MFRC522::PICC_Select(Uid *uid, uint8_t validBits)
|
| Amyrctdp |
0:c735c66e37d3
|
499
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
500
|
bool uidComplete;
|
| Amyrctdp |
0:c735c66e37d3
|
501
|
bool selectDone;
|
| Amyrctdp |
0:c735c66e37d3
|
502
|
bool useCascadeTag;
|
| Amyrctdp |
0:c735c66e37d3
|
503
|
uint8_t cascadeLevel = 1;
|
| Amyrctdp |
0:c735c66e37d3
|
504
|
uint8_t result;
|
| Amyrctdp |
0:c735c66e37d3
|
505
|
uint8_t count;
|
| Amyrctdp |
0:c735c66e37d3
|
506
|
uint8_t index;
|
| Amyrctdp |
0:c735c66e37d3
|
507
|
uint8_t uidIndex; // The first index in uid->uidByte[] that is used in the current Cascade Level.
|
| Amyrctdp |
0:c735c66e37d3
|
508
|
uint8_t currentLevelKnownBits; // The number of known UID bits in the current Cascade Level.
|
| Amyrctdp |
0:c735c66e37d3
|
509
|
uint8_t buffer[9]; // The SELECT/ANTICOLLISION commands uses a 7 byte standard frame + 2 bytes CRC_A
|
| Amyrctdp |
0:c735c66e37d3
|
510
|
uint8_t bufferUsed; // The number of bytes used in the buffer, ie the number of bytes to transfer to the FIFO.
|
| Amyrctdp |
0:c735c66e37d3
|
511
|
uint8_t rxAlign; // Used in BitFramingReg. Defines the bit position for the first bit received.
|
| Amyrctdp |
0:c735c66e37d3
|
512
|
uint8_t txLastBits; // Used in BitFramingReg. The number of valid bits in the last transmitted byte.
|
| Amyrctdp |
0:c735c66e37d3
|
513
|
uint8_t *responseBuffer;
|
| Amyrctdp |
0:c735c66e37d3
|
514
|
uint8_t responseLength;
|
| Amyrctdp |
0:c735c66e37d3
|
515
|
|
| Amyrctdp |
0:c735c66e37d3
|
516
|
// Description of buffer structure:
|
| Amyrctdp |
0:c735c66e37d3
|
517
|
// Byte 0: SEL Indicates the Cascade Level: PICC_CMD_SEL_CL1, PICC_CMD_SEL_CL2 or PICC_CMD_SEL_CL3
|
| Amyrctdp |
0:c735c66e37d3
|
518
|
// Byte 1: NVB Number of Valid Bits (in complete command, not just the UID): High nibble: complete bytes, Low nibble: Extra bits.
|
| Amyrctdp |
0:c735c66e37d3
|
519
|
// Byte 2: UID-data or CT See explanation below. CT means Cascade Tag.
|
| Amyrctdp |
0:c735c66e37d3
|
520
|
// Byte 3: UID-data
|
| Amyrctdp |
0:c735c66e37d3
|
521
|
// Byte 4: UID-data
|
| Amyrctdp |
0:c735c66e37d3
|
522
|
// Byte 5: UID-data
|
| Amyrctdp |
0:c735c66e37d3
|
523
|
// Byte 6: BCC Block Check Character - XOR of bytes 2-5
|
| Amyrctdp |
0:c735c66e37d3
|
524
|
// Byte 7: CRC_A
|
| Amyrctdp |
0:c735c66e37d3
|
525
|
// Byte 8: CRC_A
|
| Amyrctdp |
0:c735c66e37d3
|
526
|
// The BCC and CRC_A is only transmitted if we know all the UID bits of the current Cascade Level.
|
| Amyrctdp |
0:c735c66e37d3
|
527
|
//
|
| Amyrctdp |
0:c735c66e37d3
|
528
|
// Description of bytes 2-5: (Section 6.5.4 of the ISO/IEC 14443-3 draft: UID contents and cascade levels)
|
| Amyrctdp |
0:c735c66e37d3
|
529
|
// UID size Cascade level Byte2 Byte3 Byte4 Byte5
|
| Amyrctdp |
0:c735c66e37d3
|
530
|
// ======== ============= ===== ===== ===== =====
|
| Amyrctdp |
0:c735c66e37d3
|
531
|
// 4 bytes 1 uid0 uid1 uid2 uid3
|
| Amyrctdp |
0:c735c66e37d3
|
532
|
// 7 bytes 1 CT uid0 uid1 uid2
|
| Amyrctdp |
0:c735c66e37d3
|
533
|
// 2 uid3 uid4 uid5 uid6
|
| Amyrctdp |
0:c735c66e37d3
|
534
|
// 10 bytes 1 CT uid0 uid1 uid2
|
| Amyrctdp |
0:c735c66e37d3
|
535
|
// 2 CT uid3 uid4 uid5
|
| Amyrctdp |
0:c735c66e37d3
|
536
|
// 3 uid6 uid7 uid8 uid9
|
| Amyrctdp |
0:c735c66e37d3
|
537
|
|
| Amyrctdp |
0:c735c66e37d3
|
538
|
// Sanity checks
|
| Amyrctdp |
0:c735c66e37d3
|
539
|
if (validBits > 80)
|
| Amyrctdp |
0:c735c66e37d3
|
540
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
541
|
return STATUS_INVALID;
|
| Amyrctdp |
0:c735c66e37d3
|
542
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
543
|
|
| Amyrctdp |
0:c735c66e37d3
|
544
|
// Prepare MFRC522
|
| Amyrctdp |
0:c735c66e37d3
|
545
|
// ValuesAfterColl=1 => Bits received after collision are cleared.
|
| Amyrctdp |
0:c735c66e37d3
|
546
|
PCD_ClrRegisterBits(CollReg, 0x80);
|
| Amyrctdp |
0:c735c66e37d3
|
547
|
|
| Amyrctdp |
0:c735c66e37d3
|
548
|
// Repeat Cascade Level loop until we have a complete UID.
|
| Amyrctdp |
0:c735c66e37d3
|
549
|
uidComplete = false;
|
| Amyrctdp |
0:c735c66e37d3
|
550
|
while ( ! uidComplete)
|
| Amyrctdp |
0:c735c66e37d3
|
551
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
552
|
// Set the Cascade Level in the SEL byte, find out if we need to use the Cascade Tag in byte 2.
|
| Amyrctdp |
0:c735c66e37d3
|
553
|
switch (cascadeLevel)
|
| Amyrctdp |
0:c735c66e37d3
|
554
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
555
|
case 1:
|
| Amyrctdp |
0:c735c66e37d3
|
556
|
buffer[0] = PICC_CMD_SEL_CL1;
|
| Amyrctdp |
0:c735c66e37d3
|
557
|
uidIndex = 0;
|
| Amyrctdp |
0:c735c66e37d3
|
558
|
useCascadeTag = validBits && (uid->size > 4); // When we know that the UID has more than 4 bytes
|
| Amyrctdp |
0:c735c66e37d3
|
559
|
break;
|
| Amyrctdp |
0:c735c66e37d3
|
560
|
|
| Amyrctdp |
0:c735c66e37d3
|
561
|
case 2:
|
| Amyrctdp |
0:c735c66e37d3
|
562
|
buffer[0] = PICC_CMD_SEL_CL2;
|
| Amyrctdp |
0:c735c66e37d3
|
563
|
uidIndex = 3;
|
| Amyrctdp |
0:c735c66e37d3
|
564
|
useCascadeTag = validBits && (uid->size > 7); // When we know that the UID has more than 7 bytes
|
| Amyrctdp |
0:c735c66e37d3
|
565
|
break;
|
| Amyrctdp |
0:c735c66e37d3
|
566
|
|
| Amyrctdp |
0:c735c66e37d3
|
567
|
case 3:
|
| Amyrctdp |
0:c735c66e37d3
|
568
|
buffer[0] = PICC_CMD_SEL_CL3;
|
| Amyrctdp |
0:c735c66e37d3
|
569
|
uidIndex = 6;
|
| Amyrctdp |
0:c735c66e37d3
|
570
|
useCascadeTag = false; // Never used in CL3.
|
| Amyrctdp |
0:c735c66e37d3
|
571
|
break;
|
| Amyrctdp |
0:c735c66e37d3
|
572
|
|
| Amyrctdp |
0:c735c66e37d3
|
573
|
default:
|
| Amyrctdp |
0:c735c66e37d3
|
574
|
return STATUS_INTERNAL_ERROR;
|
| Amyrctdp |
0:c735c66e37d3
|
575
|
//break;
|
| Amyrctdp |
0:c735c66e37d3
|
576
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
577
|
|
| Amyrctdp |
0:c735c66e37d3
|
578
|
// How many UID bits are known in this Cascade Level?
|
| Amyrctdp |
0:c735c66e37d3
|
579
|
if(validBits > (8 * uidIndex))
|
| Amyrctdp |
0:c735c66e37d3
|
580
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
581
|
currentLevelKnownBits = validBits - (8 * uidIndex);
|
| Amyrctdp |
0:c735c66e37d3
|
582
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
583
|
else
|
| Amyrctdp |
0:c735c66e37d3
|
584
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
585
|
currentLevelKnownBits = 0;
|
| Amyrctdp |
0:c735c66e37d3
|
586
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
587
|
|
| Amyrctdp |
0:c735c66e37d3
|
588
|
// Copy the known bits from uid->uidByte[] to buffer[]
|
| Amyrctdp |
0:c735c66e37d3
|
589
|
index = 2; // destination index in buffer[]
|
| Amyrctdp |
0:c735c66e37d3
|
590
|
if (useCascadeTag)
|
| Amyrctdp |
0:c735c66e37d3
|
591
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
592
|
buffer[index++] = PICC_CMD_CT;
|
| Amyrctdp |
0:c735c66e37d3
|
593
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
594
|
|
| Amyrctdp |
0:c735c66e37d3
|
595
|
uint8_t bytesToCopy = currentLevelKnownBits / 8 + (currentLevelKnownBits % 8 ? 1 : 0); // The number of bytes needed to represent the known bits for this level.
|
| Amyrctdp |
0:c735c66e37d3
|
596
|
if (bytesToCopy)
|
| Amyrctdp |
0:c735c66e37d3
|
597
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
598
|
// Max 4 bytes in each Cascade Level. Only 3 left if we use the Cascade Tag
|
| Amyrctdp |
0:c735c66e37d3
|
599
|
uint8_t maxBytes = useCascadeTag ? 3 : 4;
|
| Amyrctdp |
0:c735c66e37d3
|
600
|
if (bytesToCopy > maxBytes)
|
| Amyrctdp |
0:c735c66e37d3
|
601
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
602
|
bytesToCopy = maxBytes;
|
| Amyrctdp |
0:c735c66e37d3
|
603
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
604
|
|
| Amyrctdp |
0:c735c66e37d3
|
605
|
for (count = 0; count < bytesToCopy; count++)
|
| Amyrctdp |
0:c735c66e37d3
|
606
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
607
|
buffer[index++] = uid->uidByte[uidIndex + count];
|
| Amyrctdp |
0:c735c66e37d3
|
608
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
609
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
610
|
|
| Amyrctdp |
0:c735c66e37d3
|
611
|
// Now that the data has been copied we need to include the 8 bits in CT in currentLevelKnownBits
|
| Amyrctdp |
0:c735c66e37d3
|
612
|
if (useCascadeTag)
|
| Amyrctdp |
0:c735c66e37d3
|
613
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
614
|
currentLevelKnownBits += 8;
|
| Amyrctdp |
0:c735c66e37d3
|
615
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
616
|
|
| Amyrctdp |
0:c735c66e37d3
|
617
|
// Repeat anti collision loop until we can transmit all UID bits + BCC and receive a SAK - max 32 iterations.
|
| Amyrctdp |
0:c735c66e37d3
|
618
|
selectDone = false;
|
| Amyrctdp |
0:c735c66e37d3
|
619
|
while ( ! selectDone)
|
| Amyrctdp |
0:c735c66e37d3
|
620
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
621
|
// Find out how many bits and bytes to send and receive.
|
| Amyrctdp |
0:c735c66e37d3
|
622
|
if (currentLevelKnownBits >= 32)
|
| Amyrctdp |
0:c735c66e37d3
|
623
|
{ // All UID bits in this Cascade Level are known. This is a SELECT.
|
| Amyrctdp |
0:c735c66e37d3
|
624
|
//Serial.print("SELECT: currentLevelKnownBits="); Serial.println(currentLevelKnownBits, DEC);
|
| Amyrctdp |
0:c735c66e37d3
|
625
|
buffer[1] = 0x70; // NVB - Number of Valid Bits: Seven whole bytes
|
| Amyrctdp |
0:c735c66e37d3
|
626
|
|
| Amyrctdp |
0:c735c66e37d3
|
627
|
// Calulate BCC - Block Check Character
|
| Amyrctdp |
0:c735c66e37d3
|
628
|
buffer[6] = buffer[2] ^ buffer[3] ^ buffer[4] ^ buffer[5];
|
| Amyrctdp |
0:c735c66e37d3
|
629
|
|
| Amyrctdp |
0:c735c66e37d3
|
630
|
// Calculate CRC_A
|
| Amyrctdp |
0:c735c66e37d3
|
631
|
result = PCD_CalculateCRC(buffer, 7, &buffer[7]);
|
| Amyrctdp |
0:c735c66e37d3
|
632
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
633
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
634
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
635
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
636
|
|
| Amyrctdp |
0:c735c66e37d3
|
637
|
txLastBits = 0; // 0 => All 8 bits are valid.
|
| Amyrctdp |
0:c735c66e37d3
|
638
|
bufferUsed = 9;
|
| Amyrctdp |
0:c735c66e37d3
|
639
|
|
| Amyrctdp |
0:c735c66e37d3
|
640
|
// Store response in the last 3 bytes of buffer (BCC and CRC_A - not needed after tx)
|
| Amyrctdp |
0:c735c66e37d3
|
641
|
responseBuffer = &buffer[6];
|
| Amyrctdp |
0:c735c66e37d3
|
642
|
responseLength = 3;
|
| Amyrctdp |
0:c735c66e37d3
|
643
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
644
|
else
|
| Amyrctdp |
0:c735c66e37d3
|
645
|
{ // This is an ANTICOLLISION.
|
| Amyrctdp |
0:c735c66e37d3
|
646
|
//Serial.print("ANTICOLLISION: currentLevelKnownBits="); Serial.println(currentLevelKnownBits, DEC);
|
| Amyrctdp |
0:c735c66e37d3
|
647
|
txLastBits = currentLevelKnownBits % 8;
|
| Amyrctdp |
0:c735c66e37d3
|
648
|
count = currentLevelKnownBits / 8; // Number of whole bytes in the UID part.
|
| Amyrctdp |
0:c735c66e37d3
|
649
|
index = 2 + count; // Number of whole bytes: SEL + NVB + UIDs
|
| Amyrctdp |
0:c735c66e37d3
|
650
|
buffer[1] = (index << 4) + txLastBits; // NVB - Number of Valid Bits
|
| Amyrctdp |
0:c735c66e37d3
|
651
|
bufferUsed = index + (txLastBits ? 1 : 0);
|
| Amyrctdp |
0:c735c66e37d3
|
652
|
|
| Amyrctdp |
0:c735c66e37d3
|
653
|
// Store response in the unused part of buffer
|
| Amyrctdp |
0:c735c66e37d3
|
654
|
responseBuffer = &buffer[index];
|
| Amyrctdp |
0:c735c66e37d3
|
655
|
responseLength = sizeof(buffer) - index;
|
| Amyrctdp |
0:c735c66e37d3
|
656
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
657
|
|
| Amyrctdp |
0:c735c66e37d3
|
658
|
// Set bit adjustments
|
| Amyrctdp |
0:c735c66e37d3
|
659
|
rxAlign = txLastBits; // Having a seperate variable is overkill. But it makes the next line easier to read.
|
| Amyrctdp |
0:c735c66e37d3
|
660
|
PCD_WriteRegister(BitFramingReg, (rxAlign << 4) + txLastBits); // RxAlign = BitFramingReg[6..4]. TxLastBits = BitFramingReg[2..0]
|
| Amyrctdp |
0:c735c66e37d3
|
661
|
|
| Amyrctdp |
0:c735c66e37d3
|
662
|
// Transmit the buffer and receive the response.
|
| Amyrctdp |
0:c735c66e37d3
|
663
|
result = PCD_TransceiveData(buffer, bufferUsed, responseBuffer, &responseLength, &txLastBits, rxAlign);
|
| Amyrctdp |
0:c735c66e37d3
|
664
|
if (result == STATUS_COLLISION)
|
| Amyrctdp |
0:c735c66e37d3
|
665
|
{ // More than one PICC in the field => collision.
|
| Amyrctdp |
0:c735c66e37d3
|
666
|
result = PCD_ReadRegister(CollReg); // CollReg[7..0] bits are: ValuesAfterColl reserved CollPosNotValid CollPos[4:0]
|
| Amyrctdp |
0:c735c66e37d3
|
667
|
if (result & 0x20)
|
| Amyrctdp |
0:c735c66e37d3
|
668
|
{ // CollPosNotValid
|
| Amyrctdp |
0:c735c66e37d3
|
669
|
return STATUS_COLLISION; // Without a valid collision position we cannot continue
|
| Amyrctdp |
0:c735c66e37d3
|
670
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
671
|
|
| Amyrctdp |
0:c735c66e37d3
|
672
|
uint8_t collisionPos = result & 0x1F; // Values 0-31, 0 means bit 32.
|
| Amyrctdp |
0:c735c66e37d3
|
673
|
if (collisionPos == 0)
|
| Amyrctdp |
0:c735c66e37d3
|
674
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
675
|
collisionPos = 32;
|
| Amyrctdp |
0:c735c66e37d3
|
676
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
677
|
|
| Amyrctdp |
0:c735c66e37d3
|
678
|
if (collisionPos <= currentLevelKnownBits)
|
| Amyrctdp |
0:c735c66e37d3
|
679
|
{ // No progress - should not happen
|
| Amyrctdp |
0:c735c66e37d3
|
680
|
return STATUS_INTERNAL_ERROR;
|
| Amyrctdp |
0:c735c66e37d3
|
681
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
682
|
|
| Amyrctdp |
0:c735c66e37d3
|
683
|
// Choose the PICC with the bit set.
|
| Amyrctdp |
0:c735c66e37d3
|
684
|
currentLevelKnownBits = collisionPos;
|
| Amyrctdp |
0:c735c66e37d3
|
685
|
count = (currentLevelKnownBits - 1) % 8; // The bit to modify
|
| Amyrctdp |
0:c735c66e37d3
|
686
|
index = 1 + (currentLevelKnownBits / 8) + (count ? 1 : 0); // First byte is index 0.
|
| Amyrctdp |
0:c735c66e37d3
|
687
|
buffer[index] |= (1 << count);
|
| Amyrctdp |
0:c735c66e37d3
|
688
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
689
|
else if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
690
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
691
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
692
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
693
|
else
|
| Amyrctdp |
0:c735c66e37d3
|
694
|
{ // STATUS_OK
|
| Amyrctdp |
0:c735c66e37d3
|
695
|
if (currentLevelKnownBits >= 32)
|
| Amyrctdp |
0:c735c66e37d3
|
696
|
{ // This was a SELECT.
|
| Amyrctdp |
0:c735c66e37d3
|
697
|
selectDone = true; // No more anticollision
|
| Amyrctdp |
0:c735c66e37d3
|
698
|
// We continue below outside the while.
|
| Amyrctdp |
0:c735c66e37d3
|
699
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
700
|
else
|
| Amyrctdp |
0:c735c66e37d3
|
701
|
{ // This was an ANTICOLLISION.
|
| Amyrctdp |
0:c735c66e37d3
|
702
|
// We now have all 32 bits of the UID in this Cascade Level
|
| Amyrctdp |
0:c735c66e37d3
|
703
|
currentLevelKnownBits = 32;
|
| Amyrctdp |
0:c735c66e37d3
|
704
|
// Run loop again to do the SELECT.
|
| Amyrctdp |
0:c735c66e37d3
|
705
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
706
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
707
|
} // End of while ( ! selectDone)
|
| Amyrctdp |
0:c735c66e37d3
|
708
|
|
| Amyrctdp |
0:c735c66e37d3
|
709
|
// We do not check the CBB - it was constructed by us above.
|
| Amyrctdp |
0:c735c66e37d3
|
710
|
|
| Amyrctdp |
0:c735c66e37d3
|
711
|
// Copy the found UID bytes from buffer[] to uid->uidByte[]
|
| Amyrctdp |
0:c735c66e37d3
|
712
|
index = (buffer[2] == PICC_CMD_CT) ? 3 : 2; // source index in buffer[]
|
| Amyrctdp |
0:c735c66e37d3
|
713
|
bytesToCopy = (buffer[2] == PICC_CMD_CT) ? 3 : 4;
|
| Amyrctdp |
0:c735c66e37d3
|
714
|
for (count = 0; count < bytesToCopy; count++)
|
| Amyrctdp |
0:c735c66e37d3
|
715
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
716
|
uid->uidByte[uidIndex + count] = buffer[index++];
|
| Amyrctdp |
0:c735c66e37d3
|
717
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
718
|
|
| Amyrctdp |
0:c735c66e37d3
|
719
|
// Check response SAK (Select Acknowledge)
|
| Amyrctdp |
0:c735c66e37d3
|
720
|
if (responseLength != 3 || txLastBits != 0)
|
| Amyrctdp |
0:c735c66e37d3
|
721
|
{ // SAK must be exactly 24 bits (1 byte + CRC_A).
|
| Amyrctdp |
0:c735c66e37d3
|
722
|
return STATUS_ERROR;
|
| Amyrctdp |
0:c735c66e37d3
|
723
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
724
|
|
| Amyrctdp |
0:c735c66e37d3
|
725
|
// Verify CRC_A - do our own calculation and store the control in buffer[2..3] - those bytes are not needed anymore.
|
| Amyrctdp |
0:c735c66e37d3
|
726
|
result = PCD_CalculateCRC(responseBuffer, 1, &buffer[2]);
|
| Amyrctdp |
0:c735c66e37d3
|
727
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
728
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
729
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
730
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
731
|
|
| Amyrctdp |
0:c735c66e37d3
|
732
|
if ((buffer[2] != responseBuffer[1]) || (buffer[3] != responseBuffer[2]))
|
| Amyrctdp |
0:c735c66e37d3
|
733
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
734
|
return STATUS_CRC_WRONG;
|
| Amyrctdp |
0:c735c66e37d3
|
735
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
736
|
|
| Amyrctdp |
0:c735c66e37d3
|
737
|
if (responseBuffer[0] & 0x04)
|
| Amyrctdp |
0:c735c66e37d3
|
738
|
{ // Cascade bit set - UID not complete yes
|
| Amyrctdp |
0:c735c66e37d3
|
739
|
cascadeLevel++;
|
| Amyrctdp |
0:c735c66e37d3
|
740
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
741
|
else
|
| Amyrctdp |
0:c735c66e37d3
|
742
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
743
|
uidComplete = true;
|
| Amyrctdp |
0:c735c66e37d3
|
744
|
uid->sak = responseBuffer[0];
|
| Amyrctdp |
0:c735c66e37d3
|
745
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
746
|
} // End of while ( ! uidComplete)
|
| Amyrctdp |
0:c735c66e37d3
|
747
|
|
| Amyrctdp |
0:c735c66e37d3
|
748
|
// Set correct uid->size
|
| Amyrctdp |
0:c735c66e37d3
|
749
|
uid->size = 3 * cascadeLevel + 1;
|
| Amyrctdp |
0:c735c66e37d3
|
750
|
|
| Amyrctdp |
0:c735c66e37d3
|
751
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
752
|
} // End PICC_Select()
|
| Amyrctdp |
0:c735c66e37d3
|
753
|
|
| Amyrctdp |
0:c735c66e37d3
|
754
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
755
|
* Instructs a PICC in state ACTIVE(*) to go to state HALT.
|
| Amyrctdp |
0:c735c66e37d3
|
756
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
757
|
uint8_t MFRC522::PICC_HaltA()
|
| Amyrctdp |
0:c735c66e37d3
|
758
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
759
|
uint8_t result;
|
| Amyrctdp |
0:c735c66e37d3
|
760
|
uint8_t buffer[4];
|
| Amyrctdp |
0:c735c66e37d3
|
761
|
|
| Amyrctdp |
0:c735c66e37d3
|
762
|
// Build command buffer
|
| Amyrctdp |
0:c735c66e37d3
|
763
|
buffer[0] = PICC_CMD_HLTA;
|
| Amyrctdp |
0:c735c66e37d3
|
764
|
buffer[1] = 0;
|
| Amyrctdp |
0:c735c66e37d3
|
765
|
|
| Amyrctdp |
0:c735c66e37d3
|
766
|
// Calculate CRC_A
|
| Amyrctdp |
0:c735c66e37d3
|
767
|
result = PCD_CalculateCRC(buffer, 2, &buffer[2]);
|
| Amyrctdp |
0:c735c66e37d3
|
768
|
if (result == STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
769
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
770
|
// Send the command.
|
| Amyrctdp |
0:c735c66e37d3
|
771
|
// The standard says:
|
| Amyrctdp |
0:c735c66e37d3
|
772
|
// If the PICC responds with any modulation during a period of 1 ms after the end of the frame containing the
|
| Amyrctdp |
0:c735c66e37d3
|
773
|
// HLTA command, this response shall be interpreted as 'not acknowledge'.
|
| Amyrctdp |
0:c735c66e37d3
|
774
|
// We interpret that this way: Only STATUS_TIMEOUT is an success.
|
| Amyrctdp |
0:c735c66e37d3
|
775
|
result = PCD_TransceiveData(buffer, sizeof(buffer), NULL, 0);
|
| Amyrctdp |
0:c735c66e37d3
|
776
|
if (result == STATUS_TIMEOUT)
|
| Amyrctdp |
0:c735c66e37d3
|
777
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
778
|
result = STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
779
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
780
|
else if (result == STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
781
|
{ // That is ironically NOT ok in this case ;-)
|
| Amyrctdp |
0:c735c66e37d3
|
782
|
result = STATUS_ERROR;
|
| Amyrctdp |
0:c735c66e37d3
|
783
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
784
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
785
|
|
| Amyrctdp |
0:c735c66e37d3
|
786
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
787
|
} // End PICC_HaltA()
|
| Amyrctdp |
0:c735c66e37d3
|
788
|
|
| Amyrctdp |
0:c735c66e37d3
|
789
|
|
| Amyrctdp |
0:c735c66e37d3
|
790
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
791
|
// Functions for communicating with MIFARE PICCs
|
| Amyrctdp |
0:c735c66e37d3
|
792
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
793
|
|
| Amyrctdp |
0:c735c66e37d3
|
794
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
795
|
* Executes the MFRC522 MFAuthent command.
|
| Amyrctdp |
0:c735c66e37d3
|
796
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
797
|
uint8_t MFRC522::PCD_Authenticate(uint8_t command, uint8_t blockAddr, MIFARE_Key *key, Uid *uid)
|
| Amyrctdp |
0:c735c66e37d3
|
798
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
799
|
uint8_t i, waitIRq = 0x10; // IdleIRq
|
| Amyrctdp |
0:c735c66e37d3
|
800
|
|
| Amyrctdp |
0:c735c66e37d3
|
801
|
// Build command buffer
|
| Amyrctdp |
0:c735c66e37d3
|
802
|
uint8_t sendData[12];
|
| Amyrctdp |
0:c735c66e37d3
|
803
|
sendData[0] = command;
|
| Amyrctdp |
0:c735c66e37d3
|
804
|
sendData[1] = blockAddr;
|
| Amyrctdp |
0:c735c66e37d3
|
805
|
|
| Amyrctdp |
0:c735c66e37d3
|
806
|
for (i = 0; i < MF_KEY_SIZE; i++)
|
| Amyrctdp |
0:c735c66e37d3
|
807
|
{ // 6 key bytes
|
| Amyrctdp |
0:c735c66e37d3
|
808
|
sendData[2+i] = key->keyByte[i];
|
| Amyrctdp |
0:c735c66e37d3
|
809
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
810
|
|
| Amyrctdp |
0:c735c66e37d3
|
811
|
for (i = 0; i < 4; i++)
|
| Amyrctdp |
0:c735c66e37d3
|
812
|
{ // The first 4 bytes of the UID
|
| Amyrctdp |
0:c735c66e37d3
|
813
|
sendData[8+i] = uid->uidByte[i];
|
| Amyrctdp |
0:c735c66e37d3
|
814
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
815
|
|
| Amyrctdp |
0:c735c66e37d3
|
816
|
// Start the authentication.
|
| Amyrctdp |
0:c735c66e37d3
|
817
|
return PCD_CommunicateWithPICC(PCD_MFAuthent, waitIRq, &sendData[0], sizeof(sendData));
|
| Amyrctdp |
0:c735c66e37d3
|
818
|
} // End PCD_Authenticate()
|
| Amyrctdp |
0:c735c66e37d3
|
819
|
|
| Amyrctdp |
0:c735c66e37d3
|
820
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
821
|
* Used to exit the PCD from its authenticated state.
|
| Amyrctdp |
0:c735c66e37d3
|
822
|
* Remember to call this function after communicating with an authenticated PICC - otherwise no new communications can start.
|
| Amyrctdp |
0:c735c66e37d3
|
823
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
824
|
void MFRC522::PCD_StopCrypto1()
|
| Amyrctdp |
0:c735c66e37d3
|
825
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
826
|
// Clear MFCrypto1On bit
|
| Amyrctdp |
0:c735c66e37d3
|
827
|
PCD_ClrRegisterBits(Status2Reg, 0x08); // Status2Reg[7..0] bits are: TempSensClear I2CForceHS reserved reserved MFCrypto1On ModemState[2:0]
|
| Amyrctdp |
0:c735c66e37d3
|
828
|
} // End PCD_StopCrypto1()
|
| Amyrctdp |
0:c735c66e37d3
|
829
|
|
| Amyrctdp |
0:c735c66e37d3
|
830
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
831
|
* Reads 16 bytes (+ 2 bytes CRC_A) from the active PICC.
|
| Amyrctdp |
0:c735c66e37d3
|
832
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
833
|
uint8_t MFRC522::MIFARE_Read(uint8_t blockAddr, uint8_t *buffer, uint8_t *bufferSize)
|
| Amyrctdp |
0:c735c66e37d3
|
834
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
835
|
uint8_t result = STATUS_NO_ROOM;
|
| Amyrctdp |
0:c735c66e37d3
|
836
|
|
| Amyrctdp |
0:c735c66e37d3
|
837
|
// Sanity check
|
| Amyrctdp |
0:c735c66e37d3
|
838
|
if ((buffer == NULL) || (*bufferSize < 18))
|
| Amyrctdp |
0:c735c66e37d3
|
839
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
840
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
841
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
842
|
|
| Amyrctdp |
0:c735c66e37d3
|
843
|
// Build command buffer
|
| Amyrctdp |
0:c735c66e37d3
|
844
|
buffer[0] = PICC_CMD_MF_READ;
|
| Amyrctdp |
0:c735c66e37d3
|
845
|
buffer[1] = blockAddr;
|
| Amyrctdp |
0:c735c66e37d3
|
846
|
|
| Amyrctdp |
0:c735c66e37d3
|
847
|
// Calculate CRC_A
|
| Amyrctdp |
0:c735c66e37d3
|
848
|
result = PCD_CalculateCRC(buffer, 2, &buffer[2]);
|
| Amyrctdp |
0:c735c66e37d3
|
849
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
850
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
851
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
852
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
853
|
|
| Amyrctdp |
0:c735c66e37d3
|
854
|
// Transmit the buffer and receive the response, validate CRC_A.
|
| Amyrctdp |
0:c735c66e37d3
|
855
|
return PCD_TransceiveData(buffer, 4, buffer, bufferSize, NULL, 0, true);
|
| Amyrctdp |
0:c735c66e37d3
|
856
|
} // End MIFARE_Read()
|
| Amyrctdp |
0:c735c66e37d3
|
857
|
|
| Amyrctdp |
0:c735c66e37d3
|
858
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
859
|
* Writes 16 bytes to the active PICC.
|
| Amyrctdp |
0:c735c66e37d3
|
860
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
861
|
uint8_t MFRC522::MIFARE_Write(uint8_t blockAddr, uint8_t *buffer, uint8_t bufferSize)
|
| Amyrctdp |
0:c735c66e37d3
|
862
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
863
|
uint8_t result;
|
| Amyrctdp |
0:c735c66e37d3
|
864
|
|
| Amyrctdp |
0:c735c66e37d3
|
865
|
// Sanity check
|
| Amyrctdp |
0:c735c66e37d3
|
866
|
if (buffer == NULL || bufferSize < 16)
|
| Amyrctdp |
0:c735c66e37d3
|
867
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
868
|
return STATUS_INVALID;
|
| Amyrctdp |
0:c735c66e37d3
|
869
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
870
|
|
| Amyrctdp |
0:c735c66e37d3
|
871
|
// Mifare Classic protocol requires two communications to perform a write.
|
| Amyrctdp |
0:c735c66e37d3
|
872
|
// Step 1: Tell the PICC we want to write to block blockAddr.
|
| Amyrctdp |
0:c735c66e37d3
|
873
|
uint8_t cmdBuffer[2];
|
| Amyrctdp |
0:c735c66e37d3
|
874
|
cmdBuffer[0] = PICC_CMD_MF_WRITE;
|
| Amyrctdp |
0:c735c66e37d3
|
875
|
cmdBuffer[1] = blockAddr;
|
| Amyrctdp |
0:c735c66e37d3
|
876
|
// Adds CRC_A and checks that the response is MF_ACK.
|
| Amyrctdp |
0:c735c66e37d3
|
877
|
result = PCD_MIFARE_Transceive(cmdBuffer, 2);
|
| Amyrctdp |
0:c735c66e37d3
|
878
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
879
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
880
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
881
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
882
|
|
| Amyrctdp |
0:c735c66e37d3
|
883
|
// Step 2: Transfer the data
|
| Amyrctdp |
0:c735c66e37d3
|
884
|
// Adds CRC_A and checks that the response is MF_ACK.
|
| Amyrctdp |
0:c735c66e37d3
|
885
|
result = PCD_MIFARE_Transceive(buffer, bufferSize);
|
| Amyrctdp |
0:c735c66e37d3
|
886
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
887
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
888
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
889
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
890
|
|
| Amyrctdp |
0:c735c66e37d3
|
891
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
892
|
} // End MIFARE_Write()
|
| Amyrctdp |
0:c735c66e37d3
|
893
|
|
| Amyrctdp |
0:c735c66e37d3
|
894
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
895
|
* Writes a 4 byte page to the active MIFARE Ultralight PICC.
|
| Amyrctdp |
0:c735c66e37d3
|
896
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
897
|
uint8_t MFRC522::MIFARE_UltralightWrite(uint8_t page, uint8_t *buffer, uint8_t bufferSize)
|
| Amyrctdp |
0:c735c66e37d3
|
898
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
899
|
uint8_t result;
|
| Amyrctdp |
0:c735c66e37d3
|
900
|
|
| Amyrctdp |
0:c735c66e37d3
|
901
|
// Sanity check
|
| Amyrctdp |
0:c735c66e37d3
|
902
|
if (buffer == NULL || bufferSize < 4)
|
| Amyrctdp |
0:c735c66e37d3
|
903
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
904
|
return STATUS_INVALID;
|
| Amyrctdp |
0:c735c66e37d3
|
905
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
906
|
|
| Amyrctdp |
0:c735c66e37d3
|
907
|
// Build commmand buffer
|
| Amyrctdp |
0:c735c66e37d3
|
908
|
uint8_t cmdBuffer[6];
|
| Amyrctdp |
0:c735c66e37d3
|
909
|
cmdBuffer[0] = PICC_CMD_UL_WRITE;
|
| Amyrctdp |
0:c735c66e37d3
|
910
|
cmdBuffer[1] = page;
|
| Amyrctdp |
0:c735c66e37d3
|
911
|
memcpy(&cmdBuffer[2], buffer, 4);
|
| Amyrctdp |
0:c735c66e37d3
|
912
|
|
| Amyrctdp |
0:c735c66e37d3
|
913
|
// Perform the write
|
| Amyrctdp |
0:c735c66e37d3
|
914
|
result = PCD_MIFARE_Transceive(cmdBuffer, 6); // Adds CRC_A and checks that the response is MF_ACK.
|
| Amyrctdp |
0:c735c66e37d3
|
915
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
916
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
917
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
918
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
919
|
|
| Amyrctdp |
0:c735c66e37d3
|
920
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
921
|
} // End MIFARE_Ultralight_Write()
|
| Amyrctdp |
0:c735c66e37d3
|
922
|
|
| Amyrctdp |
0:c735c66e37d3
|
923
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
924
|
* MIFARE Decrement subtracts the delta from the value of the addressed block, and stores the result in a volatile memory.
|
| Amyrctdp |
0:c735c66e37d3
|
925
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
926
|
uint8_t MFRC522::MIFARE_Decrement(uint8_t blockAddr, uint32_t delta)
|
| Amyrctdp |
0:c735c66e37d3
|
927
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
928
|
return MIFARE_TwoStepHelper(PICC_CMD_MF_DECREMENT, blockAddr, delta);
|
| Amyrctdp |
0:c735c66e37d3
|
929
|
} // End MIFARE_Decrement()
|
| Amyrctdp |
0:c735c66e37d3
|
930
|
|
| Amyrctdp |
0:c735c66e37d3
|
931
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
932
|
* MIFARE Increment adds the delta to the value of the addressed block, and stores the result in a volatile memory.
|
| Amyrctdp |
0:c735c66e37d3
|
933
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
934
|
uint8_t MFRC522::MIFARE_Increment(uint8_t blockAddr, uint32_t delta)
|
| Amyrctdp |
0:c735c66e37d3
|
935
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
936
|
return MIFARE_TwoStepHelper(PICC_CMD_MF_INCREMENT, blockAddr, delta);
|
| Amyrctdp |
0:c735c66e37d3
|
937
|
} // End MIFARE_Increment()
|
| Amyrctdp |
0:c735c66e37d3
|
938
|
|
| Amyrctdp |
0:c735c66e37d3
|
939
|
/**
|
| Amyrctdp |
0:c735c66e37d3
|
940
|
* MIFARE Restore copies the value of the addressed block into a volatile memory.
|
| Amyrctdp |
0:c735c66e37d3
|
941
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
942
|
uint8_t MFRC522::MIFARE_Restore(uint8_t blockAddr)
|
| Amyrctdp |
0:c735c66e37d3
|
943
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
944
|
// The datasheet describes Restore as a two step operation, but does not explain what data to transfer in step 2.
|
| Amyrctdp |
0:c735c66e37d3
|
945
|
// Doing only a single step does not work, so I chose to transfer 0L in step two.
|
| Amyrctdp |
0:c735c66e37d3
|
946
|
return MIFARE_TwoStepHelper(PICC_CMD_MF_RESTORE, blockAddr, 0L);
|
| Amyrctdp |
0:c735c66e37d3
|
947
|
} // End MIFARE_Restore()
|
| Amyrctdp |
0:c735c66e37d3
|
948
|
|
| Amyrctdp |
0:c735c66e37d3
|
949
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
950
|
* Helper function for the two-step MIFARE Classic protocol operations Decrement, Increment and Restore.
|
| Amyrctdp |
0:c735c66e37d3
|
951
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
952
|
uint8_t MFRC522::MIFARE_TwoStepHelper(uint8_t command, uint8_t blockAddr, uint32_t data)
|
| Amyrctdp |
0:c735c66e37d3
|
953
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
954
|
uint8_t result;
|
| Amyrctdp |
0:c735c66e37d3
|
955
|
uint8_t cmdBuffer[2]; // We only need room for 2 bytes.
|
| Amyrctdp |
0:c735c66e37d3
|
956
|
|
| Amyrctdp |
0:c735c66e37d3
|
957
|
// Step 1: Tell the PICC the command and block address
|
| Amyrctdp |
0:c735c66e37d3
|
958
|
cmdBuffer[0] = command;
|
| Amyrctdp |
0:c735c66e37d3
|
959
|
cmdBuffer[1] = blockAddr;
|
| Amyrctdp |
0:c735c66e37d3
|
960
|
|
| Amyrctdp |
0:c735c66e37d3
|
961
|
// Adds CRC_A and checks that the response is MF_ACK.
|
| Amyrctdp |
0:c735c66e37d3
|
962
|
result = PCD_MIFARE_Transceive(cmdBuffer, 2);
|
| Amyrctdp |
0:c735c66e37d3
|
963
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
964
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
965
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
966
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
967
|
|
| Amyrctdp |
0:c735c66e37d3
|
968
|
// Step 2: Transfer the data
|
| Amyrctdp |
0:c735c66e37d3
|
969
|
// Adds CRC_A and accept timeout as success.
|
| Amyrctdp |
0:c735c66e37d3
|
970
|
result = PCD_MIFARE_Transceive((uint8_t *) &data, 4, true);
|
| Amyrctdp |
0:c735c66e37d3
|
971
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
972
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
973
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
974
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
975
|
|
| Amyrctdp |
0:c735c66e37d3
|
976
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
977
|
} // End MIFARE_TwoStepHelper()
|
| Amyrctdp |
0:c735c66e37d3
|
978
|
|
| Amyrctdp |
0:c735c66e37d3
|
979
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
980
|
* MIFARE Transfer writes the value stored in the volatile memory into one MIFARE Classic block.
|
| Amyrctdp |
0:c735c66e37d3
|
981
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
982
|
uint8_t MFRC522::MIFARE_Transfer(uint8_t blockAddr)
|
| Amyrctdp |
0:c735c66e37d3
|
983
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
984
|
uint8_t cmdBuffer[2]; // We only need room for 2 bytes.
|
| Amyrctdp |
0:c735c66e37d3
|
985
|
|
| Amyrctdp |
0:c735c66e37d3
|
986
|
// Tell the PICC we want to transfer the result into block blockAddr.
|
| Amyrctdp |
0:c735c66e37d3
|
987
|
cmdBuffer[0] = PICC_CMD_MF_TRANSFER;
|
| Amyrctdp |
0:c735c66e37d3
|
988
|
cmdBuffer[1] = blockAddr;
|
| Amyrctdp |
0:c735c66e37d3
|
989
|
|
| Amyrctdp |
0:c735c66e37d3
|
990
|
// Adds CRC_A and checks that the response is MF_ACK.
|
| Amyrctdp |
0:c735c66e37d3
|
991
|
return PCD_MIFARE_Transceive(cmdBuffer, 2);
|
| Amyrctdp |
0:c735c66e37d3
|
992
|
} // End MIFARE_Transfer()
|
| Amyrctdp |
0:c735c66e37d3
|
993
|
|
| Amyrctdp |
0:c735c66e37d3
|
994
|
|
| Amyrctdp |
0:c735c66e37d3
|
995
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
996
|
// Support functions
|
| Amyrctdp |
0:c735c66e37d3
|
997
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
998
|
|
| Amyrctdp |
0:c735c66e37d3
|
999
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
1000
|
* Wrapper for MIFARE protocol communication.
|
| Amyrctdp |
0:c735c66e37d3
|
1001
|
* Adds CRC_A, executes the Transceive command and checks that the response is MF_ACK or a timeout.
|
| Amyrctdp |
0:c735c66e37d3
|
1002
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
1003
|
uint8_t MFRC522::PCD_MIFARE_Transceive(uint8_t *sendData, uint8_t sendLen, bool acceptTimeout)
|
| Amyrctdp |
0:c735c66e37d3
|
1004
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1005
|
uint8_t result;
|
| Amyrctdp |
0:c735c66e37d3
|
1006
|
uint8_t cmdBuffer[18]; // We need room for 16 bytes data and 2 bytes CRC_A.
|
| Amyrctdp |
0:c735c66e37d3
|
1007
|
|
| Amyrctdp |
0:c735c66e37d3
|
1008
|
// Sanity check
|
| Amyrctdp |
0:c735c66e37d3
|
1009
|
if (sendData == NULL || sendLen > 16)
|
| Amyrctdp |
0:c735c66e37d3
|
1010
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1011
|
return STATUS_INVALID;
|
| Amyrctdp |
0:c735c66e37d3
|
1012
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1013
|
|
| Amyrctdp |
0:c735c66e37d3
|
1014
|
// Copy sendData[] to cmdBuffer[] and add CRC_A
|
| Amyrctdp |
0:c735c66e37d3
|
1015
|
memcpy(cmdBuffer, sendData, sendLen);
|
| Amyrctdp |
0:c735c66e37d3
|
1016
|
result = PCD_CalculateCRC(cmdBuffer, sendLen, &cmdBuffer[sendLen]);
|
| Amyrctdp |
0:c735c66e37d3
|
1017
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
1018
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1019
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
1020
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1021
|
|
| Amyrctdp |
0:c735c66e37d3
|
1022
|
sendLen += 2;
|
| Amyrctdp |
0:c735c66e37d3
|
1023
|
|
| Amyrctdp |
0:c735c66e37d3
|
1024
|
// Transceive the data, store the reply in cmdBuffer[]
|
| Amyrctdp |
0:c735c66e37d3
|
1025
|
uint8_t waitIRq = 0x30; // RxIRq and IdleIRq
|
| Amyrctdp |
0:c735c66e37d3
|
1026
|
uint8_t cmdBufferSize = sizeof(cmdBuffer);
|
| Amyrctdp |
0:c735c66e37d3
|
1027
|
uint8_t validBits = 0;
|
| Amyrctdp |
0:c735c66e37d3
|
1028
|
result = PCD_CommunicateWithPICC(PCD_Transceive, waitIRq, cmdBuffer, sendLen, cmdBuffer, &cmdBufferSize, &validBits);
|
| Amyrctdp |
0:c735c66e37d3
|
1029
|
if (acceptTimeout && result == STATUS_TIMEOUT)
|
| Amyrctdp |
0:c735c66e37d3
|
1030
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1031
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
1032
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1033
|
|
| Amyrctdp |
0:c735c66e37d3
|
1034
|
if (result != STATUS_OK)
|
| Amyrctdp |
0:c735c66e37d3
|
1035
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1036
|
return result;
|
| Amyrctdp |
0:c735c66e37d3
|
1037
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1038
|
|
| Amyrctdp |
0:c735c66e37d3
|
1039
|
// The PICC must reply with a 4 bit ACK
|
| Amyrctdp |
0:c735c66e37d3
|
1040
|
if (cmdBufferSize != 1 || validBits != 4)
|
| Amyrctdp |
0:c735c66e37d3
|
1041
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1042
|
return STATUS_ERROR;
|
| Amyrctdp |
0:c735c66e37d3
|
1043
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1044
|
|
| Amyrctdp |
0:c735c66e37d3
|
1045
|
if (cmdBuffer[0] != MF_ACK)
|
| Amyrctdp |
0:c735c66e37d3
|
1046
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1047
|
return STATUS_MIFARE_NACK;
|
| Amyrctdp |
0:c735c66e37d3
|
1048
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1049
|
|
| Amyrctdp |
0:c735c66e37d3
|
1050
|
return STATUS_OK;
|
| Amyrctdp |
0:c735c66e37d3
|
1051
|
} // End PCD_MIFARE_Transceive()
|
| Amyrctdp |
0:c735c66e37d3
|
1052
|
|
| Amyrctdp |
0:c735c66e37d3
|
1053
|
|
| Amyrctdp |
0:c735c66e37d3
|
1054
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
1055
|
* Translates the SAK (Select Acknowledge) to a PICC type.
|
| Amyrctdp |
0:c735c66e37d3
|
1056
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
1057
|
uint8_t MFRC522::PICC_GetType(uint8_t sak)
|
| Amyrctdp |
0:c735c66e37d3
|
1058
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1059
|
uint8_t retType = PICC_TYPE_UNKNOWN;
|
| Amyrctdp |
0:c735c66e37d3
|
1060
|
|
| Amyrctdp |
0:c735c66e37d3
|
1061
|
if (sak & 0x04)
|
| Amyrctdp |
0:c735c66e37d3
|
1062
|
{ // UID not complete
|
| Amyrctdp |
0:c735c66e37d3
|
1063
|
retType = PICC_TYPE_NOT_COMPLETE;
|
| Amyrctdp |
0:c735c66e37d3
|
1064
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1065
|
else
|
| Amyrctdp |
0:c735c66e37d3
|
1066
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1067
|
switch (sak)
|
| Amyrctdp |
0:c735c66e37d3
|
1068
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1069
|
case 0x09: retType = PICC_TYPE_MIFARE_MINI; break;
|
| Amyrctdp |
0:c735c66e37d3
|
1070
|
case 0x08: retType = PICC_TYPE_MIFARE_1K; break;
|
| Amyrctdp |
0:c735c66e37d3
|
1071
|
case 0x18: retType = PICC_TYPE_MIFARE_4K; break;
|
| Amyrctdp |
0:c735c66e37d3
|
1072
|
case 0x00: retType = PICC_TYPE_MIFARE_UL; break;
|
| Amyrctdp |
0:c735c66e37d3
|
1073
|
case 0x10:
|
| Amyrctdp |
0:c735c66e37d3
|
1074
|
case 0x11: retType = PICC_TYPE_MIFARE_PLUS; break;
|
| Amyrctdp |
0:c735c66e37d3
|
1075
|
case 0x01: retType = PICC_TYPE_TNP3XXX; break;
|
| Amyrctdp |
0:c735c66e37d3
|
1076
|
default:
|
| Amyrctdp |
0:c735c66e37d3
|
1077
|
if (sak & 0x20)
|
| Amyrctdp |
0:c735c66e37d3
|
1078
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1079
|
retType = PICC_TYPE_ISO_14443_4;
|
| Amyrctdp |
0:c735c66e37d3
|
1080
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1081
|
else if (sak & 0x40)
|
| Amyrctdp |
0:c735c66e37d3
|
1082
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1083
|
retType = PICC_TYPE_ISO_18092;
|
| Amyrctdp |
0:c735c66e37d3
|
1084
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1085
|
break;
|
| Amyrctdp |
0:c735c66e37d3
|
1086
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1087
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1088
|
|
| Amyrctdp |
0:c735c66e37d3
|
1089
|
return (retType);
|
| Amyrctdp |
0:c735c66e37d3
|
1090
|
} // End PICC_GetType()
|
| Amyrctdp |
0:c735c66e37d3
|
1091
|
|
| Amyrctdp |
0:c735c66e37d3
|
1092
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
1093
|
* Returns a string pointer to the PICC type name.
|
| Amyrctdp |
0:c735c66e37d3
|
1094
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
1095
|
char* MFRC522::PICC_GetTypeName(uint8_t piccType)
|
| Amyrctdp |
0:c735c66e37d3
|
1096
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1097
|
if(piccType == PICC_TYPE_NOT_COMPLETE)
|
| Amyrctdp |
0:c735c66e37d3
|
1098
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1099
|
piccType = MFRC522_MaxPICCs - 1;
|
| Amyrctdp |
0:c735c66e37d3
|
1100
|
}
|
| Amyrctdp |
0:c735c66e37d3
|
1101
|
|
| Amyrctdp |
0:c735c66e37d3
|
1102
|
return((char *) _TypeNamePICC[piccType]);
|
| Amyrctdp |
0:c735c66e37d3
|
1103
|
} // End PICC_GetTypeName()
|
| Amyrctdp |
0:c735c66e37d3
|
1104
|
|
| Amyrctdp |
0:c735c66e37d3
|
1105
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
1106
|
* Returns a string pointer to a status code name.
|
| Amyrctdp |
0:c735c66e37d3
|
1107
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
1108
|
char* MFRC522::GetStatusCodeName(uint8_t code)
|
| Amyrctdp |
0:c735c66e37d3
|
1109
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1110
|
return((char *) _ErrorMessage[code]);
|
| Amyrctdp |
0:c735c66e37d3
|
1111
|
} // End GetStatusCodeName()
|
| Amyrctdp |
0:c735c66e37d3
|
1112
|
|
| Amyrctdp |
0:c735c66e37d3
|
1113
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
1114
|
* Calculates the bit pattern needed for the specified access bits. In the [C1 C2 C3] tupples C1 is MSB (=4) and C3 is LSB (=1).
|
| Amyrctdp |
0:c735c66e37d3
|
1115
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
1116
|
void MFRC522::MIFARE_SetAccessBits(uint8_t *accessBitBuffer,
|
| Amyrctdp |
0:c735c66e37d3
|
1117
|
uint8_t g0,
|
| Amyrctdp |
0:c735c66e37d3
|
1118
|
uint8_t g1,
|
| Amyrctdp |
0:c735c66e37d3
|
1119
|
uint8_t g2,
|
| Amyrctdp |
0:c735c66e37d3
|
1120
|
uint8_t g3)
|
| Amyrctdp |
0:c735c66e37d3
|
1121
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1122
|
uint8_t c1 = ((g3 & 4) << 1) | ((g2 & 4) << 0) | ((g1 & 4) >> 1) | ((g0 & 4) >> 2);
|
| Amyrctdp |
0:c735c66e37d3
|
1123
|
uint8_t c2 = ((g3 & 2) << 2) | ((g2 & 2) << 1) | ((g1 & 2) << 0) | ((g0 & 2) >> 1);
|
| Amyrctdp |
0:c735c66e37d3
|
1124
|
uint8_t c3 = ((g3 & 1) << 3) | ((g2 & 1) << 2) | ((g1 & 1) << 1) | ((g0 & 1) << 0);
|
| Amyrctdp |
0:c735c66e37d3
|
1125
|
|
| Amyrctdp |
0:c735c66e37d3
|
1126
|
accessBitBuffer[0] = (~c2 & 0xF) << 4 | (~c1 & 0xF);
|
| Amyrctdp |
0:c735c66e37d3
|
1127
|
accessBitBuffer[1] = c1 << 4 | (~c3 & 0xF);
|
| Amyrctdp |
0:c735c66e37d3
|
1128
|
accessBitBuffer[2] = c3 << 4 | c2;
|
| Amyrctdp |
0:c735c66e37d3
|
1129
|
} // End MIFARE_SetAccessBits()
|
| Amyrctdp |
0:c735c66e37d3
|
1130
|
|
| Amyrctdp |
0:c735c66e37d3
|
1131
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
1132
|
// Convenience functions - does not add extra functionality
|
| Amyrctdp |
0:c735c66e37d3
|
1133
|
/////////////////////////////////////////////////////////////////////////////////////
|
| Amyrctdp |
0:c735c66e37d3
|
1134
|
|
| Amyrctdp |
0:c735c66e37d3
|
1135
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
1136
|
* Returns true if a PICC responds to PICC_CMD_REQA.
|
| Amyrctdp |
0:c735c66e37d3
|
1137
|
* Only "new" cards in state IDLE are invited. Sleeping cards in state HALT are ignored.
|
| Amyrctdp |
0:c735c66e37d3
|
1138
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
1139
|
bool MFRC522::PICC_IsNewCardPresent(void)
|
| Amyrctdp |
0:c735c66e37d3
|
1140
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1141
|
uint8_t bufferATQA[2];
|
| Amyrctdp |
0:c735c66e37d3
|
1142
|
uint8_t bufferSize = sizeof(bufferATQA);
|
| Amyrctdp |
0:c735c66e37d3
|
1143
|
uint8_t result = PICC_RequestA(bufferATQA, &bufferSize);
|
| Amyrctdp |
0:c735c66e37d3
|
1144
|
return ((result == STATUS_OK) || (result == STATUS_COLLISION));
|
| Amyrctdp |
0:c735c66e37d3
|
1145
|
} // End PICC_IsNewCardPresent()
|
| Amyrctdp |
0:c735c66e37d3
|
1146
|
|
| Amyrctdp |
0:c735c66e37d3
|
1147
|
/*
|
| Amyrctdp |
0:c735c66e37d3
|
1148
|
* Simple wrapper around PICC_Select.
|
| Amyrctdp |
0:c735c66e37d3
|
1149
|
*/
|
| Amyrctdp |
0:c735c66e37d3
|
1150
|
bool MFRC522::PICC_ReadCardSerial(void)
|
| Amyrctdp |
0:c735c66e37d3
|
1151
|
{
|
| Amyrctdp |
0:c735c66e37d3
|
1152
|
uint8_t result = PICC_Select(&uid);
|
| Amyrctdp |
0:c735c66e37d3
|
1153
|
return (result == STATUS_OK);
|
| Amyrctdp |
0:c735c66e37d3
|
1154
|
} // End PICC_ReadCardSerial()
|