PN532 NFC library for Seeed Studio's NFC Shield

Fork of PN532 by Yihui Xiong

Committer:
icefeet
Date:
Tue Oct 07 15:09:46 2014 +0000
Revision:
5:51f820fbd18a
Parent:
4:0774b8298eb8
Child:
8:7ffdaea03ff9
Added support for Ultralight Write

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yihui 1:b8cab5222fd0 1 /**************************************************************************/
yihui 1:b8cab5222fd0 2 /*!
yihui 1:b8cab5222fd0 3 @file PN532.cpp
yihui 3:4189a10038e6 4 @author Adafruit Industries & Seeed Studio
yihui 3:4189a10038e6 5 @license BSD
yihui 1:b8cab5222fd0 6 */
yihui 1:b8cab5222fd0 7 /**************************************************************************/
yihui 0:9c6b9280c0e1 8
yihui 3:4189a10038e6 9 #include "PN532.h"
yihui 3:4189a10038e6 10 #include "PN532_debug.h"
yihui 0:9c6b9280c0e1 11 #include <string.h>
yihui 0:9c6b9280c0e1 12
yihui 4:0774b8298eb8 13 #ifndef ARDUINO
yihui 4:0774b8298eb8 14 #include <stdio.h>
yihui 4:0774b8298eb8 15 #endif
yihui 4:0774b8298eb8 16
yihui 0:9c6b9280c0e1 17 #define HAL(func) (_interface->func)
yihui 0:9c6b9280c0e1 18
yihui 0:9c6b9280c0e1 19 PN532::PN532(PN532Interface &interface)
yihui 0:9c6b9280c0e1 20 {
yihui 1:b8cab5222fd0 21 _interface = &interface;
yihui 0:9c6b9280c0e1 22 }
yihui 0:9c6b9280c0e1 23
yihui 0:9c6b9280c0e1 24 /**************************************************************************/
yihui 1:b8cab5222fd0 25 /*!
yihui 0:9c6b9280c0e1 26 @brief Setups the HW
yihui 0:9c6b9280c0e1 27 */
yihui 0:9c6b9280c0e1 28 /**************************************************************************/
yihui 0:9c6b9280c0e1 29 void PN532::begin()
yihui 0:9c6b9280c0e1 30 {
yihui 0:9c6b9280c0e1 31 HAL(begin)();
yihui 0:9c6b9280c0e1 32 HAL(wakeup)();
yihui 0:9c6b9280c0e1 33 }
yihui 1:b8cab5222fd0 34
yihui 0:9c6b9280c0e1 35 /**************************************************************************/
yihui 1:b8cab5222fd0 36 /*!
yihui 0:9c6b9280c0e1 37 @brief Prints a hexadecimal value in plain characters
yihui 0:9c6b9280c0e1 38
yihui 0:9c6b9280c0e1 39 @param data Pointer to the uint8_t data
yihui 0:9c6b9280c0e1 40 @param numBytes Data length in bytes
yihui 0:9c6b9280c0e1 41 */
yihui 0:9c6b9280c0e1 42 /**************************************************************************/
yihui 1:b8cab5222fd0 43 void PN532::PrintHex(const uint8_t *data, const uint32_t numBytes)
yihui 0:9c6b9280c0e1 44 {
yihui 3:4189a10038e6 45 #ifdef ARDUINO
yihui 1:b8cab5222fd0 46 for (uint8_t i = 0; i < numBytes; i++) {
yihui 3:4189a10038e6 47 if (data[i] < 0x10) {
yihui 3:4189a10038e6 48 Serial.print(" 0");
yihui 3:4189a10038e6 49 } else {
yihui 3:4189a10038e6 50 Serial.print(' ');
yihui 3:4189a10038e6 51 }
yihui 3:4189a10038e6 52 Serial.print(data[i], HEX);
yihui 1:b8cab5222fd0 53 }
yihui 3:4189a10038e6 54 Serial.println("");
yihui 3:4189a10038e6 55 #else
yihui 3:4189a10038e6 56 for (uint8_t i = 0; i < numBytes; i++) {
yihui 3:4189a10038e6 57 printf(" %2X", data[i]);
yihui 3:4189a10038e6 58 }
yihui 3:4189a10038e6 59 printf("\n");
yihui 3:4189a10038e6 60 #endif
yihui 0:9c6b9280c0e1 61 }
yihui 0:9c6b9280c0e1 62
yihui 0:9c6b9280c0e1 63 /**************************************************************************/
yihui 1:b8cab5222fd0 64 /*!
yihui 0:9c6b9280c0e1 65 @brief Prints a hexadecimal value in plain characters, along with
yihui 0:9c6b9280c0e1 66 the char equivalents in the following format
yihui 0:9c6b9280c0e1 67
yihui 0:9c6b9280c0e1 68 00 00 00 00 00 00 ......
yihui 0:9c6b9280c0e1 69
yihui 1:b8cab5222fd0 70 @param data Pointer to the data
yihui 0:9c6b9280c0e1 71 @param numBytes Data length in bytes
yihui 0:9c6b9280c0e1 72 */
yihui 0:9c6b9280c0e1 73 /**************************************************************************/
yihui 1:b8cab5222fd0 74 void PN532::PrintHexChar(const uint8_t *data, const uint32_t numBytes)
yihui 0:9c6b9280c0e1 75 {
yihui 3:4189a10038e6 76 #ifdef ARDUINO
yihui 1:b8cab5222fd0 77 for (uint8_t i = 0; i < numBytes; i++) {
yihui 3:4189a10038e6 78 if (data[i] < 0x10) {
yihui 3:4189a10038e6 79 Serial.print(" 0");
yihui 3:4189a10038e6 80 } else {
yihui 3:4189a10038e6 81 Serial.print(' ');
yihui 3:4189a10038e6 82 }
yihui 3:4189a10038e6 83 Serial.print(data[i], HEX);
yihui 3:4189a10038e6 84 }
yihui 3:4189a10038e6 85 Serial.print(" ");
yihui 3:4189a10038e6 86 for (uint8_t i = 0; i < numBytes; i++) {
yihui 3:4189a10038e6 87 char c = data[i];
yihui 3:4189a10038e6 88 if (c <= 0x1f || c > 0x7f) {
yihui 3:4189a10038e6 89 Serial.print('.');
yihui 3:4189a10038e6 90 } else {
yihui 3:4189a10038e6 91 Serial.print(c);
yihui 3:4189a10038e6 92 }
yihui 1:b8cab5222fd0 93 }
yihui 3:4189a10038e6 94 Serial.println("");
yihui 3:4189a10038e6 95 #else
yihui 3:4189a10038e6 96 for (uint8_t i = 0; i < numBytes; i++) {
yihui 3:4189a10038e6 97 printf(" %2X", data[i]);
yihui 3:4189a10038e6 98 }
yihui 3:4189a10038e6 99 printf(" ");
yihui 3:4189a10038e6 100 for (uint8_t i = 0; i < numBytes; i++) {
yihui 3:4189a10038e6 101 char c = data[i];
yihui 3:4189a10038e6 102 if (c <= 0x1f || c > 0x7f) {
yihui 3:4189a10038e6 103 printf(".");
yihui 3:4189a10038e6 104 } else {
yihui 3:4189a10038e6 105 printf("%c", c);
yihui 3:4189a10038e6 106 }
yihui 3:4189a10038e6 107 printf("\n");
yihui 3:4189a10038e6 108 }
yihui 3:4189a10038e6 109 #endif
yihui 0:9c6b9280c0e1 110 }
yihui 1:b8cab5222fd0 111
yihui 0:9c6b9280c0e1 112 /**************************************************************************/
yihui 1:b8cab5222fd0 113 /*!
yihui 0:9c6b9280c0e1 114 @brief Checks the firmware version of the PN5xx chip
yihui 0:9c6b9280c0e1 115
yihui 0:9c6b9280c0e1 116 @returns The chip's firmware version and ID
yihui 0:9c6b9280c0e1 117 */
yihui 0:9c6b9280c0e1 118 /**************************************************************************/
yihui 1:b8cab5222fd0 119 uint32_t PN532::getFirmwareVersion(void)
yihui 1:b8cab5222fd0 120 {
yihui 1:b8cab5222fd0 121 uint32_t response;
yihui 0:9c6b9280c0e1 122
yihui 1:b8cab5222fd0 123 pn532_packetbuffer[0] = PN532_COMMAND_GETFIRMWAREVERSION;
yihui 1:b8cab5222fd0 124
yihui 1:b8cab5222fd0 125 if (HAL(writeCommand)(pn532_packetbuffer, 1)) {
yihui 1:b8cab5222fd0 126 return 0;
yihui 1:b8cab5222fd0 127 }
yihui 0:9c6b9280c0e1 128
yihui 1:b8cab5222fd0 129 // read data packet
yihui 1:b8cab5222fd0 130 int16_t status = HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer));
yihui 1:b8cab5222fd0 131 if (0 > status) {
yihui 1:b8cab5222fd0 132 return 0;
yihui 1:b8cab5222fd0 133 }
yihui 0:9c6b9280c0e1 134
yihui 1:b8cab5222fd0 135 response = pn532_packetbuffer[0];
yihui 1:b8cab5222fd0 136 response <<= 8;
yihui 1:b8cab5222fd0 137 response |= pn532_packetbuffer[1];
yihui 1:b8cab5222fd0 138 response <<= 8;
yihui 1:b8cab5222fd0 139 response |= pn532_packetbuffer[2];
yihui 1:b8cab5222fd0 140 response <<= 8;
yihui 1:b8cab5222fd0 141 response |= pn532_packetbuffer[3];
yihui 1:b8cab5222fd0 142
yihui 1:b8cab5222fd0 143 return response;
yihui 0:9c6b9280c0e1 144 }
yihui 0:9c6b9280c0e1 145
yihui 0:9c6b9280c0e1 146
yihui 0:9c6b9280c0e1 147 /**************************************************************************/
yihui 1:b8cab5222fd0 148 /*!
yihui 0:9c6b9280c0e1 149 Writes an 8-bit value that sets the state of the PN532's GPIO pins
yihui 1:b8cab5222fd0 150
yihui 0:9c6b9280c0e1 151 @warning This function is provided exclusively for board testing and
yihui 0:9c6b9280c0e1 152 is dangerous since it will throw an error if any pin other
yihui 0:9c6b9280c0e1 153 than the ones marked "Can be used as GPIO" are modified! All
yihui 0:9c6b9280c0e1 154 pins that can not be used as GPIO should ALWAYS be left high
yihui 0:9c6b9280c0e1 155 (value = 1) or the system will become unstable and a HW reset
yihui 0:9c6b9280c0e1 156 will be required to recover the PN532.
yihui 1:b8cab5222fd0 157
yihui 0:9c6b9280c0e1 158 pinState[0] = P30 Can be used as GPIO
yihui 0:9c6b9280c0e1 159 pinState[1] = P31 Can be used as GPIO
yihui 0:9c6b9280c0e1 160 pinState[2] = P32 *** RESERVED (Must be 1!) ***
yihui 0:9c6b9280c0e1 161 pinState[3] = P33 Can be used as GPIO
yihui 0:9c6b9280c0e1 162 pinState[4] = P34 *** RESERVED (Must be 1!) ***
yihui 0:9c6b9280c0e1 163 pinState[5] = P35 Can be used as GPIO
yihui 1:b8cab5222fd0 164
yihui 0:9c6b9280c0e1 165 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 166 */
yihui 0:9c6b9280c0e1 167 /**************************************************************************/
yihui 1:b8cab5222fd0 168 bool PN532::writeGPIO(uint8_t pinstate)
yihui 1:b8cab5222fd0 169 {
yihui 1:b8cab5222fd0 170 // Make sure pinstate does not try to toggle P32 or P34
yihui 1:b8cab5222fd0 171 pinstate |= (1 << PN532_GPIO_P32) | (1 << PN532_GPIO_P34);
yihui 1:b8cab5222fd0 172
yihui 1:b8cab5222fd0 173 // Fill command buffer
yihui 1:b8cab5222fd0 174 pn532_packetbuffer[0] = PN532_COMMAND_WRITEGPIO;
yihui 1:b8cab5222fd0 175 pn532_packetbuffer[1] = PN532_GPIO_VALIDATIONBIT | pinstate; // P3 Pins
yihui 1:b8cab5222fd0 176 pn532_packetbuffer[2] = 0x00; // P7 GPIO Pins (not used ... taken by I2C)
yihui 0:9c6b9280c0e1 177
yihui 1:b8cab5222fd0 178 DMSG("Writing P3 GPIO: ");
yihui 1:b8cab5222fd0 179 DMSG_HEX(pn532_packetbuffer[1]);
yihui 1:b8cab5222fd0 180 DMSG("\n");
yihui 0:9c6b9280c0e1 181
yihui 1:b8cab5222fd0 182 // Send the WRITEGPIO command (0x0E)
yihui 1:b8cab5222fd0 183 if (HAL(writeCommand)(pn532_packetbuffer, 3))
yihui 1:b8cab5222fd0 184 return 0;
yihui 0:9c6b9280c0e1 185
yihui 1:b8cab5222fd0 186 return (0 < HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer)));
yihui 0:9c6b9280c0e1 187 }
yihui 0:9c6b9280c0e1 188
yihui 0:9c6b9280c0e1 189 /**************************************************************************/
yihui 1:b8cab5222fd0 190 /*!
yihui 0:9c6b9280c0e1 191 Reads the state of the PN532's GPIO pins
yihui 1:b8cab5222fd0 192
yihui 0:9c6b9280c0e1 193 @returns An 8-bit value containing the pin state where:
yihui 1:b8cab5222fd0 194
yihui 1:b8cab5222fd0 195 pinState[0] = P30
yihui 1:b8cab5222fd0 196 pinState[1] = P31
yihui 1:b8cab5222fd0 197 pinState[2] = P32
yihui 1:b8cab5222fd0 198 pinState[3] = P33
yihui 1:b8cab5222fd0 199 pinState[4] = P34
yihui 1:b8cab5222fd0 200 pinState[5] = P35
yihui 0:9c6b9280c0e1 201 */
yihui 0:9c6b9280c0e1 202 /**************************************************************************/
yihui 1:b8cab5222fd0 203 uint8_t PN532::readGPIO(void)
yihui 1:b8cab5222fd0 204 {
yihui 1:b8cab5222fd0 205 pn532_packetbuffer[0] = PN532_COMMAND_READGPIO;
yihui 0:9c6b9280c0e1 206
yihui 1:b8cab5222fd0 207 // Send the READGPIO command (0x0C)
yihui 1:b8cab5222fd0 208 if (HAL(writeCommand)(pn532_packetbuffer, 1))
yihui 1:b8cab5222fd0 209 return 0x0;
yihui 1:b8cab5222fd0 210
yihui 1:b8cab5222fd0 211 HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer));
yihui 1:b8cab5222fd0 212
yihui 1:b8cab5222fd0 213 /* READGPIO response without prefix and suffix should be in the following format:
yihui 0:9c6b9280c0e1 214
yihui 1:b8cab5222fd0 215 byte Description
yihui 1:b8cab5222fd0 216 ------------- ------------------------------------------
yihui 1:b8cab5222fd0 217 b0 P3 GPIO Pins
yihui 1:b8cab5222fd0 218 b1 P7 GPIO Pins (not used ... taken by I2C)
yihui 1:b8cab5222fd0 219 b2 Interface Mode Pins (not used ... bus select pins)
yihui 1:b8cab5222fd0 220 */
yihui 0:9c6b9280c0e1 221
yihui 0:9c6b9280c0e1 222
yihui 1:b8cab5222fd0 223 DMSG("P3 GPIO: "); DMSG_HEX(pn532_packetbuffer[7]);
yihui 1:b8cab5222fd0 224 DMSG("P7 GPIO: "); DMSG_HEX(pn532_packetbuffer[8]);
yihui 1:b8cab5222fd0 225 DMSG("I0I1 GPIO: "); DMSG_HEX(pn532_packetbuffer[9]);
yihui 1:b8cab5222fd0 226 DMSG("\n");
yihui 1:b8cab5222fd0 227
yihui 1:b8cab5222fd0 228 return pn532_packetbuffer[0];
yihui 0:9c6b9280c0e1 229 }
yihui 0:9c6b9280c0e1 230
yihui 0:9c6b9280c0e1 231 /**************************************************************************/
yihui 1:b8cab5222fd0 232 /*!
yihui 0:9c6b9280c0e1 233 @brief Configures the SAM (Secure Access Module)
yihui 0:9c6b9280c0e1 234 */
yihui 0:9c6b9280c0e1 235 /**************************************************************************/
yihui 1:b8cab5222fd0 236 bool PN532::SAMConfig(void)
yihui 1:b8cab5222fd0 237 {
yihui 1:b8cab5222fd0 238 pn532_packetbuffer[0] = PN532_COMMAND_SAMCONFIGURATION;
yihui 1:b8cab5222fd0 239 pn532_packetbuffer[1] = 0x01; // normal mode;
yihui 1:b8cab5222fd0 240 pn532_packetbuffer[2] = 0x14; // timeout 50ms * 20 = 1 second
yihui 1:b8cab5222fd0 241 pn532_packetbuffer[3] = 0x01; // use IRQ pin!
yihui 0:9c6b9280c0e1 242
yihui 3:4189a10038e6 243 DMSG("SAMConfig\n");
yihui 3:4189a10038e6 244
yihui 1:b8cab5222fd0 245 if (HAL(writeCommand)(pn532_packetbuffer, 4))
yihui 1:b8cab5222fd0 246 return false;
yihui 1:b8cab5222fd0 247
yihui 1:b8cab5222fd0 248 return (0 < HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer)));
yihui 0:9c6b9280c0e1 249 }
yihui 0:9c6b9280c0e1 250
yihui 0:9c6b9280c0e1 251 /**************************************************************************/
yihui 1:b8cab5222fd0 252 /*!
yihui 0:9c6b9280c0e1 253 Sets the MxRtyPassiveActivation uint8_t of the RFConfiguration register
yihui 1:b8cab5222fd0 254
yihui 0:9c6b9280c0e1 255 @param maxRetries 0xFF to wait forever, 0x00..0xFE to timeout
yihui 0:9c6b9280c0e1 256 after mxRetries
yihui 1:b8cab5222fd0 257
yihui 0:9c6b9280c0e1 258 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 259 */
yihui 0:9c6b9280c0e1 260 /**************************************************************************/
yihui 1:b8cab5222fd0 261 bool PN532::setPassiveActivationRetries(uint8_t maxRetries)
yihui 1:b8cab5222fd0 262 {
yihui 1:b8cab5222fd0 263 pn532_packetbuffer[0] = PN532_COMMAND_RFCONFIGURATION;
yihui 1:b8cab5222fd0 264 pn532_packetbuffer[1] = 5; // Config item 5 (MaxRetries)
yihui 1:b8cab5222fd0 265 pn532_packetbuffer[2] = 0xFF; // MxRtyATR (default = 0xFF)
yihui 1:b8cab5222fd0 266 pn532_packetbuffer[3] = 0x01; // MxRtyPSL (default = 0x01)
yihui 1:b8cab5222fd0 267 pn532_packetbuffer[4] = maxRetries;
yihui 1:b8cab5222fd0 268
yihui 1:b8cab5222fd0 269 if (HAL(writeCommand)(pn532_packetbuffer, 5))
yihui 1:b8cab5222fd0 270 return 0x0; // no ACK
yihui 1:b8cab5222fd0 271
yihui 3:4189a10038e6 272 return (0 < HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer)));
yihui 0:9c6b9280c0e1 273 }
yihui 0:9c6b9280c0e1 274
yihui 0:9c6b9280c0e1 275 /***** ISO14443A Commands ******/
yihui 0:9c6b9280c0e1 276
yihui 0:9c6b9280c0e1 277 /**************************************************************************/
yihui 1:b8cab5222fd0 278 /*!
yihui 0:9c6b9280c0e1 279 Waits for an ISO14443A target to enter the field
yihui 1:b8cab5222fd0 280
yihui 0:9c6b9280c0e1 281 @param cardBaudRate Baud rate of the card
yihui 0:9c6b9280c0e1 282 @param uid Pointer to the array that will be populated
yihui 0:9c6b9280c0e1 283 with the card's UID (up to 7 bytes)
yihui 0:9c6b9280c0e1 284 @param uidLength Pointer to the variable that will hold the
yihui 0:9c6b9280c0e1 285 length of the card's UID.
yihui 1:b8cab5222fd0 286
yihui 0:9c6b9280c0e1 287 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 288 */
yihui 0:9c6b9280c0e1 289 /**************************************************************************/
icefeet 5:51f820fbd18a 290 bool PN532::readPassiveTargetID(uint8_t cardbaudrate, uint8_t *uid, uint8_t *uidLength, uint16_t *atqa, uint8_t *sak, uint16_t timeout)
yihui 1:b8cab5222fd0 291 {
yihui 1:b8cab5222fd0 292 pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET;
yihui 1:b8cab5222fd0 293 pn532_packetbuffer[1] = 1; // max 1 cards at once (we can set this to 2 later)
yihui 1:b8cab5222fd0 294 pn532_packetbuffer[2] = cardbaudrate;
yihui 1:b8cab5222fd0 295
yihui 1:b8cab5222fd0 296 if (HAL(writeCommand)(pn532_packetbuffer, 3)) {
yihui 1:b8cab5222fd0 297 return 0x0; // command failed
yihui 1:b8cab5222fd0 298 }
yihui 1:b8cab5222fd0 299
yihui 1:b8cab5222fd0 300 // read data packet
yihui 2:f618fb2169c4 301 if (HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer), timeout) < 0) {
yihui 2:f618fb2169c4 302 return 0x0;
yihui 2:f618fb2169c4 303 }
yihui 1:b8cab5222fd0 304
yihui 1:b8cab5222fd0 305 // check some basic stuff
yihui 1:b8cab5222fd0 306 /* ISO14443A card response should be in the following format:
yihui 0:9c6b9280c0e1 307
yihui 1:b8cab5222fd0 308 byte Description
yihui 1:b8cab5222fd0 309 ------------- ------------------------------------------
yihui 1:b8cab5222fd0 310 b0 Tags Found
yihui 1:b8cab5222fd0 311 b1 Tag Number (only one used in this example)
yihui 1:b8cab5222fd0 312 b2..3 SENS_RES
yihui 1:b8cab5222fd0 313 b4 SEL_RES
yihui 1:b8cab5222fd0 314 b5 NFCID Length
yihui 1:b8cab5222fd0 315 b6..NFCIDLen NFCID
yihui 1:b8cab5222fd0 316 */
yihui 1:b8cab5222fd0 317
yihui 1:b8cab5222fd0 318 if (pn532_packetbuffer[0] != 1)
yihui 1:b8cab5222fd0 319 return 0;
yihui 0:9c6b9280c0e1 320
yihui 1:b8cab5222fd0 321 uint16_t sens_res = pn532_packetbuffer[2];
yihui 1:b8cab5222fd0 322 sens_res <<= 8;
yihui 1:b8cab5222fd0 323 sens_res |= pn532_packetbuffer[3];
icefeet 5:51f820fbd18a 324 *atqa = sens_res;
icefeet 5:51f820fbd18a 325 *sak = pn532_packetbuffer[4];
yihui 1:b8cab5222fd0 326 DMSG("ATQA: 0x"); DMSG_HEX(sens_res);
yihui 1:b8cab5222fd0 327 DMSG("SAK: 0x"); DMSG_HEX(pn532_packetbuffer[4]);
yihui 1:b8cab5222fd0 328 DMSG("\n");
yihui 0:9c6b9280c0e1 329
yihui 1:b8cab5222fd0 330 /* Card appears to be Mifare Classic */
yihui 1:b8cab5222fd0 331 *uidLength = pn532_packetbuffer[5];
yihui 0:9c6b9280c0e1 332
yihui 1:b8cab5222fd0 333 for (uint8_t i = 0; i < pn532_packetbuffer[5]; i++) {
yihui 1:b8cab5222fd0 334 uid[i] = pn532_packetbuffer[6 + i];
yihui 1:b8cab5222fd0 335 }
yihui 1:b8cab5222fd0 336
yihui 1:b8cab5222fd0 337 return 1;
yihui 0:9c6b9280c0e1 338 }
yihui 0:9c6b9280c0e1 339
yihui 0:9c6b9280c0e1 340
yihui 0:9c6b9280c0e1 341 /***** Mifare Classic Functions ******/
yihui 0:9c6b9280c0e1 342
yihui 0:9c6b9280c0e1 343 /**************************************************************************/
yihui 1:b8cab5222fd0 344 /*!
yihui 0:9c6b9280c0e1 345 Indicates whether the specified block number is the first block
yihui 0:9c6b9280c0e1 346 in the sector (block 0 relative to the current sector)
yihui 0:9c6b9280c0e1 347 */
yihui 0:9c6b9280c0e1 348 /**************************************************************************/
yihui 0:9c6b9280c0e1 349 bool PN532::mifareclassic_IsFirstBlock (uint32_t uiBlock)
yihui 0:9c6b9280c0e1 350 {
yihui 1:b8cab5222fd0 351 // Test if we are in the small or big sectors
yihui 1:b8cab5222fd0 352 if (uiBlock < 128)
yihui 1:b8cab5222fd0 353 return ((uiBlock) % 4 == 0);
yihui 1:b8cab5222fd0 354 else
yihui 1:b8cab5222fd0 355 return ((uiBlock) % 16 == 0);
yihui 0:9c6b9280c0e1 356 }
yihui 0:9c6b9280c0e1 357
yihui 0:9c6b9280c0e1 358 /**************************************************************************/
yihui 1:b8cab5222fd0 359 /*!
yihui 0:9c6b9280c0e1 360 Indicates whether the specified block number is the sector trailer
yihui 0:9c6b9280c0e1 361 */
yihui 0:9c6b9280c0e1 362 /**************************************************************************/
yihui 0:9c6b9280c0e1 363 bool PN532::mifareclassic_IsTrailerBlock (uint32_t uiBlock)
yihui 0:9c6b9280c0e1 364 {
yihui 1:b8cab5222fd0 365 // Test if we are in the small or big sectors
yihui 1:b8cab5222fd0 366 if (uiBlock < 128)
yihui 1:b8cab5222fd0 367 return ((uiBlock + 1) % 4 == 0);
yihui 1:b8cab5222fd0 368 else
yihui 1:b8cab5222fd0 369 return ((uiBlock + 1) % 16 == 0);
yihui 0:9c6b9280c0e1 370 }
yihui 0:9c6b9280c0e1 371
yihui 0:9c6b9280c0e1 372 /**************************************************************************/
yihui 1:b8cab5222fd0 373 /*!
yihui 0:9c6b9280c0e1 374 Tries to authenticate a block of memory on a MIFARE card using the
yihui 0:9c6b9280c0e1 375 INDATAEXCHANGE command. See section 7.3.8 of the PN532 User Manual
yihui 0:9c6b9280c0e1 376 for more information on sending MIFARE and other commands.
yihui 0:9c6b9280c0e1 377
yihui 1:b8cab5222fd0 378 @param uid Pointer to a byte array containing the card UID
yihui 0:9c6b9280c0e1 379 @param uidLen The length (in bytes) of the card's UID (Should
yihui 0:9c6b9280c0e1 380 be 4 for MIFARE Classic)
yihui 0:9c6b9280c0e1 381 @param blockNumber The block number to authenticate. (0..63 for
yihui 0:9c6b9280c0e1 382 1KB cards, and 0..255 for 4KB cards).
yihui 0:9c6b9280c0e1 383 @param keyNumber Which key type to use during authentication
yihui 0:9c6b9280c0e1 384 (0 = MIFARE_CMD_AUTH_A, 1 = MIFARE_CMD_AUTH_B)
yihui 1:b8cab5222fd0 385 @param keyData Pointer to a byte array containing the 6 bytes
yihui 0:9c6b9280c0e1 386 key value
yihui 1:b8cab5222fd0 387
yihui 0:9c6b9280c0e1 388 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 389 */
yihui 0:9c6b9280c0e1 390 /**************************************************************************/
yihui 1:b8cab5222fd0 391 uint8_t PN532::mifareclassic_AuthenticateBlock (uint8_t *uid, uint8_t uidLen, uint32_t blockNumber, uint8_t keyNumber, uint8_t *keyData)
yihui 0:9c6b9280c0e1 392 {
yihui 1:b8cab5222fd0 393 uint8_t i;
yihui 1:b8cab5222fd0 394
yihui 1:b8cab5222fd0 395 // Hang on to the key and uid data
yihui 1:b8cab5222fd0 396 memcpy (_key, keyData, 6);
yihui 1:b8cab5222fd0 397 memcpy (_uid, uid, uidLen);
yihui 1:b8cab5222fd0 398 _uidLen = uidLen;
yihui 0:9c6b9280c0e1 399
yihui 1:b8cab5222fd0 400 // Prepare the authentication command //
yihui 1:b8cab5222fd0 401 pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; /* Data Exchange Header */
yihui 1:b8cab5222fd0 402 pn532_packetbuffer[1] = 1; /* Max card numbers */
yihui 1:b8cab5222fd0 403 pn532_packetbuffer[2] = (keyNumber) ? MIFARE_CMD_AUTH_B : MIFARE_CMD_AUTH_A;
yihui 1:b8cab5222fd0 404 pn532_packetbuffer[3] = blockNumber; /* Block Number (1K = 0..63, 4K = 0..255 */
yihui 1:b8cab5222fd0 405 memcpy (pn532_packetbuffer + 4, _key, 6);
yihui 1:b8cab5222fd0 406 for (i = 0; i < _uidLen; i++) {
yihui 1:b8cab5222fd0 407 pn532_packetbuffer[10 + i] = _uid[i]; /* 4 bytes card ID */
yihui 1:b8cab5222fd0 408 }
yihui 1:b8cab5222fd0 409
yihui 1:b8cab5222fd0 410 if (HAL(writeCommand)(pn532_packetbuffer, 10 + _uidLen))
yihui 1:b8cab5222fd0 411 return 0;
yihui 0:9c6b9280c0e1 412
yihui 1:b8cab5222fd0 413 // Read the response packet
yihui 1:b8cab5222fd0 414 HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer));
yihui 0:9c6b9280c0e1 415
yihui 1:b8cab5222fd0 416 // Check if the response is valid and we are authenticated???
yihui 1:b8cab5222fd0 417 // for an auth success it should be bytes 5-7: 0xD5 0x41 0x00
yihui 1:b8cab5222fd0 418 // Mifare auth error is technically byte 7: 0x14 but anything other and 0x00 is not good
yihui 1:b8cab5222fd0 419 if (pn532_packetbuffer[0] != 0x00) {
yihui 1:b8cab5222fd0 420 DMSG("Authentification failed\n");
yihui 1:b8cab5222fd0 421 return 0;
yihui 1:b8cab5222fd0 422 }
yihui 1:b8cab5222fd0 423
yihui 1:b8cab5222fd0 424 return 1;
yihui 0:9c6b9280c0e1 425 }
yihui 0:9c6b9280c0e1 426
yihui 0:9c6b9280c0e1 427 /**************************************************************************/
yihui 1:b8cab5222fd0 428 /*!
yihui 1:b8cab5222fd0 429 Tries to read an entire 16-bytes data block at the specified block
yihui 0:9c6b9280c0e1 430 address.
yihui 0:9c6b9280c0e1 431
yihui 0:9c6b9280c0e1 432 @param blockNumber The block number to authenticate. (0..63 for
yihui 0:9c6b9280c0e1 433 1KB cards, and 0..255 for 4KB cards).
yihui 1:b8cab5222fd0 434 @param data Pointer to the byte array that will hold the
yihui 0:9c6b9280c0e1 435 retrieved data (if any)
yihui 1:b8cab5222fd0 436
yihui 0:9c6b9280c0e1 437 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 438 */
yihui 0:9c6b9280c0e1 439 /**************************************************************************/
yihui 1:b8cab5222fd0 440 uint8_t PN532::mifareclassic_ReadDataBlock (uint8_t blockNumber, uint8_t *data)
yihui 0:9c6b9280c0e1 441 {
yihui 1:b8cab5222fd0 442 DMSG("Trying to read 16 bytes from block ");
yihui 1:b8cab5222fd0 443 DMSG_INT(blockNumber);
yihui 1:b8cab5222fd0 444
yihui 1:b8cab5222fd0 445 /* Prepare the command */
yihui 1:b8cab5222fd0 446 pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE;
yihui 1:b8cab5222fd0 447 pn532_packetbuffer[1] = 1; /* Card number */
yihui 1:b8cab5222fd0 448 pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */
yihui 1:b8cab5222fd0 449 pn532_packetbuffer[3] = blockNumber; /* Block Number (0..63 for 1K, 0..255 for 4K) */
yihui 0:9c6b9280c0e1 450
yihui 1:b8cab5222fd0 451 /* Send the command */
yihui 1:b8cab5222fd0 452 if (HAL(writeCommand)(pn532_packetbuffer, 4)) {
yihui 1:b8cab5222fd0 453 return 0;
yihui 1:b8cab5222fd0 454 }
yihui 0:9c6b9280c0e1 455
yihui 1:b8cab5222fd0 456 /* Read the response packet */
yihui 1:b8cab5222fd0 457 HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer));
yihui 0:9c6b9280c0e1 458
yihui 1:b8cab5222fd0 459 /* If byte 8 isn't 0x00 we probably have an error */
yihui 1:b8cab5222fd0 460 if (pn532_packetbuffer[0] != 0x00) {
yihui 1:b8cab5222fd0 461 return 0;
yihui 1:b8cab5222fd0 462 }
yihui 0:9c6b9280c0e1 463
yihui 1:b8cab5222fd0 464 /* Copy the 16 data bytes to the output buffer */
yihui 1:b8cab5222fd0 465 /* Block content starts at byte 9 of a valid response */
yihui 1:b8cab5222fd0 466 memcpy (data, pn532_packetbuffer + 1, 16);
yihui 1:b8cab5222fd0 467
yihui 1:b8cab5222fd0 468 return 1;
yihui 0:9c6b9280c0e1 469 }
yihui 0:9c6b9280c0e1 470
yihui 0:9c6b9280c0e1 471 /**************************************************************************/
yihui 1:b8cab5222fd0 472 /*!
yihui 1:b8cab5222fd0 473 Tries to write an entire 16-bytes data block at the specified block
yihui 0:9c6b9280c0e1 474 address.
yihui 0:9c6b9280c0e1 475
yihui 0:9c6b9280c0e1 476 @param blockNumber The block number to authenticate. (0..63 for
yihui 0:9c6b9280c0e1 477 1KB cards, and 0..255 for 4KB cards).
yihui 1:b8cab5222fd0 478 @param data The byte array that contains the data to write.
yihui 1:b8cab5222fd0 479
yihui 0:9c6b9280c0e1 480 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 481 */
yihui 0:9c6b9280c0e1 482 /**************************************************************************/
yihui 1:b8cab5222fd0 483 uint8_t PN532::mifareclassic_WriteDataBlock (uint8_t blockNumber, uint8_t *data)
yihui 0:9c6b9280c0e1 484 {
yihui 1:b8cab5222fd0 485 /* Prepare the first command */
yihui 1:b8cab5222fd0 486 pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE;
yihui 1:b8cab5222fd0 487 pn532_packetbuffer[1] = 1; /* Card number */
yihui 1:b8cab5222fd0 488 pn532_packetbuffer[2] = MIFARE_CMD_WRITE; /* Mifare Write command = 0xA0 */
yihui 1:b8cab5222fd0 489 pn532_packetbuffer[3] = blockNumber; /* Block Number (0..63 for 1K, 0..255 for 4K) */
yihui 1:b8cab5222fd0 490 memcpy (pn532_packetbuffer + 4, data, 16); /* Data Payload */
yihui 0:9c6b9280c0e1 491
yihui 1:b8cab5222fd0 492 /* Send the command */
yihui 1:b8cab5222fd0 493 if (HAL(writeCommand)(pn532_packetbuffer, 20)) {
yihui 1:b8cab5222fd0 494 return 0;
yihui 1:b8cab5222fd0 495 }
yihui 1:b8cab5222fd0 496
yihui 1:b8cab5222fd0 497 /* Read the response packet */
yihui 1:b8cab5222fd0 498 return (0 < HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer)));
yihui 0:9c6b9280c0e1 499 }
icefeet 5:51f820fbd18a 500 /**************************************************************************/
icefeet 5:51f820fbd18a 501 /*!
icefeet 5:51f820fbd18a 502 Tries to write an entire 4-bytes data block at the specified block
icefeet 5:51f820fbd18a 503 address.
icefeet 5:51f820fbd18a 504
icefeet 5:51f820fbd18a 505 @param blockNumber The block number to authenticate. (0..63 for
icefeet 5:51f820fbd18a 506 1KB cards, and 0..255 for 4KB cards).
icefeet 5:51f820fbd18a 507 @param data The byte array that contains the data to write.
icefeet 5:51f820fbd18a 508
icefeet 5:51f820fbd18a 509 @returns 1 if everything executed properly, 0 for an error
icefeet 5:51f820fbd18a 510 */
icefeet 5:51f820fbd18a 511 /**************************************************************************/
icefeet 5:51f820fbd18a 512 uint8_t PN532::mifareultralight_WritePage (uint8_t blockNumber, uint8_t *data)
icefeet 5:51f820fbd18a 513 {
icefeet 5:51f820fbd18a 514 /* Prepare the first command */
icefeet 5:51f820fbd18a 515 pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE;
icefeet 5:51f820fbd18a 516 pn532_packetbuffer[1] = 1; /* Card number */
icefeet 5:51f820fbd18a 517 pn532_packetbuffer[2] = MIFARE_UL_CMD_WRITE_PAGE; /* Mifare Write command = 0xA0 */
icefeet 5:51f820fbd18a 518 pn532_packetbuffer[3] = blockNumber; /* Block Number (0..63 for 1K, 0..255 for 4K) */
icefeet 5:51f820fbd18a 519 memcpy (pn532_packetbuffer + 4, data, 4); /* Data Payload */
icefeet 5:51f820fbd18a 520
icefeet 5:51f820fbd18a 521 /* Send the command */
icefeet 5:51f820fbd18a 522 if (HAL(writeCommand)(pn532_packetbuffer, 8)) {
icefeet 5:51f820fbd18a 523 return 0;
icefeet 5:51f820fbd18a 524 }
icefeet 5:51f820fbd18a 525
icefeet 5:51f820fbd18a 526 /* Read the response packet */
icefeet 5:51f820fbd18a 527 return (0 < HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer)));
icefeet 5:51f820fbd18a 528 }
yihui 0:9c6b9280c0e1 529
yihui 0:9c6b9280c0e1 530 /**************************************************************************/
yihui 1:b8cab5222fd0 531 /*!
yihui 1:b8cab5222fd0 532 Formats a Mifare Classic card to store NDEF Records
yihui 1:b8cab5222fd0 533
yihui 0:9c6b9280c0e1 534 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 535 */
yihui 0:9c6b9280c0e1 536 /**************************************************************************/
yihui 0:9c6b9280c0e1 537 uint8_t PN532::mifareclassic_FormatNDEF (void)
yihui 0:9c6b9280c0e1 538 {
yihui 1:b8cab5222fd0 539 uint8_t sectorbuffer1[16] = {0x14, 0x01, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1};
yihui 1:b8cab5222fd0 540 uint8_t sectorbuffer2[16] = {0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1};
yihui 1:b8cab5222fd0 541 uint8_t sectorbuffer3[16] = {0xA0, 0xA1, 0xA2, 0xA3, 0xA4, 0xA5, 0x78, 0x77, 0x88, 0xC1, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
yihui 1:b8cab5222fd0 542
yihui 1:b8cab5222fd0 543 // Note 0xA0 0xA1 0xA2 0xA3 0xA4 0xA5 must be used for key A
yihui 1:b8cab5222fd0 544 // for the MAD sector in NDEF records (sector 0)
yihui 0:9c6b9280c0e1 545
yihui 1:b8cab5222fd0 546 // Write block 1 and 2 to the card
yihui 1:b8cab5222fd0 547 if (!(mifareclassic_WriteDataBlock (1, sectorbuffer1)))
yihui 1:b8cab5222fd0 548 return 0;
yihui 1:b8cab5222fd0 549 if (!(mifareclassic_WriteDataBlock (2, sectorbuffer2)))
yihui 1:b8cab5222fd0 550 return 0;
yihui 1:b8cab5222fd0 551 // Write key A and access rights card
yihui 1:b8cab5222fd0 552 if (!(mifareclassic_WriteDataBlock (3, sectorbuffer3)))
yihui 1:b8cab5222fd0 553 return 0;
yihui 0:9c6b9280c0e1 554
yihui 1:b8cab5222fd0 555 // Seems that everything was OK (?!)
yihui 1:b8cab5222fd0 556 return 1;
yihui 0:9c6b9280c0e1 557 }
yihui 0:9c6b9280c0e1 558
yihui 0:9c6b9280c0e1 559 /**************************************************************************/
yihui 1:b8cab5222fd0 560 /*!
yihui 0:9c6b9280c0e1 561 Writes an NDEF URI Record to the specified sector (1..15)
yihui 1:b8cab5222fd0 562
yihui 0:9c6b9280c0e1 563 Note that this function assumes that the Mifare Classic card is
yihui 0:9c6b9280c0e1 564 already formatted to work as an "NFC Forum Tag" and uses a MAD1
yihui 0:9c6b9280c0e1 565 file system. You can use the NXP TagWriter app on Android to
yihui 0:9c6b9280c0e1 566 properly format cards for this.
yihui 0:9c6b9280c0e1 567
yihui 0:9c6b9280c0e1 568 @param sectorNumber The sector that the URI record should be written
yihui 0:9c6b9280c0e1 569 to (can be 1..15 for a 1K card)
yihui 1:b8cab5222fd0 570 @param uriIdentifier The uri identifier code (0 = none, 0x01 =
yihui 0:9c6b9280c0e1 571 "http://www.", etc.)
yihui 0:9c6b9280c0e1 572 @param url The uri text to write (max 38 characters).
yihui 1:b8cab5222fd0 573
yihui 0:9c6b9280c0e1 574 @returns 1 if everything executed properly, 0 for an error
yihui 0:9c6b9280c0e1 575 */
yihui 0:9c6b9280c0e1 576 /**************************************************************************/
yihui 1:b8cab5222fd0 577 uint8_t PN532::mifareclassic_WriteNDEFURI (uint8_t sectorNumber, uint8_t uriIdentifier, const char *url)
yihui 0:9c6b9280c0e1 578 {
yihui 1:b8cab5222fd0 579 // Figure out how long the string is
yihui 1:b8cab5222fd0 580 uint8_t len = strlen(url);
yihui 1:b8cab5222fd0 581
yihui 1:b8cab5222fd0 582 // Make sure we're within a 1K limit for the sector number
yihui 1:b8cab5222fd0 583 if ((sectorNumber < 1) || (sectorNumber > 15))
yihui 1:b8cab5222fd0 584 return 0;
yihui 1:b8cab5222fd0 585
yihui 1:b8cab5222fd0 586 // Make sure the URI payload is between 1 and 38 chars
yihui 1:b8cab5222fd0 587 if ((len < 1) || (len > 38))
yihui 1:b8cab5222fd0 588 return 0;
yihui 1:b8cab5222fd0 589
yihui 1:b8cab5222fd0 590 // Note 0xD3 0xF7 0xD3 0xF7 0xD3 0xF7 must be used for key A
yihui 1:b8cab5222fd0 591 // in NDEF records
yihui 0:9c6b9280c0e1 592
yihui 1:b8cab5222fd0 593 // Setup the sector buffer (w/pre-formatted TLV wrapper and NDEF message)
yihui 1:b8cab5222fd0 594 uint8_t sectorbuffer1[16] = {0x00, 0x00, 0x03, len + 5, 0xD1, 0x01, len + 1, 0x55, uriIdentifier, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
yihui 1:b8cab5222fd0 595 uint8_t sectorbuffer2[16] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
yihui 1:b8cab5222fd0 596 uint8_t sectorbuffer3[16] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
yihui 1:b8cab5222fd0 597 uint8_t sectorbuffer4[16] = {0xD3, 0xF7, 0xD3, 0xF7, 0xD3, 0xF7, 0x7F, 0x07, 0x88, 0x40, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
yihui 1:b8cab5222fd0 598 if (len <= 6) {
yihui 1:b8cab5222fd0 599 // Unlikely we'll get a url this short, but why not ...
yihui 1:b8cab5222fd0 600 memcpy (sectorbuffer1 + 9, url, len);
yihui 1:b8cab5222fd0 601 sectorbuffer1[len + 9] = 0xFE;
yihui 1:b8cab5222fd0 602 } else if (len == 7) {
yihui 1:b8cab5222fd0 603 // 0xFE needs to be wrapped around to next block
yihui 1:b8cab5222fd0 604 memcpy (sectorbuffer1 + 9, url, len);
yihui 1:b8cab5222fd0 605 sectorbuffer2[0] = 0xFE;
yihui 1:b8cab5222fd0 606 } else if ((len > 7) || (len <= 22)) {
yihui 1:b8cab5222fd0 607 // Url fits in two blocks
yihui 1:b8cab5222fd0 608 memcpy (sectorbuffer1 + 9, url, 7);
yihui 1:b8cab5222fd0 609 memcpy (sectorbuffer2, url + 7, len - 7);
yihui 1:b8cab5222fd0 610 sectorbuffer2[len - 7] = 0xFE;
yihui 1:b8cab5222fd0 611 } else if (len == 23) {
yihui 1:b8cab5222fd0 612 // 0xFE needs to be wrapped around to final block
yihui 1:b8cab5222fd0 613 memcpy (sectorbuffer1 + 9, url, 7);
yihui 1:b8cab5222fd0 614 memcpy (sectorbuffer2, url + 7, len - 7);
yihui 1:b8cab5222fd0 615 sectorbuffer3[0] = 0xFE;
yihui 1:b8cab5222fd0 616 } else {
yihui 1:b8cab5222fd0 617 // Url fits in three blocks
yihui 1:b8cab5222fd0 618 memcpy (sectorbuffer1 + 9, url, 7);
yihui 1:b8cab5222fd0 619 memcpy (sectorbuffer2, url + 7, 16);
yihui 1:b8cab5222fd0 620 memcpy (sectorbuffer3, url + 23, len - 24);
yihui 1:b8cab5222fd0 621 sectorbuffer3[len - 22] = 0xFE;
yihui 1:b8cab5222fd0 622 }
yihui 1:b8cab5222fd0 623
yihui 1:b8cab5222fd0 624 // Now write all three blocks back to the card
yihui 1:b8cab5222fd0 625 if (!(mifareclassic_WriteDataBlock (sectorNumber * 4, sectorbuffer1)))
yihui 1:b8cab5222fd0 626 return 0;
yihui 1:b8cab5222fd0 627 if (!(mifareclassic_WriteDataBlock ((sectorNumber * 4) + 1, sectorbuffer2)))
yihui 1:b8cab5222fd0 628 return 0;
yihui 1:b8cab5222fd0 629 if (!(mifareclassic_WriteDataBlock ((sectorNumber * 4) + 2, sectorbuffer3)))
yihui 1:b8cab5222fd0 630 return 0;
yihui 1:b8cab5222fd0 631 if (!(mifareclassic_WriteDataBlock ((sectorNumber * 4) + 3, sectorbuffer4)))
yihui 1:b8cab5222fd0 632 return 0;
yihui 1:b8cab5222fd0 633
yihui 1:b8cab5222fd0 634 // Seems that everything was OK (?!)
yihui 1:b8cab5222fd0 635 return 1;
yihui 0:9c6b9280c0e1 636 }
yihui 0:9c6b9280c0e1 637
yihui 0:9c6b9280c0e1 638 /***** Mifare Ultralight Functions ******/
yihui 0:9c6b9280c0e1 639
yihui 0:9c6b9280c0e1 640 /**************************************************************************/
yihui 1:b8cab5222fd0 641 /*!
yihui 1:b8cab5222fd0 642 Tries to read an entire 4-bytes page at the specified address.
yihui 0:9c6b9280c0e1 643
yihui 0:9c6b9280c0e1 644 @param page The page number (0..63 in most cases)
yihui 1:b8cab5222fd0 645 @param buffer Pointer to the byte array that will hold the
yihui 0:9c6b9280c0e1 646 retrieved data (if any)
yihui 0:9c6b9280c0e1 647 */
yihui 0:9c6b9280c0e1 648 /**************************************************************************/
yihui 1:b8cab5222fd0 649 uint8_t PN532::mifareultralight_ReadPage (uint8_t page, uint8_t *buffer)
yihui 0:9c6b9280c0e1 650 {
yihui 1:b8cab5222fd0 651 if (page >= 64) {
yihui 1:b8cab5222fd0 652 DMSG("Page value out of range\n");
yihui 1:b8cab5222fd0 653 return 0;
yihui 1:b8cab5222fd0 654 }
yihui 0:9c6b9280c0e1 655
yihui 1:b8cab5222fd0 656 /* Prepare the command */
yihui 1:b8cab5222fd0 657 pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE;
yihui 1:b8cab5222fd0 658 pn532_packetbuffer[1] = 1; /* Card number */
yihui 1:b8cab5222fd0 659 pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */
yihui 1:b8cab5222fd0 660 pn532_packetbuffer[3] = page; /* Page Number (0..63 in most cases) */
yihui 1:b8cab5222fd0 661
yihui 1:b8cab5222fd0 662 /* Send the command */
yihui 1:b8cab5222fd0 663 if (HAL(writeCommand)(pn532_packetbuffer, 4)) {
yihui 1:b8cab5222fd0 664 return 0;
yihui 1:b8cab5222fd0 665 }
yihui 0:9c6b9280c0e1 666
yihui 1:b8cab5222fd0 667 /* Read the response packet */
yihui 1:b8cab5222fd0 668 HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer));
yihui 0:9c6b9280c0e1 669
yihui 1:b8cab5222fd0 670 /* If byte 8 isn't 0x00 we probably have an error */
yihui 1:b8cab5222fd0 671 if (pn532_packetbuffer[0] == 0x00) {
yihui 1:b8cab5222fd0 672 /* Copy the 4 data bytes to the output buffer */
yihui 1:b8cab5222fd0 673 /* Block content starts at byte 9 of a valid response */
yihui 1:b8cab5222fd0 674 /* Note that the command actually reads 16 bytes or 4 */
yihui 1:b8cab5222fd0 675 /* pages at a time ... we simply discard the last 12 */
yihui 1:b8cab5222fd0 676 /* bytes */
yihui 1:b8cab5222fd0 677 memcpy (buffer, pn532_packetbuffer + 1, 4);
yihui 1:b8cab5222fd0 678 } else {
yihui 1:b8cab5222fd0 679 return 0;
yihui 1:b8cab5222fd0 680 }
yihui 0:9c6b9280c0e1 681
yihui 1:b8cab5222fd0 682 // Return OK signal
yihui 1:b8cab5222fd0 683 return 1;
yihui 0:9c6b9280c0e1 684 }
yihui 0:9c6b9280c0e1 685
yihui 0:9c6b9280c0e1 686 /**************************************************************************/
yihui 1:b8cab5222fd0 687 /*!
yihui 0:9c6b9280c0e1 688 @brief Exchanges an APDU with the currently inlisted peer
yihui 0:9c6b9280c0e1 689
yihui 0:9c6b9280c0e1 690 @param send Pointer to data to send
yihui 0:9c6b9280c0e1 691 @param sendLength Length of the data to send
yihui 0:9c6b9280c0e1 692 @param response Pointer to response data
yihui 0:9c6b9280c0e1 693 @param responseLength Pointer to the response data length
yihui 0:9c6b9280c0e1 694 */
yihui 0:9c6b9280c0e1 695 /**************************************************************************/
yihui 1:b8cab5222fd0 696 bool PN532::inDataExchange(uint8_t *send, uint8_t sendLength, uint8_t *response, uint8_t *responseLength)
yihui 1:b8cab5222fd0 697 {
yihui 1:b8cab5222fd0 698 uint8_t i;
yihui 0:9c6b9280c0e1 699
yihui 1:b8cab5222fd0 700 pn532_packetbuffer[0] = 0x40; // PN532_COMMAND_INDATAEXCHANGE;
yihui 1:b8cab5222fd0 701 pn532_packetbuffer[1] = inListedTag;
yihui 1:b8cab5222fd0 702
yihui 3:4189a10038e6 703 if (HAL(writeCommand)(pn532_packetbuffer, 2, send, sendLength)) {
yihui 1:b8cab5222fd0 704 return false;
yihui 1:b8cab5222fd0 705 }
yihui 0:9c6b9280c0e1 706
yihui 3:4189a10038e6 707 int16_t status = HAL(readResponse)(response, *responseLength, 1000);
yihui 1:b8cab5222fd0 708 if (status < 0) {
yihui 1:b8cab5222fd0 709 return false;
yihui 1:b8cab5222fd0 710 }
yihui 1:b8cab5222fd0 711
yihui 3:4189a10038e6 712 if ((response[0] & 0x3f) != 0) {
yihui 1:b8cab5222fd0 713 DMSG("Status code indicates an error\n");
yihui 1:b8cab5222fd0 714 return false;
yihui 1:b8cab5222fd0 715 }
yihui 0:9c6b9280c0e1 716
yihui 3:4189a10038e6 717 uint8_t length = status;
yihui 1:b8cab5222fd0 718 length -= 1;
yihui 1:b8cab5222fd0 719
yihui 1:b8cab5222fd0 720 if (length > *responseLength) {
yihui 1:b8cab5222fd0 721 length = *responseLength; // silent truncation...
yihui 1:b8cab5222fd0 722 }
yihui 1:b8cab5222fd0 723
yihui 3:4189a10038e6 724 for (uint8_t i = 0; i < length; i++) {
yihui 3:4189a10038e6 725 response[i] = response[i + 1];
yihui 1:b8cab5222fd0 726 }
yihui 1:b8cab5222fd0 727 *responseLength = length;
yihui 1:b8cab5222fd0 728
yihui 1:b8cab5222fd0 729 return true;
yihui 0:9c6b9280c0e1 730 }
yihui 0:9c6b9280c0e1 731
yihui 0:9c6b9280c0e1 732 /**************************************************************************/
yihui 1:b8cab5222fd0 733 /*!
yihui 0:9c6b9280c0e1 734 @brief 'InLists' a passive target. PN532 acting as reader/initiator,
yihui 0:9c6b9280c0e1 735 peer acting as card/responder.
yihui 0:9c6b9280c0e1 736 */
yihui 0:9c6b9280c0e1 737 /**************************************************************************/
yihui 1:b8cab5222fd0 738 bool PN532::inListPassiveTarget()
yihui 1:b8cab5222fd0 739 {
yihui 1:b8cab5222fd0 740 pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET;
yihui 1:b8cab5222fd0 741 pn532_packetbuffer[1] = 1;
yihui 1:b8cab5222fd0 742 pn532_packetbuffer[2] = 0;
yihui 0:9c6b9280c0e1 743
yihui 1:b8cab5222fd0 744 DMSG("inList passive target\n");
yihui 1:b8cab5222fd0 745
yihui 1:b8cab5222fd0 746 if (HAL(writeCommand)(pn532_packetbuffer, 3)) {
yihui 1:b8cab5222fd0 747 return false;
yihui 1:b8cab5222fd0 748 }
yihui 0:9c6b9280c0e1 749
yihui 1:b8cab5222fd0 750 int16_t status = HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer), 30000);
yihui 1:b8cab5222fd0 751 if (status < 0) {
yihui 1:b8cab5222fd0 752 return false;
yihui 1:b8cab5222fd0 753 }
yihui 0:9c6b9280c0e1 754
yihui 1:b8cab5222fd0 755 if (pn532_packetbuffer[0] != 1) {
yihui 1:b8cab5222fd0 756 return false;
yihui 1:b8cab5222fd0 757 }
yihui 1:b8cab5222fd0 758
yihui 1:b8cab5222fd0 759 inListedTag = pn532_packetbuffer[1];
yihui 1:b8cab5222fd0 760
yihui 1:b8cab5222fd0 761 return true;
yihui 0:9c6b9280c0e1 762 }
yihui 0:9c6b9280c0e1 763
yihui 3:4189a10038e6 764 int8_t PN532::tgInitAsTarget(const uint8_t* command, const uint8_t len, const uint16_t timeout){
yihui 3:4189a10038e6 765
yihui 3:4189a10038e6 766 int8_t status = HAL(writeCommand)(command, len);
yihui 3:4189a10038e6 767 if (status < 0) {
yihui 3:4189a10038e6 768 return -1;
yihui 3:4189a10038e6 769 }
yihui 3:4189a10038e6 770
yihui 3:4189a10038e6 771 status = HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer), timeout);
yihui 3:4189a10038e6 772 if (status > 0) {
yihui 3:4189a10038e6 773 return 1;
yihui 3:4189a10038e6 774 } else if (PN532_TIMEOUT == status) {
yihui 3:4189a10038e6 775 return 0;
yihui 3:4189a10038e6 776 } else {
yihui 3:4189a10038e6 777 return -2;
yihui 3:4189a10038e6 778 }
yihui 3:4189a10038e6 779 }
yihui 3:4189a10038e6 780
yihui 0:9c6b9280c0e1 781 /**
yihui 0:9c6b9280c0e1 782 * Peer to Peer
yihui 0:9c6b9280c0e1 783 */
yihui 3:4189a10038e6 784 int8_t PN532::tgInitAsTarget(uint16_t timeout)
yihui 0:9c6b9280c0e1 785 {
yihui 3:4189a10038e6 786 const uint8_t command[] = {
yihui 1:b8cab5222fd0 787 PN532_COMMAND_TGINITASTARGET,
yihui 1:b8cab5222fd0 788 0,
yihui 1:b8cab5222fd0 789 0x00, 0x00, //SENS_RES
yihui 1:b8cab5222fd0 790 0x00, 0x00, 0x00, //NFCID1
yihui 1:b8cab5222fd0 791 0x40, //SEL_RES
yihui 0:9c6b9280c0e1 792
yihui 1:b8cab5222fd0 793 0x01, 0xFE, 0x0F, 0xBB, 0xBA, 0xA6, 0xC9, 0x89, // POL_RES
yihui 1:b8cab5222fd0 794 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
yihui 1:b8cab5222fd0 795 0xFF, 0xFF,
yihui 0:9c6b9280c0e1 796
yihui 1:b8cab5222fd0 797 0x01, 0xFE, 0x0F, 0xBB, 0xBA, 0xA6, 0xC9, 0x89, 0x00, 0x00, //NFCID3t: Change this to desired value
yihui 0:9c6b9280c0e1 798
yihui 1:b8cab5222fd0 799 0x06, 0x46, 0x66, 0x6D, 0x01, 0x01, 0x10, 0x00// LLCP magic number and version parameter
yihui 1:b8cab5222fd0 800 };
yihui 3:4189a10038e6 801 return tgInitAsTarget(command, sizeof(command), timeout);
yihui 3:4189a10038e6 802 }
yihui 1:b8cab5222fd0 803
yihui 3:4189a10038e6 804 int16_t PN532::tgGetData(uint8_t *buf, uint8_t len)
yihui 3:4189a10038e6 805 {
yihui 3:4189a10038e6 806 buf[0] = PN532_COMMAND_TGGETDATA;
yihui 3:4189a10038e6 807
yihui 3:4189a10038e6 808 if (HAL(writeCommand)(buf, 1)) {
yihui 3:4189a10038e6 809 return -1;
yihui 3:4189a10038e6 810 }
yihui 3:4189a10038e6 811
yihui 3:4189a10038e6 812 int16_t status = HAL(readResponse)(buf, len, 3000);
yihui 3:4189a10038e6 813 if (0 >= status) {
yihui 0:9c6b9280c0e1 814 return status;
yihui 0:9c6b9280c0e1 815 }
yihui 1:b8cab5222fd0 816
yihui 3:4189a10038e6 817 uint16_t length = status - 1;
yihui 1:b8cab5222fd0 818
yihui 1:b8cab5222fd0 819
yihui 3:4189a10038e6 820 if (buf[0] != 0) {
yihui 0:9c6b9280c0e1 821 DMSG("status is not ok\n");
yihui 0:9c6b9280c0e1 822 return -5;
yihui 0:9c6b9280c0e1 823 }
yihui 1:b8cab5222fd0 824
yihui 3:4189a10038e6 825 for (uint8_t i = 0; i < length; i++) {
yihui 3:4189a10038e6 826 buf[i] = buf[i + 1];
yihui 3:4189a10038e6 827 }
yihui 0:9c6b9280c0e1 828
yihui 3:4189a10038e6 829 return length;
yihui 0:9c6b9280c0e1 830 }
yihui 0:9c6b9280c0e1 831
yihui 3:4189a10038e6 832 bool PN532::tgSetData(const uint8_t *header, uint8_t hlen, const uint8_t *body, uint8_t blen)
yihui 0:9c6b9280c0e1 833 {
yihui 3:4189a10038e6 834 if (hlen > (sizeof(pn532_packetbuffer) - 1)) {
yihui 0:9c6b9280c0e1 835 return false;
yihui 0:9c6b9280c0e1 836 }
yihui 1:b8cab5222fd0 837
yihui 3:4189a10038e6 838 for (int8_t i = hlen - 1; i >= 0; i--){
yihui 3:4189a10038e6 839 pn532_packetbuffer[i + 1] = header[i];
yihui 3:4189a10038e6 840 }
yihui 3:4189a10038e6 841 pn532_packetbuffer[0] = PN532_COMMAND_TGSETDATA;
yihui 1:b8cab5222fd0 842
yihui 3:4189a10038e6 843 if (HAL(writeCommand)(pn532_packetbuffer, hlen + 1, body, blen)) {
yihui 0:9c6b9280c0e1 844 return false;
yihui 0:9c6b9280c0e1 845 }
yihui 1:b8cab5222fd0 846
yihui 0:9c6b9280c0e1 847 if (0 > HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer), 3000)) {
yihui 0:9c6b9280c0e1 848 return false;
yihui 0:9c6b9280c0e1 849 }
yihui 1:b8cab5222fd0 850
yihui 0:9c6b9280c0e1 851 if (0 != pn532_packetbuffer[0]) {
yihui 0:9c6b9280c0e1 852 return false;
yihui 0:9c6b9280c0e1 853 }
yihui 1:b8cab5222fd0 854
yihui 0:9c6b9280c0e1 855 return true;
yihui 0:9c6b9280c0e1 856 }
yihui 3:4189a10038e6 857
yihui 3:4189a10038e6 858 int16_t PN532::inRelease(const uint8_t relevantTarget){
yihui 3:4189a10038e6 859
yihui 3:4189a10038e6 860 pn532_packetbuffer[0] = PN532_COMMAND_INRELEASE;
yihui 3:4189a10038e6 861 pn532_packetbuffer[1] = relevantTarget;
yihui 3:4189a10038e6 862
yihui 3:4189a10038e6 863 if (HAL(writeCommand)(pn532_packetbuffer, 2)) {
yihui 3:4189a10038e6 864 return 0;
yihui 3:4189a10038e6 865 }
yihui 3:4189a10038e6 866
yihui 3:4189a10038e6 867 // read data packet
yihui 3:4189a10038e6 868 return HAL(readResponse)(pn532_packetbuffer, sizeof(pn532_packetbuffer));
yihui 3:4189a10038e6 869 }
yihui 3:4189a10038e6 870
yihui 3:4189a10038e6 871