diff options
Diffstat (limited to 'src/libs/Adafruit_PN532.cpp')
| -rw-r--r-- | src/libs/Adafruit_PN532.cpp | 1934 |
1 files changed, 973 insertions, 961 deletions
diff --git a/src/libs/Adafruit_PN532.cpp b/src/libs/Adafruit_PN532.cpp index 4665656..0a547b7 100644 --- a/src/libs/Adafruit_PN532.cpp +++ b/src/libs/Adafruit_PN532.cpp @@ -91,9 +91,9 @@ byte pn532_packetbuffer[PN532_PACKBUFFSIZ]; ///< Packet buffer used in various /**************************************************************************/ Adafruit_PN532::Adafruit_PN532(uint8_t clk, uint8_t miso, uint8_t mosi, uint8_t ss) { - _cs = ss; - spi_dev = new Adafruit_SPIDevice(ss, clk, miso, mosi, 1000000, - SPI_BITORDER_LSBFIRST, SPI_MODE0); + _cs = ss; + spi_dev = new Adafruit_SPIDevice(ss, clk, miso, mosi, 1000000, + SPI_BITORDER_LSBFIRST, SPI_MODE0); } /**************************************************************************/ @@ -107,9 +107,9 @@ Adafruit_PN532::Adafruit_PN532(uint8_t clk, uint8_t miso, uint8_t mosi, /**************************************************************************/ Adafruit_PN532::Adafruit_PN532(uint8_t irq, uint8_t reset, TwoWire *theWire) : _irq(irq), _reset(reset) { - pinMode(_irq, INPUT); - pinMode(_reset, OUTPUT); - i2c_dev = new Adafruit_I2CDevice(PN532_I2C_ADDRESS, theWire); + pinMode(_irq, INPUT); + pinMode(_reset, OUTPUT); + i2c_dev = new Adafruit_I2CDevice(PN532_I2C_ADDRESS, theWire); } /**************************************************************************/ @@ -121,9 +121,9 @@ Adafruit_PN532::Adafruit_PN532(uint8_t irq, uint8_t reset, TwoWire *theWire) */ /**************************************************************************/ Adafruit_PN532::Adafruit_PN532(uint8_t ss, SPIClass *theSPI) { - _cs = ss; - spi_dev = new Adafruit_SPIDevice(ss, 1000000, SPI_BITORDER_LSBFIRST, - SPI_MODE0, theSPI); + _cs = ss; + spi_dev = new Adafruit_SPIDevice(ss, 1000000, SPI_BITORDER_LSBFIRST, + SPI_MODE0, theSPI); } /**************************************************************************/ @@ -136,8 +136,8 @@ Adafruit_PN532::Adafruit_PN532(uint8_t ss, SPIClass *theSPI) { /**************************************************************************/ Adafruit_PN532::Adafruit_PN532(uint8_t reset, HardwareSerial *theSer) : _reset(reset) { - pinMode(_reset, OUTPUT); - ser_dev = theSer; + pinMode(_reset, OUTPUT); + ser_dev = theSer; } /**************************************************************************/ @@ -148,30 +148,30 @@ Adafruit_PN532::Adafruit_PN532(uint8_t reset, HardwareSerial *theSer) */ /**************************************************************************/ bool Adafruit_PN532::begin() { - if (spi_dev) { - // SPI initialization - if (!spi_dev->begin()) { - return false; - } - } else if (i2c_dev) { - // I2C initialization - // PN532 will fail address check since its asleep, so suppress - if (!i2c_dev->begin(false)) { - return false; + if (spi_dev) { + // SPI initialization + if (!spi_dev->begin()) { + return false; + } + } else if (i2c_dev) { + // I2C initialization + // PN532 will fail address check since its asleep, so suppress + if (!i2c_dev->begin(false)) { + return false; + } + } else if (ser_dev) { + ser_dev->begin(115200); + // clear out anything in read buffer + while (ser_dev->available()) + ser_dev->read(); + } else { + // no interface specified + return false; } - } else if (ser_dev) { - ser_dev->begin(115200); - // clear out anything in read buffer - while (ser_dev->available()) - ser_dev->read(); - } else { - // no interface specified - return false; - } - reset(); // HW reset - put in known state - delay(10); - wakeup(); // hey! wakeup! - return true; + reset(); // HW reset - put in known state + delay(10); + wakeup(); // hey! wakeup! + return true; } /**************************************************************************/ @@ -180,13 +180,13 @@ bool Adafruit_PN532::begin() { */ /**************************************************************************/ void Adafruit_PN532::reset(void) { - // see Datasheet p.209, Fig.48 for timings - if (_reset != -1) { - digitalWrite(_reset, LOW); - delay(1); // min 20ns - digitalWrite(_reset, HIGH); - delay(2); // max 2ms - } + // see Datasheet p.209, Fig.48 for timings + if (_reset != -1) { + digitalWrite(_reset, LOW); + delay(1); // min 20ns + digitalWrite(_reset, HIGH); + delay(2); // max 2ms + } } /**************************************************************************/ @@ -195,21 +195,21 @@ void Adafruit_PN532::reset(void) { */ /**************************************************************************/ void Adafruit_PN532::wakeup(void) { - // interface specific wakeups - each one is unique! - if (spi_dev) { - // hold CS low for 2ms - digitalWrite(_cs, LOW); - delay(2); - } else if (ser_dev) { - uint8_t w[3] = {0x55, 0x00, 0x00}; - ser_dev->write(w, 3); - delay(2); - } - - // PN532 will clock stretch I2C during SAMConfig as a "wakeup" - - // need to config SAM to stay in Normal Mode - SAMConfig(); + // interface specific wakeups - each one is unique! + if (spi_dev) { + // hold CS low for 2ms + digitalWrite(_cs, LOW); + delay(2); + } else if (ser_dev) { + uint8_t w[3] = {0x55, 0x00, 0x00}; + ser_dev->write(w, 3); + delay(2); + } + + // PN532 will clock stretch I2C during SAMConfig as a "wakeup" + + // need to config SAM to stay in Normal Mode + SAMConfig(); } /**************************************************************************/ @@ -221,18 +221,18 @@ void Adafruit_PN532::wakeup(void) { */ /**************************************************************************/ void Adafruit_PN532::PrintHex(const byte *data, const uint32_t numBytes) { - uint32_t szPos; - for (szPos = 0; szPos < numBytes; szPos++) { - PN532DEBUGPRINT.print(F("0x")); - // Append leading 0 for small values - if (data[szPos] <= 0xF) - PN532DEBUGPRINT.print(F("0")); - PN532DEBUGPRINT.print(data[szPos] & 0xff, HEX); - if ((numBytes > 1) && (szPos != numBytes - 1)) { - PN532DEBUGPRINT.print(F(" ")); + uint32_t szPos; + for (szPos = 0; szPos < numBytes; szPos++) { + PN532DEBUGPRINT.print(F("0x")); + // Append leading 0 for small values + if (data[szPos] <= 0xF) + PN532DEBUGPRINT.print(F("0")); + PN532DEBUGPRINT.print(data[szPos] & 0xff, HEX); + if ((numBytes > 1) && (szPos != numBytes - 1)) { + PN532DEBUGPRINT.print(F(" ")); + } } - } - PN532DEBUGPRINT.println(); + PN532DEBUGPRINT.println(); } /**************************************************************************/ @@ -247,24 +247,24 @@ void Adafruit_PN532::PrintHex(const byte *data, const uint32_t numBytes) { */ /**************************************************************************/ void Adafruit_PN532::PrintHexChar(const byte *data, const uint32_t numBytes) { - uint32_t szPos; - for (szPos = 0; szPos < numBytes; szPos++) { - // Append leading 0 for small values - if (data[szPos] <= 0xF) - PN532DEBUGPRINT.print(F("0")); - PN532DEBUGPRINT.print(data[szPos], HEX); - if ((numBytes > 1) && (szPos != numBytes - 1)) { - PN532DEBUGPRINT.print(F(" ")); + uint32_t szPos; + for (szPos = 0; szPos < numBytes; szPos++) { + // Append leading 0 for small values + if (data[szPos] <= 0xF) + PN532DEBUGPRINT.print(F("0")); + PN532DEBUGPRINT.print(data[szPos], HEX); + if ((numBytes > 1) && (szPos != numBytes - 1)) { + PN532DEBUGPRINT.print(F(" ")); + } } - } - PN532DEBUGPRINT.print(F(" ")); - for (szPos = 0; szPos < numBytes; szPos++) { - if (data[szPos] <= 0x1F) - PN532DEBUGPRINT.print(F(".")); - else - PN532DEBUGPRINT.print((char)data[szPos]); - } - PN532DEBUGPRINT.println(); + PN532DEBUGPRINT.print(F(" ")); + for (szPos = 0; szPos < numBytes; szPos++) { + if (data[szPos] <= 0x1F) + PN532DEBUGPRINT.print(F(".")); + else + PN532DEBUGPRINT.print((char)data[szPos]); + } + PN532DEBUGPRINT.println(); } /**************************************************************************/ @@ -275,36 +275,36 @@ void Adafruit_PN532::PrintHexChar(const byte *data, const uint32_t numBytes) { */ /**************************************************************************/ uint32_t Adafruit_PN532::getFirmwareVersion(void) { - uint32_t response; + uint32_t response; - pn532_packetbuffer[0] = PN532_COMMAND_GETFIRMWAREVERSION; + pn532_packetbuffer[0] = PN532_COMMAND_GETFIRMWAREVERSION; - if (!sendCommandCheckAck(pn532_packetbuffer, 1)) { - return 0; - } + if (!sendCommandCheckAck(pn532_packetbuffer, 1)) { + return 0; + } - // read data packet - readdata(pn532_packetbuffer, 13); + // read data packet + readdata(pn532_packetbuffer, 13); - // check some basic stuff - if (0 != memcmp((char *)pn532_packetbuffer, - (char *)pn532response_firmwarevers, 6)) { + // check some basic stuff + if (0 != memcmp((char *)pn532_packetbuffer, + (char *)pn532response_firmwarevers, 6)) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Firmware doesn't match!")); + PN532DEBUGPRINT.println(F("Firmware doesn't match!")); #endif - return 0; - } - - int offset = 7; - response = pn532_packetbuffer[offset++]; - response <<= 8; - response |= pn532_packetbuffer[offset++]; - response <<= 8; - response |= pn532_packetbuffer[offset++]; - response <<= 8; - response |= pn532_packetbuffer[offset++]; - - return response; + return 0; + } + + int offset = 7; + response = pn532_packetbuffer[offset++]; + response <<= 8; + response |= pn532_packetbuffer[offset++]; + response <<= 8; + response |= pn532_packetbuffer[offset++]; + response <<= 8; + response |= pn532_packetbuffer[offset++]; + + return response; } /**************************************************************************/ @@ -323,46 +323,46 @@ uint32_t Adafruit_PN532::getFirmwareVersion(void) { bool Adafruit_PN532::sendCommandCheckAck(uint8_t *cmd, uint8_t cmdlen, uint16_t timeout) { - // I2C works without using IRQ pin by polling for RDY byte - // seems to work best with some delays between transactions - uint8_t SLOWDOWN = 0; - if (i2c_dev || spi_dev) // SPI and I2C need 1ms slow for page reads - SLOWDOWN = 1; + // I2C works without using IRQ pin by polling for RDY byte + // seems to work best with some delays between transactions + uint8_t SLOWDOWN = 0; + if (i2c_dev || spi_dev) // SPI and I2C need 1ms slow for page reads + SLOWDOWN = 1; - // write the command - writecommand(cmd, cmdlen); + // write the command + writecommand(cmd, cmdlen); - // I2C TUNING - delay(SLOWDOWN); + // I2C TUNING + delay(SLOWDOWN); - // Wait for chip to say its ready! - if (!waitready(timeout)) { - return false; - } + // Wait for chip to say its ready! + if (!waitready(timeout)) { + return false; + } #ifdef PN532DEBUG - if (spi_dev == NULL) { - PN532DEBUGPRINT.println(F("IRQ received")); - } + if (spi_dev == NULL) { + PN532DEBUGPRINT.println(F("IRQ received")); + } #endif - // read acknowledgement - if (!readack()) { + // read acknowledgement + if (!readack()) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("No ACK frame received!")); + PN532DEBUGPRINT.println(F("No ACK frame received!")); #endif - return false; - } + return false; + } - // I2C TUNING - delay(SLOWDOWN); + // I2C TUNING + delay(SLOWDOWN); - // Wait for chip to say its ready! - if (!waitready(timeout)) { - return false; - } + // Wait for chip to say its ready! + if (!waitready(timeout)) { + return false; + } - return true; // ack'd command + return true; // ack'd command } /**************************************************************************/ @@ -389,37 +389,37 @@ bool Adafruit_PN532::sendCommandCheckAck(uint8_t *cmd, uint8_t cmdlen, */ /**************************************************************************/ bool Adafruit_PN532::writeGPIO(uint8_t pinstate) { - // uint8_t errorbit; + // uint8_t errorbit; - // Make sure pinstate does not try to toggle P32 or P34 - pinstate |= (1 << PN532_GPIO_P32) | (1 << PN532_GPIO_P34); + // Make sure pinstate does not try to toggle P32 or P34 + pinstate |= (1 << PN532_GPIO_P32) | (1 << PN532_GPIO_P34); - // Fill command buffer - pn532_packetbuffer[0] = PN532_COMMAND_WRITEGPIO; - pn532_packetbuffer[1] = PN532_GPIO_VALIDATIONBIT | pinstate; // P3 Pins - pn532_packetbuffer[2] = 0x00; // P7 GPIO Pins (not used ... taken by SPI) + // Fill command buffer + pn532_packetbuffer[0] = PN532_COMMAND_WRITEGPIO; + pn532_packetbuffer[1] = PN532_GPIO_VALIDATIONBIT | pinstate; // P3 Pins + pn532_packetbuffer[2] = 0x00; // P7 GPIO Pins (not used ... taken by SPI) #ifdef PN532DEBUG - PN532DEBUGPRINT.print(F("Writing P3 GPIO: ")); - PN532DEBUGPRINT.println(pn532_packetbuffer[1], HEX); + PN532DEBUGPRINT.print(F("Writing P3 GPIO: ")); + PN532DEBUGPRINT.println(pn532_packetbuffer[1], HEX); #endif - // Send the WRITEGPIO command (0x0E) - if (!sendCommandCheckAck(pn532_packetbuffer, 3)) - return 0x0; + // Send the WRITEGPIO command (0x0E) + if (!sendCommandCheckAck(pn532_packetbuffer, 3)) + return 0x0; - // Read response packet (00 FF PLEN PLENCHECKSUM D5 CMD+1(0x0F) DATACHECKSUM - // 00) - readdata(pn532_packetbuffer, 8); + // Read response packet (00 FF PLEN PLENCHECKSUM D5 CMD+1(0x0F) DATACHECKSUM + // 00) + readdata(pn532_packetbuffer, 8); #ifdef PN532DEBUG - PN532DEBUGPRINT.print(F("Received: ")); - PrintHex(pn532_packetbuffer, 8); - PN532DEBUGPRINT.println(); + PN532DEBUGPRINT.print(F("Received: ")); + PrintHex(pn532_packetbuffer, 8); + PN532DEBUGPRINT.println(); #endif - int offset = 6; - return (pn532_packetbuffer[offset] == 0x0F); + int offset = 6; + return (pn532_packetbuffer[offset] == 0x0F); } /**************************************************************************/ @@ -437,53 +437,52 @@ bool Adafruit_PN532::writeGPIO(uint8_t pinstate) { */ /**************************************************************************/ uint8_t Adafruit_PN532::readGPIO(void) { - pn532_packetbuffer[0] = PN532_COMMAND_READGPIO; + pn532_packetbuffer[0] = PN532_COMMAND_READGPIO; - // Send the READGPIO command (0x0C) - if (!sendCommandCheckAck(pn532_packetbuffer, 1)) - return 0x0; + // Send the READGPIO command (0x0C) + if (!sendCommandCheckAck(pn532_packetbuffer, 1)) + return 0x0; - // Read response packet (00 FF PLEN PLENCHECKSUM D5 CMD+1(0x0D) P3 P7 IO1 - // DATACHECKSUM 00) - readdata(pn532_packetbuffer, 11); + // Read response packet (00 FF PLEN PLENCHECKSUM D5 CMD+1(0x0D) P3 P7 IO1 + // DATACHECKSUM 00) + readdata(pn532_packetbuffer, 11); - /* READGPIO response should be in the following format: + /* READGPIO response should be in the following format: - byte Description - ------------- ------------------------------------------ - b0..5 Frame header and preamble (with I2C there is an extra 0x00) - b6 P3 GPIO Pins - b7 P7 GPIO Pins (not used ... taken by SPI) - b8 Interface Mode Pins (not used ... bus select pins) - b9..10 checksum */ + byte Description + ------------- ------------------------------------------ + b0..5 Frame header and preamble (with I2C there is an extra + 0x00) b6 P3 GPIO Pins b7 P7 GPIO Pins (not used + ... taken by SPI) b8 Interface Mode Pins (not used ... bus + select pins) b9..10 checksum */ - int p3offset = 7; + int p3offset = 7; #ifdef PN532DEBUG - PN532DEBUGPRINT.print(F("Received: ")); - PrintHex(pn532_packetbuffer, 11); - PN532DEBUGPRINT.println(); - PN532DEBUGPRINT.print(F("P3 GPIO: 0x")); - PN532DEBUGPRINT.println(pn532_packetbuffer[p3offset], HEX); - PN532DEBUGPRINT.print(F("P7 GPIO: 0x")); - PN532DEBUGPRINT.println(pn532_packetbuffer[p3offset + 1], HEX); - PN532DEBUGPRINT.print(F("IO GPIO: 0x")); - PN532DEBUGPRINT.println(pn532_packetbuffer[p3offset + 2], HEX); - // Note: You can use the IO GPIO value to detect the serial bus being used - switch (pn532_packetbuffer[p3offset + 2]) { - case 0x00: // Using UART - PN532DEBUGPRINT.println(F("Using UART (IO = 0x00)")); - break; - case 0x01: // Using I2C - PN532DEBUGPRINT.println(F("Using I2C (IO = 0x01)")); - break; - case 0x02: // Using SPI - PN532DEBUGPRINT.println(F("Using SPI (IO = 0x02)")); - break; - } + PN532DEBUGPRINT.print(F("Received: ")); + PrintHex(pn532_packetbuffer, 11); + PN532DEBUGPRINT.println(); + PN532DEBUGPRINT.print(F("P3 GPIO: 0x")); + PN532DEBUGPRINT.println(pn532_packetbuffer[p3offset], HEX); + PN532DEBUGPRINT.print(F("P7 GPIO: 0x")); + PN532DEBUGPRINT.println(pn532_packetbuffer[p3offset + 1], HEX); + PN532DEBUGPRINT.print(F("IO GPIO: 0x")); + PN532DEBUGPRINT.println(pn532_packetbuffer[p3offset + 2], HEX); + // Note: You can use the IO GPIO value to detect the serial bus being used + switch (pn532_packetbuffer[p3offset + 2]) { + case 0x00: // Using UART + PN532DEBUGPRINT.println(F("Using UART (IO = 0x00)")); + break; + case 0x01: // Using I2C + PN532DEBUGPRINT.println(F("Using I2C (IO = 0x01)")); + break; + case 0x02: // Using SPI + PN532DEBUGPRINT.println(F("Using SPI (IO = 0x02)")); + break; + } #endif - return pn532_packetbuffer[p3offset]; + return pn532_packetbuffer[p3offset]; } /**************************************************************************/ @@ -493,19 +492,19 @@ uint8_t Adafruit_PN532::readGPIO(void) { */ /**************************************************************************/ bool Adafruit_PN532::SAMConfig(void) { - pn532_packetbuffer[0] = PN532_COMMAND_SAMCONFIGURATION; - pn532_packetbuffer[1] = 0x01; // normal mode; - pn532_packetbuffer[2] = 0x14; // timeout 50ms * 20 = 1 second - pn532_packetbuffer[3] = 0x01; // use IRQ pin! + pn532_packetbuffer[0] = PN532_COMMAND_SAMCONFIGURATION; + pn532_packetbuffer[1] = 0x01; // normal mode; + pn532_packetbuffer[2] = 0x14; // timeout 50ms * 20 = 1 second + pn532_packetbuffer[3] = 0x01; // use IRQ pin! - if (!sendCommandCheckAck(pn532_packetbuffer, 4)) - return false; + if (!sendCommandCheckAck(pn532_packetbuffer, 4)) + return false; - // read data packet - readdata(pn532_packetbuffer, 9); + // read data packet + readdata(pn532_packetbuffer, 9); - int offset = 6; - return (pn532_packetbuffer[offset] == 0x15); + int offset = 6; + return (pn532_packetbuffer[offset] == 0x15); } /**************************************************************************/ @@ -519,22 +518,22 @@ bool Adafruit_PN532::SAMConfig(void) { */ /**************************************************************************/ bool Adafruit_PN532::setPassiveActivationRetries(uint8_t maxRetries) { - pn532_packetbuffer[0] = PN532_COMMAND_RFCONFIGURATION; - pn532_packetbuffer[1] = 5; // Config item 5 (MaxRetries) - pn532_packetbuffer[2] = 0xFF; // MxRtyATR (default = 0xFF) - pn532_packetbuffer[3] = 0x01; // MxRtyPSL (default = 0x01) - pn532_packetbuffer[4] = maxRetries; + pn532_packetbuffer[0] = PN532_COMMAND_RFCONFIGURATION; + pn532_packetbuffer[1] = 5; // Config item 5 (MaxRetries) + pn532_packetbuffer[2] = 0xFF; // MxRtyATR (default = 0xFF) + pn532_packetbuffer[3] = 0x01; // MxRtyPSL (default = 0x01) + pn532_packetbuffer[4] = maxRetries; #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Setting MxRtyPassiveActivation to ")); - PN532DEBUGPRINT.print(maxRetries, DEC); - PN532DEBUGPRINT.println(F(" ")); + PN532DEBUGPRINT.print(F("Setting MxRtyPassiveActivation to ")); + PN532DEBUGPRINT.print(maxRetries, DEC); + PN532DEBUGPRINT.println(F(" ")); #endif - if (!sendCommandCheckAck(pn532_packetbuffer, 5)) - return 0x0; // no ACK + if (!sendCommandCheckAck(pn532_packetbuffer, 5)) + return 0x0; // no ACK - return 1; + return 1; } /***** ISO14443A Commands ******/ @@ -556,18 +555,19 @@ bool Adafruit_PN532::setPassiveActivationRetries(uint8_t maxRetries) { /**************************************************************************/ bool Adafruit_PN532::readPassiveTargetID(uint8_t cardbaudrate, uint8_t *uid, uint8_t *uidLength, uint16_t timeout) { - pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET; - pn532_packetbuffer[1] = 1; // max 1 cards at once (we can set this to 2 later) - pn532_packetbuffer[2] = cardbaudrate; + pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET; + pn532_packetbuffer[1] = + 1; // max 1 cards at once (we can set this to 2 later) + pn532_packetbuffer[2] = cardbaudrate; - if (!sendCommandCheckAck(pn532_packetbuffer, 3, timeout)) { + if (!sendCommandCheckAck(pn532_packetbuffer, 3, timeout)) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("No card(s) read")); + PN532DEBUGPRINT.println(F("No card(s) read")); #endif - return 0x0; // no cards read - } + return 0x0; // no cards read + } - return readDetectedPassiveTargetID(uid, uidLength); + return readDetectedPassiveTargetID(uid, uidLength); } /**************************************************************************/ @@ -579,11 +579,12 @@ bool Adafruit_PN532::readPassiveTargetID(uint8_t cardbaudrate, uint8_t *uid, */ /**************************************************************************/ bool Adafruit_PN532::startPassiveTargetIDDetection(uint8_t cardbaudrate) { - pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET; - pn532_packetbuffer[1] = 1; // max 1 cards at once (we can set this to 2 later) - pn532_packetbuffer[2] = cardbaudrate; + pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET; + pn532_packetbuffer[1] = + 1; // max 1 cards at once (we can set this to 2 later) + pn532_packetbuffer[2] = cardbaudrate; - return sendCommandCheckAck(pn532_packetbuffer, 3); + return sendCommandCheckAck(pn532_packetbuffer, 3); } /**************************************************************************/ @@ -600,57 +601,57 @@ bool Adafruit_PN532::startPassiveTargetIDDetection(uint8_t cardbaudrate) { /**************************************************************************/ bool Adafruit_PN532::readDetectedPassiveTargetID(uint8_t *uid, uint8_t *uidLength) { - // read data packet - readdata(pn532_packetbuffer, 20); - // check some basic stuff - - /* ISO14443A card response should be in the following format: - - byte Description - ------------- ------------------------------------------ - b0..6 Frame header and preamble - b7 Tags Found - b8 Tag Number (only one used in this example) - b9..10 SENS_RES - b11 SEL_RES - b12 NFCID Length - b13..NFCIDLen NFCID */ + // read data packet + readdata(pn532_packetbuffer, 20); + // check some basic stuff + + /* ISO14443A card response should be in the following format: + + byte Description + ------------- ------------------------------------------ + b0..6 Frame header and preamble + b7 Tags Found + b8 Tag Number (only one used in this example) + b9..10 SENS_RES + b11 SEL_RES + b12 NFCID Length + b13..NFCIDLen NFCID */ #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Found ")); - PN532DEBUGPRINT.print(pn532_packetbuffer[7], DEC); - PN532DEBUGPRINT.println(F(" tags")); + PN532DEBUGPRINT.print(F("Found ")); + PN532DEBUGPRINT.print(pn532_packetbuffer[7], DEC); + PN532DEBUGPRINT.println(F(" tags")); #endif - if (pn532_packetbuffer[7] != 1) - return 0; + if (pn532_packetbuffer[7] != 1) + return 0; - uint16_t sens_res = pn532_packetbuffer[9]; - sens_res <<= 8; - sens_res |= pn532_packetbuffer[10]; + uint16_t sens_res = pn532_packetbuffer[9]; + sens_res <<= 8; + sens_res |= pn532_packetbuffer[10]; #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("ATQA: 0x")); - PN532DEBUGPRINT.println(sens_res, HEX); - PN532DEBUGPRINT.print(F("SAK: 0x")); - PN532DEBUGPRINT.println(pn532_packetbuffer[11], HEX); + PN532DEBUGPRINT.print(F("ATQA: 0x")); + PN532DEBUGPRINT.println(sens_res, HEX); + PN532DEBUGPRINT.print(F("SAK: 0x")); + PN532DEBUGPRINT.println(pn532_packetbuffer[11], HEX); #endif - /* Card appears to be Mifare Classic */ - *uidLength = pn532_packetbuffer[12]; + /* Card appears to be Mifare Classic */ + *uidLength = pn532_packetbuffer[12]; #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("UID:")); + PN532DEBUGPRINT.print(F("UID:")); #endif - for (uint8_t i = 0; i < pn532_packetbuffer[12]; i++) { - uid[i] = pn532_packetbuffer[13 + i]; + for (uint8_t i = 0; i < pn532_packetbuffer[12]; i++) { + uid[i] = pn532_packetbuffer[13 + i]; #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F(" 0x")); - PN532DEBUGPRINT.print(uid[i], HEX); + PN532DEBUGPRINT.print(F(" 0x")); + PN532DEBUGPRINT.print(uid[i], HEX); #endif - } + } #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(); + PN532DEBUGPRINT.println(); #endif - return 1; + return 1; } /**************************************************************************/ @@ -667,77 +668,77 @@ bool Adafruit_PN532::readDetectedPassiveTargetID(uint8_t *uid, bool Adafruit_PN532::inDataExchange(uint8_t *send, uint8_t sendLength, uint8_t *response, uint8_t *responseLength) { - if (sendLength > PN532_PACKBUFFSIZ - 2) { + if (sendLength > PN532_PACKBUFFSIZ - 2) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("APDU length too long for packet buffer")); + PN532DEBUGPRINT.println(F("APDU length too long for packet buffer")); #endif - return false; - } - uint8_t i; + return false; + } + uint8_t i; - pn532_packetbuffer[0] = 0x40; // PN532_COMMAND_INDATAEXCHANGE; - pn532_packetbuffer[1] = _inListedTag; - for (i = 0; i < sendLength; ++i) { - pn532_packetbuffer[i + 2] = send[i]; - } + pn532_packetbuffer[0] = 0x40; // PN532_COMMAND_INDATAEXCHANGE; + pn532_packetbuffer[1] = _inListedTag; + for (i = 0; i < sendLength; ++i) { + pn532_packetbuffer[i + 2] = send[i]; + } - if (!sendCommandCheckAck(pn532_packetbuffer, sendLength + 2, 1000)) { + if (!sendCommandCheckAck(pn532_packetbuffer, sendLength + 2, 1000)) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Could not send APDU")); + PN532DEBUGPRINT.println(F("Could not send APDU")); #endif - return false; - } + return false; + } - if (!waitready(1000)) { + if (!waitready(1000)) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Response never received for APDU...")); + PN532DEBUGPRINT.println(F("Response never received for APDU...")); #endif - return false; - } + return false; + } - readdata(pn532_packetbuffer, sizeof(pn532_packetbuffer)); + readdata(pn532_packetbuffer, sizeof(pn532_packetbuffer)); - if (pn532_packetbuffer[0] == 0 && pn532_packetbuffer[1] == 0 && - pn532_packetbuffer[2] == 0xff) { - uint8_t length = pn532_packetbuffer[3]; - if (pn532_packetbuffer[4] != (uint8_t)(~length + 1)) { + if (pn532_packetbuffer[0] == 0 && pn532_packetbuffer[1] == 0 && + pn532_packetbuffer[2] == 0xff) { + uint8_t length = pn532_packetbuffer[3]; + if (pn532_packetbuffer[4] != (uint8_t)(~length + 1)) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Length check invalid")); - PN532DEBUGPRINT.println(length, HEX); - PN532DEBUGPRINT.println((~length) + 1, HEX); + PN532DEBUGPRINT.println(F("Length check invalid")); + PN532DEBUGPRINT.println(length, HEX); + PN532DEBUGPRINT.println((~length) + 1, HEX); #endif - return false; - } - if (pn532_packetbuffer[5] == PN532_PN532TOHOST && - pn532_packetbuffer[6] == PN532_RESPONSE_INDATAEXCHANGE) { - if ((pn532_packetbuffer[7] & 0x3f) != 0) { + return false; + } + if (pn532_packetbuffer[5] == PN532_PN532TOHOST && + pn532_packetbuffer[6] == PN532_RESPONSE_INDATAEXCHANGE) { + if ((pn532_packetbuffer[7] & 0x3f) != 0) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Status code indicates an error")); + PN532DEBUGPRINT.println(F("Status code indicates an error")); #endif - return false; - } - - length -= 3; - - if (length > *responseLength) { - length = *responseLength; // silent truncation... - } - - for (i = 0; i < length; ++i) { - response[i] = pn532_packetbuffer[8 + i]; - } - *responseLength = length; - - return true; + return false; + } + + length -= 3; + + if (length > *responseLength) { + length = *responseLength; // silent truncation... + } + + for (i = 0; i < length; ++i) { + response[i] = pn532_packetbuffer[8 + i]; + } + *responseLength = length; + + return true; + } else { + PN532DEBUGPRINT.print(F("Don't know how to handle this command: ")); + PN532DEBUGPRINT.println(pn532_packetbuffer[6], HEX); + return false; + } } else { - PN532DEBUGPRINT.print(F("Don't know how to handle this command: ")); - PN532DEBUGPRINT.println(pn532_packetbuffer[6], HEX); - return false; + PN532DEBUGPRINT.println(F("Preamble missing")); + return false; } - } else { - PN532DEBUGPRINT.println(F("Preamble missing")); - return false; - } } /**************************************************************************/ @@ -748,68 +749,70 @@ bool Adafruit_PN532::inDataExchange(uint8_t *send, uint8_t sendLength, */ /**************************************************************************/ bool Adafruit_PN532::inListPassiveTarget() { - pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET; - pn532_packetbuffer[1] = 1; - pn532_packetbuffer[2] = 0; + pn532_packetbuffer[0] = PN532_COMMAND_INLISTPASSIVETARGET; + pn532_packetbuffer[1] = 1; + pn532_packetbuffer[2] = 0; #ifdef PN532DEBUG - PN532DEBUGPRINT.print(F("About to inList passive target")); + PN532DEBUGPRINT.print(F("About to inList passive target")); #endif - if (!sendCommandCheckAck(pn532_packetbuffer, 3, 1000)) { + if (!sendCommandCheckAck(pn532_packetbuffer, 3, 1000)) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Could not send inlist message")); + PN532DEBUGPRINT.println(F("Could not send inlist message")); #endif - return false; - } + return false; + } - if (!waitready(30000)) { - return false; - } + if (!waitready(30000)) { + return false; + } - readdata(pn532_packetbuffer, sizeof(pn532_packetbuffer)); + readdata(pn532_packetbuffer, sizeof(pn532_packetbuffer)); - if (pn532_packetbuffer[0] == 0 && pn532_packetbuffer[1] == 0 && - pn532_packetbuffer[2] == 0xff) { - uint8_t length = pn532_packetbuffer[3]; - if (pn532_packetbuffer[4] != (uint8_t)(~length + 1)) { + if (pn532_packetbuffer[0] == 0 && pn532_packetbuffer[1] == 0 && + pn532_packetbuffer[2] == 0xff) { + uint8_t length = pn532_packetbuffer[3]; + if (pn532_packetbuffer[4] != (uint8_t)(~length + 1)) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Length check invalid")); - PN532DEBUGPRINT.println(length, HEX); - PN532DEBUGPRINT.println((~length) + 1, HEX); + PN532DEBUGPRINT.println(F("Length check invalid")); + PN532DEBUGPRINT.println(length, HEX); + PN532DEBUGPRINT.println((~length) + 1, HEX); #endif - return false; - } - if (pn532_packetbuffer[5] == PN532_PN532TOHOST && - pn532_packetbuffer[6] == PN532_RESPONSE_INLISTPASSIVETARGET) { - if (pn532_packetbuffer[7] != 1) { + return false; + } + if (pn532_packetbuffer[5] == PN532_PN532TOHOST && + pn532_packetbuffer[6] == PN532_RESPONSE_INLISTPASSIVETARGET) { + if (pn532_packetbuffer[7] != 1) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Unhandled number of targets inlisted")); + PN532DEBUGPRINT.println( + F("Unhandled number of targets inlisted")); #endif - PN532DEBUGPRINT.println(F("Number of tags inlisted:")); - PN532DEBUGPRINT.println(pn532_packetbuffer[7]); - return false; - } + PN532DEBUGPRINT.println(F("Number of tags inlisted:")); + PN532DEBUGPRINT.println(pn532_packetbuffer[7]); + return false; + } - _inListedTag = pn532_packetbuffer[8]; - PN532DEBUGPRINT.print(F("Tag number: ")); - PN532DEBUGPRINT.println(_inListedTag); + _inListedTag = pn532_packetbuffer[8]; + PN532DEBUGPRINT.print(F("Tag number: ")); + PN532DEBUGPRINT.println(_inListedTag); - return true; - } else { + return true; + } else { #ifdef PN532DEBUG - PN532DEBUGPRINT.print(F("Unexpected response to inlist passive host")); + PN532DEBUGPRINT.print( + F("Unexpected response to inlist passive host")); #endif - return false; - } - } else { + return false; + } + } else { #ifdef PN532DEBUG - PN532DEBUGPRINT.println(F("Preamble missing")); + PN532DEBUGPRINT.println(F("Preamble missing")); #endif - return false; - } + return false; + } - return true; + return true; } /***** Mifare Classic Functions ******/ @@ -823,11 +826,11 @@ bool Adafruit_PN532::inListPassiveTarget() { */ /**************************************************************************/ bool Adafruit_PN532::mifareclassic_IsFirstBlock(uint32_t uiBlock) { - // Test if we are in the small or big sectors - if (uiBlock < 128) - return ((uiBlock) % 4 == 0); - else - return ((uiBlock) % 16 == 0); + // Test if we are in the small or big sectors + if (uiBlock < 128) + return ((uiBlock) % 4 == 0); + else + return ((uiBlock) % 16 == 0); } /**************************************************************************/ @@ -839,11 +842,11 @@ bool Adafruit_PN532::mifareclassic_IsFirstBlock(uint32_t uiBlock) { */ /**************************************************************************/ bool Adafruit_PN532::mifareclassic_IsTrailerBlock(uint32_t uiBlock) { - // Test if we are in the small or big sectors - if (uiBlock < 128) - return ((uiBlock + 1) % 4 == 0); - else - return ((uiBlock + 1) % 16 == 0); + // Test if we are in the small or big sectors + if (uiBlock < 128) + return ((uiBlock + 1) % 4 == 0); + else + return ((uiBlock + 1) % 16 == 0); } /**************************************************************************/ @@ -870,54 +873,54 @@ uint8_t Adafruit_PN532::mifareclassic_AuthenticateBlock(uint8_t *uid, uint32_t blockNumber, uint8_t keyNumber, uint8_t *keyData) { - // uint8_t len; - uint8_t i; + // uint8_t len; + uint8_t i; - // Hang on to the key and uid data - memcpy(_key, keyData, 6); - memcpy(_uid, uid, uidLen); - _uidLen = uidLen; + // Hang on to the key and uid data + memcpy(_key, keyData, 6); + memcpy(_uid, uid, uidLen); + _uidLen = uidLen; #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Trying to authenticate card ")); - Adafruit_PN532::PrintHex(_uid, _uidLen); - PN532DEBUGPRINT.print(F("Using authentication KEY ")); - PN532DEBUGPRINT.print(keyNumber ? 'B' : 'A'); - PN532DEBUGPRINT.print(F(": ")); - Adafruit_PN532::PrintHex(_key, 6); + PN532DEBUGPRINT.print(F("Trying to authenticate card ")); + Adafruit_PN532::PrintHex(_uid, _uidLen); + PN532DEBUGPRINT.print(F("Using authentication KEY ")); + PN532DEBUGPRINT.print(keyNumber ? 'B' : 'A'); + PN532DEBUGPRINT.print(F(": ")); + Adafruit_PN532::PrintHex(_key, 6); #endif - // Prepare the authentication command // - pn532_packetbuffer[0] = - PN532_COMMAND_INDATAEXCHANGE; /* Data Exchange Header */ - pn532_packetbuffer[1] = 1; /* Max card numbers */ - pn532_packetbuffer[2] = (keyNumber) ? MIFARE_CMD_AUTH_B : MIFARE_CMD_AUTH_A; - pn532_packetbuffer[3] = - blockNumber; /* Block Number (1K = 0..63, 4K = 0..255 */ - memcpy(pn532_packetbuffer + 4, _key, 6); - for (i = 0; i < _uidLen; i++) { - pn532_packetbuffer[10 + i] = _uid[i]; /* 4 byte card ID */ - } - - if (!sendCommandCheckAck(pn532_packetbuffer, 10 + _uidLen)) - return 0; - - // Read the response packet - readdata(pn532_packetbuffer, 12); - - // check if the response is valid and we are authenticated??? - // for an auth success it should be bytes 5-7: 0xD5 0x41 0x00 - // Mifare auth error is technically byte 7: 0x14 but anything other and 0x00 - // is not good - if (pn532_packetbuffer[7] != 0x00) { + // Prepare the authentication command // + pn532_packetbuffer[0] = + PN532_COMMAND_INDATAEXCHANGE; /* Data Exchange Header */ + pn532_packetbuffer[1] = 1; /* Max card numbers */ + pn532_packetbuffer[2] = (keyNumber) ? MIFARE_CMD_AUTH_B : MIFARE_CMD_AUTH_A; + pn532_packetbuffer[3] = + blockNumber; /* Block Number (1K = 0..63, 4K = 0..255 */ + memcpy(pn532_packetbuffer + 4, _key, 6); + for (i = 0; i < _uidLen; i++) { + pn532_packetbuffer[10 + i] = _uid[i]; /* 4 byte card ID */ + } + + if (!sendCommandCheckAck(pn532_packetbuffer, 10 + _uidLen)) + return 0; + + // Read the response packet + readdata(pn532_packetbuffer, 12); + + // check if the response is valid and we are authenticated??? + // for an auth success it should be bytes 5-7: 0xD5 0x41 0x00 + // Mifare auth error is technically byte 7: 0x14 but anything other and 0x00 + // is not good + if (pn532_packetbuffer[7] != 0x00) { #ifdef PN532DEBUG - PN532DEBUGPRINT.print(F("Authentification failed: ")); - Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 12); + PN532DEBUGPRINT.print(F("Authentification failed: ")); + Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 12); #endif - return 0; - } + return 0; + } - return 1; + return 1; } /**************************************************************************/ @@ -936,49 +939,49 @@ uint8_t Adafruit_PN532::mifareclassic_AuthenticateBlock(uint8_t *uid, uint8_t Adafruit_PN532::mifareclassic_ReadDataBlock(uint8_t blockNumber, uint8_t *data) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Trying to read 16 bytes from block ")); - PN532DEBUGPRINT.println(blockNumber); + PN532DEBUGPRINT.print(F("Trying to read 16 bytes from block ")); + PN532DEBUGPRINT.println(blockNumber); #endif - /* Prepare the command */ - pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; - pn532_packetbuffer[1] = 1; /* Card number */ - pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */ - pn532_packetbuffer[3] = - blockNumber; /* Block Number (0..63 for 1K, 0..255 for 4K) */ + /* Prepare the command */ + pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; + pn532_packetbuffer[1] = 1; /* Card number */ + pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */ + pn532_packetbuffer[3] = + blockNumber; /* Block Number (0..63 for 1K, 0..255 for 4K) */ - /* Send the command */ - if (!sendCommandCheckAck(pn532_packetbuffer, 4)) { + /* Send the command */ + if (!sendCommandCheckAck(pn532_packetbuffer, 4)) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Failed to receive ACK for read command")); + PN532DEBUGPRINT.println(F("Failed to receive ACK for read command")); #endif - return 0; - } + return 0; + } - /* Read the response packet */ - readdata(pn532_packetbuffer, 26); + /* Read the response packet */ + readdata(pn532_packetbuffer, 26); - /* If byte 8 isn't 0x00 we probably have an error */ - if (pn532_packetbuffer[7] != 0x00) { + /* If byte 8 isn't 0x00 we probably have an error */ + if (pn532_packetbuffer[7] != 0x00) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Unexpected response")); - Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); + PN532DEBUGPRINT.println(F("Unexpected response")); + Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); #endif - return 0; - } + return 0; + } - /* Copy the 16 data bytes to the output buffer */ - /* Block content starts at byte 9 of a valid response */ - memcpy(data, pn532_packetbuffer + 8, 16); + /* Copy the 16 data bytes to the output buffer */ + /* Block content starts at byte 9 of a valid response */ + memcpy(data, pn532_packetbuffer + 8, 16); /* Display data for debug if requested */ #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Block ")); - PN532DEBUGPRINT.println(blockNumber); - Adafruit_PN532::PrintHexChar(data, 16); + PN532DEBUGPRINT.print(F("Block ")); + PN532DEBUGPRINT.println(blockNumber); + Adafruit_PN532::PrintHexChar(data, 16); #endif - return 1; + return 1; } /**************************************************************************/ @@ -996,31 +999,31 @@ uint8_t Adafruit_PN532::mifareclassic_ReadDataBlock(uint8_t blockNumber, uint8_t Adafruit_PN532::mifareclassic_WriteDataBlock(uint8_t blockNumber, uint8_t *data) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Trying to write 16 bytes to block ")); - PN532DEBUGPRINT.println(blockNumber); + PN532DEBUGPRINT.print(F("Trying to write 16 bytes to block ")); + PN532DEBUGPRINT.println(blockNumber); #endif - /* Prepare the first command */ - pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; - pn532_packetbuffer[1] = 1; /* Card number */ - pn532_packetbuffer[2] = MIFARE_CMD_WRITE; /* Mifare Write command = 0xA0 */ - pn532_packetbuffer[3] = - blockNumber; /* Block Number (0..63 for 1K, 0..255 for 4K) */ - memcpy(pn532_packetbuffer + 4, data, 16); /* Data Payload */ + /* Prepare the first command */ + pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; + pn532_packetbuffer[1] = 1; /* Card number */ + pn532_packetbuffer[2] = MIFARE_CMD_WRITE; /* Mifare Write command = 0xA0 */ + pn532_packetbuffer[3] = + blockNumber; /* Block Number (0..63 for 1K, 0..255 for 4K) */ + memcpy(pn532_packetbuffer + 4, data, 16); /* Data Payload */ - /* Send the command */ - if (!sendCommandCheckAck(pn532_packetbuffer, 20)) { + /* Send the command */ + if (!sendCommandCheckAck(pn532_packetbuffer, 20)) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); + PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); #endif - return 0; - } - delay(10); + return 0; + } + delay(10); - /* Read the response packet */ - readdata(pn532_packetbuffer, 26); + /* Read the response packet */ + readdata(pn532_packetbuffer, 26); - return 1; + return 1; } /**************************************************************************/ @@ -1031,27 +1034,30 @@ uint8_t Adafruit_PN532::mifareclassic_WriteDataBlock(uint8_t blockNumber, */ /**************************************************************************/ uint8_t Adafruit_PN532::mifareclassic_FormatNDEF(void) { - uint8_t sectorbuffer1[16] = {0x14, 0x01, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, - 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1}; - uint8_t sectorbuffer2[16] = {0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, - 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1}; - uint8_t sectorbuffer3[16] = {0xA0, 0xA1, 0xA2, 0xA3, 0xA4, 0xA5, 0x78, 0x77, - 0x88, 0xC1, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF}; - - // Note 0xA0 0xA1 0xA2 0xA3 0xA4 0xA5 must be used for key A - // for the MAD sector in NDEF records (sector 0) - - // Write block 1 and 2 to the card - if (!(mifareclassic_WriteDataBlock(1, sectorbuffer1))) - return 0; - if (!(mifareclassic_WriteDataBlock(2, sectorbuffer2))) - return 0; - // Write key A and access rights card - if (!(mifareclassic_WriteDataBlock(3, sectorbuffer3))) - return 0; - - // Seems that everything was OK (?!) - return 1; + uint8_t sectorbuffer1[16] = {0x14, 0x01, 0x03, 0xE1, 0x03, 0xE1, + 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, + 0x03, 0xE1, 0x03, 0xE1}; + uint8_t sectorbuffer2[16] = {0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, + 0x03, 0xE1, 0x03, 0xE1, 0x03, 0xE1, + 0x03, 0xE1, 0x03, 0xE1}; + uint8_t sectorbuffer3[16] = {0xA0, 0xA1, 0xA2, 0xA3, 0xA4, 0xA5, + 0x78, 0x77, 0x88, 0xC1, 0xFF, 0xFF, + 0xFF, 0xFF, 0xFF, 0xFF}; + + // Note 0xA0 0xA1 0xA2 0xA3 0xA4 0xA5 must be used for key A + // for the MAD sector in NDEF records (sector 0) + + // Write block 1 and 2 to the card + if (!(mifareclassic_WriteDataBlock(1, sectorbuffer1))) + return 0; + if (!(mifareclassic_WriteDataBlock(2, sectorbuffer2))) + return 0; + // Write key A and access rights card + if (!(mifareclassic_WriteDataBlock(3, sectorbuffer3))) + return 0; + + // Seems that everything was OK (?!) + return 1; } /**************************************************************************/ @@ -1075,81 +1081,84 @@ uint8_t Adafruit_PN532::mifareclassic_FormatNDEF(void) { uint8_t Adafruit_PN532::mifareclassic_WriteNDEFURI(uint8_t sectorNumber, uint8_t uriIdentifier, const char *url) { - // Figure out how long the string is - uint8_t len = strlen(url); - - // Make sure we're within a 1K limit for the sector number - if ((sectorNumber < 1) || (sectorNumber > 15)) - return 0; - - // Make sure the URI payload is between 1 and 38 chars - if ((len < 1) || (len > 38)) - return 0; - - // Note 0xD3 0xF7 0xD3 0xF7 0xD3 0xF7 must be used for key A - // in NDEF records - - // Setup the sector buffer (w/pre-formatted TLV wrapper and NDEF message) - uint8_t sectorbuffer1[16] = {0x00, - 0x00, - 0x03, - (uint8_t)(len + 5), - 0xD1, - 0x01, - (uint8_t)(len + 1), - 0x55, - uriIdentifier, - 0x00, - 0x00, - 0x00, - 0x00, - 0x00, - 0x00, - 0x00}; - uint8_t sectorbuffer2[16] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; - uint8_t sectorbuffer3[16] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; - uint8_t sectorbuffer4[16] = {0xD3, 0xF7, 0xD3, 0xF7, 0xD3, 0xF7, 0x7F, 0x07, - 0x88, 0x40, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF}; - if (len <= 6) { - // Unlikely we'll get a url this short, but why not ... - memcpy(sectorbuffer1 + 9, url, len); - sectorbuffer1[len + 9] = 0xFE; - } else if (len == 7) { - // 0xFE needs to be wrapped around to next block - memcpy(sectorbuffer1 + 9, url, len); - sectorbuffer2[0] = 0xFE; - } else if ((len > 7) && (len <= 22)) { - // Url fits in two blocks - memcpy(sectorbuffer1 + 9, url, 7); - memcpy(sectorbuffer2, url + 7, len - 7); - sectorbuffer2[len - 7] = 0xFE; - } else if (len == 23) { - // 0xFE needs to be wrapped around to final block - memcpy(sectorbuffer1 + 9, url, 7); - memcpy(sectorbuffer2, url + 7, len - 7); - sectorbuffer3[0] = 0xFE; - } else { - // Url fits in three blocks - memcpy(sectorbuffer1 + 9, url, 7); - memcpy(sectorbuffer2, url + 7, 16); - memcpy(sectorbuffer3, url + 23, len - 24); - sectorbuffer3[len - 22] = 0xFE; - } - - // Now write all three blocks back to the card - if (!(mifareclassic_WriteDataBlock(sectorNumber * 4, sectorbuffer1))) - return 0; - if (!(mifareclassic_WriteDataBlock((sectorNumber * 4) + 1, sectorbuffer2))) - return 0; - if (!(mifareclassic_WriteDataBlock((sectorNumber * 4) + 2, sectorbuffer3))) - return 0; - if (!(mifareclassic_WriteDataBlock((sectorNumber * 4) + 3, sectorbuffer4))) - return 0; - - // Seems that everything was OK (?!) - return 1; + // Figure out how long the string is + uint8_t len = strlen(url); + + // Make sure we're within a 1K limit for the sector number + if ((sectorNumber < 1) || (sectorNumber > 15)) + return 0; + + // Make sure the URI payload is between 1 and 38 chars + if ((len < 1) || (len > 38)) + return 0; + + // Note 0xD3 0xF7 0xD3 0xF7 0xD3 0xF7 must be used for key A + // in NDEF records + + // Setup the sector buffer (w/pre-formatted TLV wrapper and NDEF message) + uint8_t sectorbuffer1[16] = {0x00, + 0x00, + 0x03, + (uint8_t)(len + 5), + 0xD1, + 0x01, + (uint8_t)(len + 1), + 0x55, + uriIdentifier, + 0x00, + 0x00, + 0x00, + 0x00, + 0x00, + 0x00, + 0x00}; + uint8_t sectorbuffer2[16] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00}; + uint8_t sectorbuffer3[16] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00}; + uint8_t sectorbuffer4[16] = {0xD3, 0xF7, 0xD3, 0xF7, 0xD3, 0xF7, + 0x7F, 0x07, 0x88, 0x40, 0xFF, 0xFF, + 0xFF, 0xFF, 0xFF, 0xFF}; + if (len <= 6) { + // Unlikely we'll get a url this short, but why not ... + memcpy(sectorbuffer1 + 9, url, len); + sectorbuffer1[len + 9] = 0xFE; + } else if (len == 7) { + // 0xFE needs to be wrapped around to next block + memcpy(sectorbuffer1 + 9, url, len); + sectorbuffer2[0] = 0xFE; + } else if ((len > 7) && (len <= 22)) { + // Url fits in two blocks + memcpy(sectorbuffer1 + 9, url, 7); + memcpy(sectorbuffer2, url + 7, len - 7); + sectorbuffer2[len - 7] = 0xFE; + } else if (len == 23) { + // 0xFE needs to be wrapped around to final block + memcpy(sectorbuffer1 + 9, url, 7); + memcpy(sectorbuffer2, url + 7, len - 7); + sectorbuffer3[0] = 0xFE; + } else { + // Url fits in three blocks + memcpy(sectorbuffer1 + 9, url, 7); + memcpy(sectorbuffer2, url + 7, 16); + memcpy(sectorbuffer3, url + 23, len - 24); + sectorbuffer3[len - 22] = 0xFE; + } + + // Now write all three blocks back to the card + if (!(mifareclassic_WriteDataBlock(sectorNumber * 4, sectorbuffer1))) + return 0; + if (!(mifareclassic_WriteDataBlock((sectorNumber * 4) + 1, sectorbuffer2))) + return 0; + if (!(mifareclassic_WriteDataBlock((sectorNumber * 4) + 2, sectorbuffer3))) + return 0; + if (!(mifareclassic_WriteDataBlock((sectorNumber * 4) + 3, sectorbuffer4))) + return 0; + + // Seems that everything was OK (?!) + return 1; } /***** Mifare Ultralight Functions ******/ @@ -1166,65 +1175,65 @@ uint8_t Adafruit_PN532::mifareclassic_WriteNDEFURI(uint8_t sectorNumber, /**************************************************************************/ uint8_t Adafruit_PN532::mifareultralight_ReadPage(uint8_t page, uint8_t *buffer) { - if (page >= 64) { + if (page >= 64) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Page value out of range")); + PN532DEBUGPRINT.println(F("Page value out of range")); #endif - return 0; - } + return 0; + } #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Reading page ")); - PN532DEBUGPRINT.println(page); + PN532DEBUGPRINT.print(F("Reading page ")); + PN532DEBUGPRINT.println(page); #endif - /* Prepare the command */ - pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; - pn532_packetbuffer[1] = 1; /* Card number */ - pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */ - pn532_packetbuffer[3] = page; /* Page Number (0..63 in most cases) */ + /* Prepare the command */ + pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; + pn532_packetbuffer[1] = 1; /* Card number */ + pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */ + pn532_packetbuffer[3] = page; /* Page Number (0..63 in most cases) */ - /* Send the command */ - if (!sendCommandCheckAck(pn532_packetbuffer, 4)) { + /* Send the command */ + if (!sendCommandCheckAck(pn532_packetbuffer, 4)) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); + PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); #endif - return 0; - } + return 0; + } - /* Read the response packet */ - readdata(pn532_packetbuffer, 26); + /* Read the response packet */ + readdata(pn532_packetbuffer, 26); #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Received: ")); - Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); + PN532DEBUGPRINT.println(F("Received: ")); + Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); #endif - /* If byte 8 isn't 0x00 we probably have an error */ - if (pn532_packetbuffer[7] == 0x00) { - /* Copy the 4 data bytes to the output buffer */ - /* Block content starts at byte 9 of a valid response */ - /* Note that the command actually reads 16 byte or 4 */ - /* pages at a time ... we simply discard the last 12 */ - /* bytes */ - memcpy(buffer, pn532_packetbuffer + 8, 4); - } else { + /* If byte 8 isn't 0x00 we probably have an error */ + if (pn532_packetbuffer[7] == 0x00) { + /* Copy the 4 data bytes to the output buffer */ + /* Block content starts at byte 9 of a valid response */ + /* Note that the command actually reads 16 byte or 4 */ + /* pages at a time ... we simply discard the last 12 */ + /* bytes */ + memcpy(buffer, pn532_packetbuffer + 8, 4); + } else { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Unexpected response reading block: ")); - Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); + PN532DEBUGPRINT.println(F("Unexpected response reading block: ")); + Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); #endif - return 0; - } + return 0; + } /* Display data for debug if requested */ #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Page ")); - PN532DEBUGPRINT.print(page); - PN532DEBUGPRINT.println(F(":")); - Adafruit_PN532::PrintHexChar(buffer, 4); + PN532DEBUGPRINT.print(F("Page ")); + PN532DEBUGPRINT.print(page); + PN532DEBUGPRINT.println(F(":")); + Adafruit_PN532::PrintHexChar(buffer, 4); #endif - // Return OK signal - return 1; + // Return OK signal + return 1; } /**************************************************************************/ @@ -1242,43 +1251,44 @@ uint8_t Adafruit_PN532::mifareultralight_ReadPage(uint8_t page, uint8_t Adafruit_PN532::mifareultralight_WritePage(uint8_t page, uint8_t *data) { - if (page >= 64) { + if (page >= 64) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Page value out of range")); + PN532DEBUGPRINT.println(F("Page value out of range")); #endif - // Return Failed Signal - return 0; - } + // Return Failed Signal + return 0; + } #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Trying to write 4 byte page")); - PN532DEBUGPRINT.println(page); + PN532DEBUGPRINT.print(F("Trying to write 4 byte page")); + PN532DEBUGPRINT.println(page); #endif - /* Prepare the first command */ - pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; - pn532_packetbuffer[1] = 1; /* Card number */ - pn532_packetbuffer[2] = - MIFARE_ULTRALIGHT_CMD_WRITE; /* Mifare Ultralight Write command = 0xA2 */ - pn532_packetbuffer[3] = page; /* Page Number (0..63 for most cases) */ - memcpy(pn532_packetbuffer + 4, data, 4); /* Data Payload */ - - /* Send the command */ - if (!sendCommandCheckAck(pn532_packetbuffer, 8)) { + /* Prepare the first command */ + pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; + pn532_packetbuffer[1] = 1; /* Card number */ + pn532_packetbuffer[2] = + MIFARE_ULTRALIGHT_CMD_WRITE; /* Mifare Ultralight Write command = 0xA2 + */ + pn532_packetbuffer[3] = page; /* Page Number (0..63 for most cases) */ + memcpy(pn532_packetbuffer + 4, data, 4); /* Data Payload */ + + /* Send the command */ + if (!sendCommandCheckAck(pn532_packetbuffer, 8)) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); + PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); #endif - // Return Failed Signal - return 0; - } - delay(10); + // Return Failed Signal + return 0; + } + delay(10); - /* Read the response packet */ - readdata(pn532_packetbuffer, 26); + /* Read the response packet */ + readdata(pn532_packetbuffer, 26); - // Return OK Signal - return 1; + // Return OK Signal + return 1; } /***** NTAG2xx Functions ******/ @@ -1294,72 +1304,72 @@ uint8_t Adafruit_PN532::mifareultralight_WritePage(uint8_t page, */ /**************************************************************************/ uint8_t Adafruit_PN532::ntag2xx_ReadPage(uint8_t page, uint8_t *buffer) { - // TAG Type PAGES USER START USER STOP - // -------- ----- ---------- --------- - // NTAG 203 42 4 39 - // NTAG 213 45 4 39 - // NTAG 215 135 4 129 - // NTAG 216 231 4 225 - - if (page >= 231) { + // TAG Type PAGES USER START USER STOP + // -------- ----- ---------- --------- + // NTAG 203 42 4 39 + // NTAG 213 45 4 39 + // NTAG 215 135 4 129 + // NTAG 216 231 4 225 + + if (page >= 231) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Page value out of range")); + PN532DEBUGPRINT.println(F("Page value out of range")); #endif - return 0; - } + return 0; + } #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Reading page ")); - PN532DEBUGPRINT.println(page); + PN532DEBUGPRINT.print(F("Reading page ")); + PN532DEBUGPRINT.println(page); #endif - /* Prepare the command */ - pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; - pn532_packetbuffer[1] = 1; /* Card number */ - pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */ - pn532_packetbuffer[3] = page; /* Page Number (0..63 in most cases) */ + /* Prepare the command */ + pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; + pn532_packetbuffer[1] = 1; /* Card number */ + pn532_packetbuffer[2] = MIFARE_CMD_READ; /* Mifare Read command = 0x30 */ + pn532_packetbuffer[3] = page; /* Page Number (0..63 in most cases) */ - /* Send the command */ - if (!sendCommandCheckAck(pn532_packetbuffer, 4)) { + /* Send the command */ + if (!sendCommandCheckAck(pn532_packetbuffer, 4)) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); + PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); #endif - return 0; - } + return 0; + } - /* Read the response packet */ - readdata(pn532_packetbuffer, 26); + /* Read the response packet */ + readdata(pn532_packetbuffer, 26); #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Received: ")); - Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); + PN532DEBUGPRINT.println(F("Received: ")); + Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); #endif - /* If byte 8 isn't 0x00 we probably have an error */ - if (pn532_packetbuffer[7] == 0x00) { - /* Copy the 4 data bytes to the output buffer */ - /* Block content starts at byte 9 of a valid response */ - /* Note that the command actually reads 16 byte or 4 */ - /* pages at a time ... we simply discard the last 12 */ - /* bytes */ - memcpy(buffer, pn532_packetbuffer + 8, 4); - } else { + /* If byte 8 isn't 0x00 we probably have an error */ + if (pn532_packetbuffer[7] == 0x00) { + /* Copy the 4 data bytes to the output buffer */ + /* Block content starts at byte 9 of a valid response */ + /* Note that the command actually reads 16 byte or 4 */ + /* pages at a time ... we simply discard the last 12 */ + /* bytes */ + memcpy(buffer, pn532_packetbuffer + 8, 4); + } else { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Unexpected response reading block: ")); - Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); + PN532DEBUGPRINT.println(F("Unexpected response reading block: ")); + Adafruit_PN532::PrintHexChar(pn532_packetbuffer, 26); #endif - return 0; - } + return 0; + } /* Display data for debug if requested */ #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Page ")); - PN532DEBUGPRINT.print(page); - PN532DEBUGPRINT.println(F(":")); - Adafruit_PN532::PrintHexChar(buffer, 4); + PN532DEBUGPRINT.print(F("Page ")); + PN532DEBUGPRINT.print(page); + PN532DEBUGPRINT.println(F(":")); + Adafruit_PN532::PrintHexChar(buffer, 4); #endif - // Return OK signal - return 1; + // Return OK signal + return 1; } /**************************************************************************/ @@ -1375,50 +1385,51 @@ uint8_t Adafruit_PN532::ntag2xx_ReadPage(uint8_t page, uint8_t *buffer) { */ /**************************************************************************/ uint8_t Adafruit_PN532::ntag2xx_WritePage(uint8_t page, uint8_t *data) { - // TAG Type PAGES USER START USER STOP - // -------- ----- ---------- --------- - // NTAG 203 42 4 39 - // NTAG 213 45 4 39 - // NTAG 215 135 4 129 - // NTAG 216 231 4 225 - - if ((page < 4) || (page > 225)) { + // TAG Type PAGES USER START USER STOP + // -------- ----- ---------- --------- + // NTAG 203 42 4 39 + // NTAG 213 45 4 39 + // NTAG 215 135 4 129 + // NTAG 216 231 4 225 + + if ((page < 4) || (page > 225)) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Page value out of range")); + PN532DEBUGPRINT.println(F("Page value out of range")); #endif - // Return Failed Signal - return 0; - } + // Return Failed Signal + return 0; + } #ifdef MIFAREDEBUG - PN532DEBUGPRINT.print(F("Trying to write 4 byte page")); - PN532DEBUGPRINT.println(page); + PN532DEBUGPRINT.print(F("Trying to write 4 byte page")); + PN532DEBUGPRINT.println(page); #endif - /* Prepare the first command */ - pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; - pn532_packetbuffer[1] = 1; /* Card number */ - pn532_packetbuffer[2] = - MIFARE_ULTRALIGHT_CMD_WRITE; /* Mifare Ultralight Write command = 0xA2 */ - pn532_packetbuffer[3] = page; /* Page Number (0..63 for most cases) */ - memcpy(pn532_packetbuffer + 4, data, 4); /* Data Payload */ - - /* Send the command */ - if (!sendCommandCheckAck(pn532_packetbuffer, 8)) { + /* Prepare the first command */ + pn532_packetbuffer[0] = PN532_COMMAND_INDATAEXCHANGE; + pn532_packetbuffer[1] = 1; /* Card number */ + pn532_packetbuffer[2] = + MIFARE_ULTRALIGHT_CMD_WRITE; /* Mifare Ultralight Write command = 0xA2 + */ + pn532_packetbuffer[3] = page; /* Page Number (0..63 for most cases) */ + memcpy(pn532_packetbuffer + 4, data, 4); /* Data Payload */ + + /* Send the command */ + if (!sendCommandCheckAck(pn532_packetbuffer, 8)) { #ifdef MIFAREDEBUG - PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); + PN532DEBUGPRINT.println(F("Failed to receive ACK for write command")); #endif - // Return Failed Signal - return 0; - } - delay(10); + // Return Failed Signal + return 0; + } + delay(10); - /* Read the response packet */ - readdata(pn532_packetbuffer, 26); + /* Read the response packet */ + readdata(pn532_packetbuffer, 26); - // Return OK Signal - return 1; + // Return OK Signal + return 1; } /**************************************************************************/ @@ -1438,86 +1449,87 @@ uint8_t Adafruit_PN532::ntag2xx_WritePage(uint8_t page, uint8_t *data) { /**************************************************************************/ uint8_t Adafruit_PN532::ntag2xx_WriteNDEFURI(uint8_t uriIdentifier, char *url, uint8_t dataLen) { - uint8_t pageBuffer[4] = {0, 0, 0, 0}; - - // Remove NDEF record overhead from the URI data (pageHeader below) - uint8_t wrapperSize = 12; - - // Figure out how long the string is - uint8_t len = strlen(url); - - // Make sure the URI payload will fit in dataLen (include 0xFE trailer) - if ((len < 1) || (len + 1 > (dataLen - wrapperSize))) - return 0; - - // Setup the record header - // See NFCForum-TS-Type-2-Tag_1.1.pdf for details - uint8_t pageHeader[12] = { - /* NDEF Lock Control TLV (must be first and always present) */ - 0x01, /* Tag Field (0x01 = Lock Control TLV) */ - 0x03, /* Payload Length (always 3) */ - 0xA0, /* The position inside the tag of the lock bytes (upper 4 = page - address, lower 4 = byte offset) */ - 0x10, /* Size in bits of the lock area */ - 0x44, /* Size in bytes of a page and the number of bytes each lock bit can - lock (4 bit + 4 bits) */ - /* NDEF Message TLV - URI Record */ - 0x03, /* Tag Field (0x03 = NDEF Message) */ - (uint8_t)(len + 5), /* Payload Length (not including 0xFE trailer) */ - 0xD1, /* NDEF Record Header (TNF=0x1:Well known record + SR + ME + MB) */ - 0x01, /* Type Length for the record type indicator */ - (uint8_t)(len + 1), /* Payload len */ - 0x55, /* Record Type Indicator (0x55 or 'U' = URI Record) */ - uriIdentifier /* URI Prefix (ex. 0x01 = "http://www.") */ - }; - - // Write 12 byte header (three pages of data starting at page 4) - memcpy(pageBuffer, pageHeader, 4); - if (!(ntag2xx_WritePage(4, pageBuffer))) - return 0; - memcpy(pageBuffer, pageHeader + 4, 4); - if (!(ntag2xx_WritePage(5, pageBuffer))) - return 0; - memcpy(pageBuffer, pageHeader + 8, 4); - if (!(ntag2xx_WritePage(6, pageBuffer))) - return 0; - - // Write URI (starting at page 7) - uint8_t currentPage = 7; - char *urlcopy = url; - while (len) { - if (len < 4) { - memset(pageBuffer, 0, 4); - memcpy(pageBuffer, urlcopy, len); - pageBuffer[len] = 0xFE; // NDEF record footer - if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + uint8_t pageBuffer[4] = {0, 0, 0, 0}; + + // Remove NDEF record overhead from the URI data (pageHeader below) + uint8_t wrapperSize = 12; + + // Figure out how long the string is + uint8_t len = strlen(url); + + // Make sure the URI payload will fit in dataLen (include 0xFE trailer) + if ((len < 1) || (len + 1 > (dataLen - wrapperSize))) return 0; - // DONE! - return 1; - } else if (len == 4) { - memcpy(pageBuffer, urlcopy, len); - if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + + // Setup the record header + // See NFCForum-TS-Type-2-Tag_1.1.pdf for details + uint8_t pageHeader[12] = { + /* NDEF Lock Control TLV (must be first and always present) */ + 0x01, /* Tag Field (0x01 = Lock Control TLV) */ + 0x03, /* Payload Length (always 3) */ + 0xA0, /* The position inside the tag of the lock bytes (upper 4 = page + address, lower 4 = byte offset) */ + 0x10, /* Size in bits of the lock area */ + 0x44, /* Size in bytes of a page and the number of bytes each lock bit + can lock (4 bit + 4 bits) */ + /* NDEF Message TLV - URI Record */ + 0x03, /* Tag Field (0x03 = NDEF Message) */ + (uint8_t)(len + 5), /* Payload Length (not including 0xFE trailer) */ + 0xD1, /* NDEF Record Header (TNF=0x1:Well known record + SR + ME + MB) + */ + 0x01, /* Type Length for the record type indicator */ + (uint8_t)(len + 1), /* Payload len */ + 0x55, /* Record Type Indicator (0x55 or 'U' = URI Record) */ + uriIdentifier /* URI Prefix (ex. 0x01 = "http://www.") */ + }; + + // Write 12 byte header (three pages of data starting at page 4) + memcpy(pageBuffer, pageHeader, 4); + if (!(ntag2xx_WritePage(4, pageBuffer))) return 0; - memset(pageBuffer, 0, 4); - pageBuffer[0] = 0xFE; // NDEF record footer - currentPage++; - if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + memcpy(pageBuffer, pageHeader + 4, 4); + if (!(ntag2xx_WritePage(5, pageBuffer))) return 0; - // DONE! - return 1; - } else { - // More than one page of data left - memcpy(pageBuffer, urlcopy, 4); - if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + memcpy(pageBuffer, pageHeader + 8, 4); + if (!(ntag2xx_WritePage(6, pageBuffer))) return 0; - currentPage++; - urlcopy += 4; - len -= 4; + + // Write URI (starting at page 7) + uint8_t currentPage = 7; + char *urlcopy = url; + while (len) { + if (len < 4) { + memset(pageBuffer, 0, 4); + memcpy(pageBuffer, urlcopy, len); + pageBuffer[len] = 0xFE; // NDEF record footer + if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + return 0; + // DONE! + return 1; + } else if (len == 4) { + memcpy(pageBuffer, urlcopy, len); + if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + return 0; + memset(pageBuffer, 0, 4); + pageBuffer[0] = 0xFE; // NDEF record footer + currentPage++; + if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + return 0; + // DONE! + return 1; + } else { + // More than one page of data left + memcpy(pageBuffer, urlcopy, 4); + if (!(ntag2xx_WritePage(currentPage, pageBuffer))) + return 0; + currentPage++; + urlcopy += 4; + len -= 4; + } } - } - // Seems that everything was OK (?!) - return 1; + // Seems that everything was OK (?!) + return 1; } /************** high level communication functions (handles both I2C and SPI) */ @@ -1528,16 +1540,16 @@ uint8_t Adafruit_PN532::ntag2xx_WriteNDEFURI(uint8_t uriIdentifier, char *url, */ /**************************************************************************/ bool Adafruit_PN532::readack() { - uint8_t ackbuff[6]; + uint8_t ackbuff[6]; - if (spi_dev) { - uint8_t cmd = PN532_SPI_DATAREAD; - spi_dev->write_then_read(&cmd, 1, ackbuff, 6); - } else if (i2c_dev || ser_dev) { - readdata(ackbuff, 6); - } + if (spi_dev) { + uint8_t cmd = PN532_SPI_DATAREAD; + spi_dev->write_then_read(&cmd, 1, ackbuff, 6); + } else if (i2c_dev || ser_dev) { + readdata(ackbuff, 6); + } - return (0 == memcmp((char *)ackbuff, (char *)pn532ack, 6)); + return (0 == memcmp((char *)ackbuff, (char *)pn532ack, 6)); } /**************************************************************************/ @@ -1546,25 +1558,25 @@ bool Adafruit_PN532::readack() { */ /**************************************************************************/ bool Adafruit_PN532::isready() { - if (spi_dev) { - // SPI ready check via Status Request - uint8_t cmd = PN532_SPI_STATREAD; - uint8_t reply; - spi_dev->write_then_read(&cmd, 1, &reply, 1); - return reply == PN532_SPI_READY; - } else if (i2c_dev) { - // I2C ready check via reading RDY byte - uint8_t rdy[1]; - i2c_dev->read(rdy, 1); - return rdy[0] == PN532_I2C_READY; - } else if (ser_dev) { - // Serial ready check based on non-zero read buffer - return (ser_dev->available() != 0); - } else if (_irq != -1) { - uint8_t x = digitalRead(_irq); - return x == 0; - } - return false; + if (spi_dev) { + // SPI ready check via Status Request + uint8_t cmd = PN532_SPI_STATREAD; + uint8_t reply; + spi_dev->write_then_read(&cmd, 1, &reply, 1); + return reply == PN532_SPI_READY; + } else if (i2c_dev) { + // I2C ready check via reading RDY byte + uint8_t rdy[1]; + i2c_dev->read(rdy, 1); + return rdy[0] == PN532_I2C_READY; + } else if (ser_dev) { + // Serial ready check based on non-zero read buffer + return (ser_dev->available() != 0); + } else if (_irq != -1) { + uint8_t x = digitalRead(_irq); + return x == 0; + } + return false; } /**************************************************************************/ @@ -1575,20 +1587,20 @@ bool Adafruit_PN532::isready() { */ /**************************************************************************/ bool Adafruit_PN532::waitready(uint16_t timeout) { - uint16_t timer = 0; - while (!isready()) { - if (timeout != 0) { - timer += 10; - if (timer > timeout) { + uint16_t timer = 0; + while (!isready()) { + if (timeout != 0) { + timer += 10; + if (timer > timeout) { #ifdef PN532DEBUG - PN532DEBUGPRINT.println("TIMEOUT!"); + PN532DEBUGPRINT.println("TIMEOUT!"); #endif - return false; - } + return false; + } + } + delay(10); } - delay(10); - } - return true; + return true; } /**************************************************************************/ @@ -1600,28 +1612,28 @@ bool Adafruit_PN532::waitready(uint16_t timeout) { */ /**************************************************************************/ void Adafruit_PN532::readdata(uint8_t *buff, uint8_t n) { - if (spi_dev) { - // SPI read - uint8_t cmd = PN532_SPI_DATAREAD; - spi_dev->write_then_read(&cmd, 1, buff, n); - } else if (i2c_dev) { - // I2C read - uint8_t rbuff[n + 1]; // +1 for leading RDY byte - i2c_dev->read(rbuff, n + 1); - for (uint8_t i = 0; i < n; i++) { - buff[i] = rbuff[i + 1]; + if (spi_dev) { + // SPI read + uint8_t cmd = PN532_SPI_DATAREAD; + spi_dev->write_then_read(&cmd, 1, buff, n); + } else if (i2c_dev) { + // I2C read + uint8_t rbuff[n + 1]; // +1 for leading RDY byte + i2c_dev->read(rbuff, n + 1); + for (uint8_t i = 0; i < n; i++) { + buff[i] = rbuff[i + 1]; + } + } else if (ser_dev) { + // Serial read + ser_dev->readBytes(buff, n); } - } else if (ser_dev) { - // Serial read - ser_dev->readBytes(buff, n); - } #ifdef PN532DEBUG - PN532DEBUGPRINT.print(F("Reading: ")); - for (uint8_t i = 0; i < n; i++) { - PN532DEBUGPRINT.print(F(" 0x")); - PN532DEBUGPRINT.print(buff[i], HEX); - } - PN532DEBUGPRINT.println(); + PN532DEBUGPRINT.print(F("Reading: ")); + for (uint8_t i = 0; i < n; i++) { + PN532DEBUGPRINT.print(F(" 0x")); + PN532DEBUGPRINT.print(buff[i], HEX); + } + PN532DEBUGPRINT.println(); #endif } @@ -1636,30 +1648,30 @@ void Adafruit_PN532::readdata(uint8_t *buff, uint8_t n) { */ /**************************************************************************/ uint8_t Adafruit_PN532::AsTarget() { - pn532_packetbuffer[0] = 0x8C; - uint8_t target[] = { - 0x8C, // INIT AS TARGET - 0x00, // MODE -> BITFIELD - 0x08, 0x00, // SENS_RES - MIFARE PARAMS - 0xdc, 0x44, 0x20, // NFCID1T - 0x60, // SEL_RES - 0x01, 0xfe, // NFCID2T MUST START WITH 01fe - FELICA PARAMS - POL_RES - 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7, 0xc0, - 0xc1, 0xc2, 0xc3, 0xc4, 0xc5, 0xc6, 0xc7, // PAD - 0xff, 0xff, // SYSTEM CODE - 0xaa, 0x99, 0x88, 0x77, 0x66, 0x55, 0x44, - 0x33, 0x22, 0x11, 0x01, 0x00, // NFCID3t MAX 47 BYTES ATR_RES - 0x0d, 0x52, 0x46, 0x49, 0x44, 0x49, 0x4f, - 0x74, 0x20, 0x50, 0x4e, 0x35, 0x33, 0x32 // HISTORICAL BYTES - }; - if (!sendCommandCheckAck(target, sizeof(target))) - return false; + pn532_packetbuffer[0] = 0x8C; + uint8_t target[] = { + 0x8C, // INIT AS TARGET + 0x00, // MODE -> BITFIELD + 0x08, 0x00, // SENS_RES - MIFARE PARAMS + 0xdc, 0x44, 0x20, // NFCID1T + 0x60, // SEL_RES + 0x01, 0xfe, // NFCID2T MUST START WITH 01fe - FELICA PARAMS - POL_RES + 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7, 0xc0, + 0xc1, 0xc2, 0xc3, 0xc4, 0xc5, 0xc6, 0xc7, // PAD + 0xff, 0xff, // SYSTEM CODE + 0xaa, 0x99, 0x88, 0x77, 0x66, 0x55, 0x44, + 0x33, 0x22, 0x11, 0x01, 0x00, // NFCID3t MAX 47 BYTES ATR_RES + 0x0d, 0x52, 0x46, 0x49, 0x44, 0x49, 0x4f, + 0x74, 0x20, 0x50, 0x4e, 0x35, 0x33, 0x32 // HISTORICAL BYTES + }; + if (!sendCommandCheckAck(target, sizeof(target))) + return false; - // read data packet - readdata(pn532_packetbuffer, 8); + // read data packet + readdata(pn532_packetbuffer, 8); - int offset = 6; - return (pn532_packetbuffer[offset] == 0x15); + int offset = 6; + return (pn532_packetbuffer[offset] == 0x15); } /**************************************************************************/ /*! @@ -1671,27 +1683,27 @@ uint8_t Adafruit_PN532::AsTarget() { */ /**************************************************************************/ uint8_t Adafruit_PN532::getDataTarget(uint8_t *cmd, uint8_t *cmdlen) { - uint8_t length; - pn532_packetbuffer[0] = 0x86; - if (!sendCommandCheckAck(pn532_packetbuffer, 1, 1000)) { - PN532DEBUGPRINT.println(F("Error en ack")); - return false; - } - - // read data packet - readdata(pn532_packetbuffer, 64); - length = pn532_packetbuffer[3] - 3; - - // if (length > *responseLength) {// Bug, should avoid it in the reading - // target data - // length = *responseLength; // silent truncation... - //} - - for (int i = 0; i < length; ++i) { - cmd[i] = pn532_packetbuffer[8 + i]; - } - *cmdlen = length; - return true; + uint8_t length; + pn532_packetbuffer[0] = 0x86; + if (!sendCommandCheckAck(pn532_packetbuffer, 1, 1000)) { + PN532DEBUGPRINT.println(F("Error en ack")); + return false; + } + + // read data packet + readdata(pn532_packetbuffer, 64); + length = pn532_packetbuffer[3] - 3; + + // if (length > *responseLength) {// Bug, should avoid it in the reading + // target data + // length = *responseLength; // silent truncation... + //} + + for (int i = 0; i < length; ++i) { + cmd[i] = pn532_packetbuffer[8 + i]; + } + *cmdlen = length; + return true; } /**************************************************************************/ @@ -1704,23 +1716,23 @@ uint8_t Adafruit_PN532::getDataTarget(uint8_t *cmd, uint8_t *cmdlen) { */ /**************************************************************************/ uint8_t Adafruit_PN532::setDataTarget(uint8_t *cmd, uint8_t cmdlen) { - uint8_t length; - // cmd1[0] = 0x8E; Must! + uint8_t length; + // cmd1[0] = 0x8E; Must! - if (!sendCommandCheckAck(cmd, cmdlen)) - return false; + if (!sendCommandCheckAck(cmd, cmdlen)) + return false; - // read data packet - readdata(pn532_packetbuffer, 8); - length = pn532_packetbuffer[3] - 3; - for (int i = 0; i < length; ++i) { - cmd[i] = pn532_packetbuffer[8 + i]; - } - // cmdl = 0 - cmdlen = length; - - int offset = 6; - return (pn532_packetbuffer[offset] == 0x15); + // read data packet + readdata(pn532_packetbuffer, 8); + length = pn532_packetbuffer[3] - 3; + for (int i = 0; i < length; ++i) { + cmd[i] = pn532_packetbuffer[8 + i]; + } + // cmdl = 0 + cmdlen = length; + + int offset = 6; + return (pn532_packetbuffer[offset] == 0x15); } /**************************************************************************/ @@ -1733,88 +1745,88 @@ uint8_t Adafruit_PN532::setDataTarget(uint8_t *cmd, uint8_t cmdlen) { */ /**************************************************************************/ void Adafruit_PN532::writecommand(uint8_t *cmd, uint8_t cmdlen) { - if (spi_dev) { - // SPI command write. - uint8_t checksum; - uint8_t packet[9 + cmdlen]; - uint8_t *p = packet; - cmdlen++; - - p[0] = PN532_SPI_DATAWRITE; - p++; - - p[0] = PN532_PREAMBLE; - p++; - p[0] = PN532_STARTCODE1; - p++; - p[0] = PN532_STARTCODE2; - p++; - checksum = PN532_PREAMBLE + PN532_STARTCODE1 + PN532_STARTCODE2; - - p[0] = cmdlen; - p++; - p[0] = ~cmdlen + 1; - p++; - - p[0] = PN532_HOSTTOPN532; - p++; - checksum += PN532_HOSTTOPN532; - - for (uint8_t i = 0; i < cmdlen - 1; i++) { - p[0] = cmd[i]; - p++; - checksum += cmd[i]; - } - - p[0] = ~checksum; - p++; - p[0] = PN532_POSTAMBLE; - p++; + if (spi_dev) { + // SPI command write. + uint8_t checksum; + uint8_t packet[9 + cmdlen]; + uint8_t *p = packet; + cmdlen++; + + p[0] = PN532_SPI_DATAWRITE; + p++; + + p[0] = PN532_PREAMBLE; + p++; + p[0] = PN532_STARTCODE1; + p++; + p[0] = PN532_STARTCODE2; + p++; + checksum = PN532_PREAMBLE + PN532_STARTCODE1 + PN532_STARTCODE2; + + p[0] = cmdlen; + p++; + p[0] = ~cmdlen + 1; + p++; + + p[0] = PN532_HOSTTOPN532; + p++; + checksum += PN532_HOSTTOPN532; + + for (uint8_t i = 0; i < cmdlen - 1; i++) { + p[0] = cmd[i]; + p++; + checksum += cmd[i]; + } + + p[0] = ~checksum; + p++; + p[0] = PN532_POSTAMBLE; + p++; #ifdef PN532DEBUG - Serial.print("Sending : "); - for (int i = 1; i < 8 + cmdlen; i++) { - Serial.print("0x"); - Serial.print(packet[i], HEX); - Serial.print(", "); - } - Serial.println(); + Serial.print("Sending : "); + for (int i = 1; i < 8 + cmdlen; i++) { + Serial.print("0x"); + Serial.print(packet[i], HEX); + Serial.print(", "); + } + Serial.println(); #endif - spi_dev->write(packet, 8 + cmdlen); - } else if (i2c_dev || ser_dev) { - // I2C or Serial command write. - uint8_t packet[8 + cmdlen]; - uint8_t LEN = cmdlen + 1; - - packet[0] = PN532_PREAMBLE; - packet[1] = PN532_STARTCODE1; - packet[2] = PN532_STARTCODE2; - packet[3] = LEN; - packet[4] = ~LEN + 1; - packet[5] = PN532_HOSTTOPN532; - uint8_t sum = 0; - for (uint8_t i = 0; i < cmdlen; i++) { - packet[6 + i] = cmd[i]; - sum += cmd[i]; - } - packet[6 + cmdlen] = ~(PN532_HOSTTOPN532 + sum) + 1; - packet[7 + cmdlen] = PN532_POSTAMBLE; + spi_dev->write(packet, 8 + cmdlen); + } else if (i2c_dev || ser_dev) { + // I2C or Serial command write. + uint8_t packet[8 + cmdlen]; + uint8_t LEN = cmdlen + 1; + + packet[0] = PN532_PREAMBLE; + packet[1] = PN532_STARTCODE1; + packet[2] = PN532_STARTCODE2; + packet[3] = LEN; + packet[4] = ~LEN + 1; + packet[5] = PN532_HOSTTOPN532; + uint8_t sum = 0; + for (uint8_t i = 0; i < cmdlen; i++) { + packet[6 + i] = cmd[i]; + sum += cmd[i]; + } + packet[6 + cmdlen] = ~(PN532_HOSTTOPN532 + sum) + 1; + packet[7 + cmdlen] = PN532_POSTAMBLE; #ifdef PN532DEBUG - Serial.print("Sending : "); - for (int i = 1; i < 8 + cmdlen; i++) { - Serial.print("0x"); - Serial.print(packet[i], HEX); - Serial.print(", "); - } - Serial.println(); + Serial.print("Sending : "); + for (int i = 1; i < 8 + cmdlen; i++) { + Serial.print("0x"); + Serial.print(packet[i], HEX); + Serial.print(", "); + } + Serial.println(); #endif - if (i2c_dev) { - i2c_dev->write(packet, 8 + cmdlen); - } else { - ser_dev->write(packet, 8 + cmdlen); + if (i2c_dev) { + i2c_dev->write(packet, 8 + cmdlen); + } else { + ser_dev->write(packet, 8 + cmdlen); + } } - } } |