mirror of
https://github.com/Vale54321/schafkopf-bot.git
synced 2025-12-15 19:29:33 +01:00
added arduino nfcReader files (#42)
This commit is contained in:
committed by
GitHub
parent
76cb0eaf1a
commit
6259d0bef3
210
Arduino/nfcReader/PN532_SPI/PN532_SPI.cpp
Normal file
210
Arduino/nfcReader/PN532_SPI/PN532_SPI.cpp
Normal file
@@ -0,0 +1,210 @@
|
||||
|
||||
#include "PN532_SPI.h"
|
||||
#include "PN532_debug.h"
|
||||
#include "Arduino.h"
|
||||
|
||||
#define STATUS_READ 2
|
||||
#define DATA_WRITE 1
|
||||
#define DATA_READ 3
|
||||
|
||||
PN532_SPI::PN532_SPI(SPIClass &spi, uint8_t ss)
|
||||
{
|
||||
command = 0;
|
||||
_spi = &spi;
|
||||
_ss = ss;
|
||||
}
|
||||
|
||||
void PN532_SPI::begin()
|
||||
{
|
||||
pinMode(_ss, OUTPUT);
|
||||
|
||||
_spi->begin();
|
||||
_spi->setDataMode(SPI_MODE0); // PN532 only supports mode0
|
||||
_spi->setBitOrder(LSBFIRST);
|
||||
#ifndef __SAM3X8E__
|
||||
_spi->setClockDivider(SPI_CLOCK_DIV8); // set clock 2MHz(max: 5MHz)
|
||||
#else
|
||||
/** DUE spi library does not support SPI_CLOCK_DIV8 macro */
|
||||
_spi->setClockDivider(42); // set clock 2MHz(max: 5MHz)
|
||||
#endif
|
||||
|
||||
}
|
||||
|
||||
void PN532_SPI::wakeup()
|
||||
{
|
||||
digitalWrite(_ss, LOW);
|
||||
delay(2);
|
||||
digitalWrite(_ss, HIGH);
|
||||
}
|
||||
|
||||
|
||||
|
||||
int8_t PN532_SPI::writeCommand(const uint8_t *header, uint8_t hlen, const uint8_t *body, uint8_t blen)
|
||||
{
|
||||
command = header[0];
|
||||
writeFrame(header, hlen, body, blen);
|
||||
|
||||
uint8_t timeout = PN532_ACK_WAIT_TIME;
|
||||
while (!isReady()) {
|
||||
delay(1);
|
||||
timeout--;
|
||||
if (0 == timeout) {
|
||||
DMSG("Time out when waiting for ACK\n");
|
||||
return -2;
|
||||
}
|
||||
}
|
||||
if (readAckFrame()) {
|
||||
DMSG("Invalid ACK\n");
|
||||
return PN532_INVALID_ACK;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
int16_t PN532_SPI::readResponse(uint8_t buf[], uint8_t len, uint16_t timeout)
|
||||
{
|
||||
uint16_t time = 0;
|
||||
while (!isReady()) {
|
||||
delay(1);
|
||||
time++;
|
||||
if (timeout > 0 && time > timeout) {
|
||||
return PN532_TIMEOUT;
|
||||
}
|
||||
}
|
||||
|
||||
digitalWrite(_ss, LOW);
|
||||
delay(1);
|
||||
|
||||
int16_t result;
|
||||
do {
|
||||
write(DATA_READ);
|
||||
|
||||
if (0x00 != read() || // PREAMBLE
|
||||
0x00 != read() || // STARTCODE1
|
||||
0xFF != read() // STARTCODE2
|
||||
) {
|
||||
|
||||
result = PN532_INVALID_FRAME;
|
||||
break;
|
||||
}
|
||||
|
||||
uint8_t length = read();
|
||||
if (0 != (uint8_t)(length + read())) { // checksum of length
|
||||
result = PN532_INVALID_FRAME;
|
||||
break;
|
||||
}
|
||||
|
||||
uint8_t cmd = command + 1; // response command
|
||||
if (PN532_PN532TOHOST != read() || (cmd) != read()) {
|
||||
result = PN532_INVALID_FRAME;
|
||||
break;
|
||||
}
|
||||
|
||||
DMSG("read: ");
|
||||
DMSG_HEX(cmd);
|
||||
|
||||
length -= 2;
|
||||
if (length > len) {
|
||||
for (uint8_t i = 0; i < length; i++) {
|
||||
DMSG_HEX(read()); // dump message
|
||||
}
|
||||
DMSG("\nNot enough space\n");
|
||||
read();
|
||||
read();
|
||||
result = PN532_NO_SPACE; // not enough space
|
||||
break;
|
||||
}
|
||||
|
||||
uint8_t sum = PN532_PN532TOHOST + cmd;
|
||||
for (uint8_t i = 0; i < length; i++) {
|
||||
buf[i] = read();
|
||||
sum += buf[i];
|
||||
|
||||
DMSG_HEX(buf[i]);
|
||||
}
|
||||
DMSG('\n');
|
||||
|
||||
uint8_t checksum = read();
|
||||
if (0 != (uint8_t)(sum + checksum)) {
|
||||
DMSG("checksum is not ok\n");
|
||||
result = PN532_INVALID_FRAME;
|
||||
break;
|
||||
}
|
||||
read(); // POSTAMBLE
|
||||
|
||||
result = length;
|
||||
} while (0);
|
||||
|
||||
digitalWrite(_ss, HIGH);
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
boolean PN532_SPI::isReady()
|
||||
{
|
||||
digitalWrite(_ss, LOW);
|
||||
|
||||
write(STATUS_READ);
|
||||
uint8_t status = read() & 1;
|
||||
digitalWrite(_ss, HIGH);
|
||||
return status;
|
||||
}
|
||||
|
||||
void PN532_SPI::writeFrame(const uint8_t *header, uint8_t hlen, const uint8_t *body, uint8_t blen)
|
||||
{
|
||||
digitalWrite(_ss, LOW);
|
||||
delay(2); // wake up PN532
|
||||
|
||||
write(DATA_WRITE);
|
||||
write(PN532_PREAMBLE);
|
||||
write(PN532_STARTCODE1);
|
||||
write(PN532_STARTCODE2);
|
||||
|
||||
uint8_t length = hlen + blen + 1; // length of data field: TFI + DATA
|
||||
write(length);
|
||||
write(~length + 1); // checksum of length
|
||||
|
||||
write(PN532_HOSTTOPN532);
|
||||
uint8_t sum = PN532_HOSTTOPN532; // sum of TFI + DATA
|
||||
|
||||
DMSG("write: ");
|
||||
|
||||
for (uint8_t i = 0; i < hlen; i++) {
|
||||
write(header[i]);
|
||||
sum += header[i];
|
||||
|
||||
DMSG_HEX(header[i]);
|
||||
}
|
||||
for (uint8_t i = 0; i < blen; i++) {
|
||||
write(body[i]);
|
||||
sum += body[i];
|
||||
|
||||
DMSG_HEX(body[i]);
|
||||
}
|
||||
|
||||
uint8_t checksum = ~sum + 1; // checksum of TFI + DATA
|
||||
write(checksum);
|
||||
write(PN532_POSTAMBLE);
|
||||
|
||||
digitalWrite(_ss, HIGH);
|
||||
|
||||
DMSG('\n');
|
||||
}
|
||||
|
||||
int8_t PN532_SPI::readAckFrame()
|
||||
{
|
||||
const uint8_t PN532_ACK[] = {0, 0, 0xFF, 0, 0xFF, 0};
|
||||
|
||||
uint8_t ackBuf[sizeof(PN532_ACK)];
|
||||
|
||||
digitalWrite(_ss, LOW);
|
||||
delay(1);
|
||||
write(DATA_READ);
|
||||
|
||||
for (uint8_t i = 0; i < sizeof(PN532_ACK); i++) {
|
||||
ackBuf[i] = read();
|
||||
}
|
||||
|
||||
digitalWrite(_ss, HIGH);
|
||||
|
||||
return memcmp(ackBuf, PN532_ACK, sizeof(PN532_ACK));
|
||||
}
|
||||
36
Arduino/nfcReader/PN532_SPI/PN532_SPI.h
Normal file
36
Arduino/nfcReader/PN532_SPI/PN532_SPI.h
Normal file
@@ -0,0 +1,36 @@
|
||||
|
||||
#ifndef __PN532_SPI_H__
|
||||
#define __PN532_SPI_H__
|
||||
|
||||
#include <SPI.h>
|
||||
#include "PN532Interface.h"
|
||||
|
||||
class PN532_SPI : public PN532Interface {
|
||||
public:
|
||||
PN532_SPI(SPIClass &spi, uint8_t ss);
|
||||
|
||||
void begin();
|
||||
void wakeup();
|
||||
int8_t writeCommand(const uint8_t *header, uint8_t hlen, const uint8_t *body = 0, uint8_t blen = 0);
|
||||
|
||||
int16_t readResponse(uint8_t buf[], uint8_t len, uint16_t timeout);
|
||||
|
||||
private:
|
||||
SPIClass* _spi;
|
||||
uint8_t _ss;
|
||||
uint8_t command;
|
||||
|
||||
boolean isReady();
|
||||
void writeFrame(const uint8_t *header, uint8_t hlen, const uint8_t *body = 0, uint8_t blen = 0);
|
||||
int8_t readAckFrame();
|
||||
|
||||
inline void write(uint8_t data) {
|
||||
_spi->transfer(data);
|
||||
};
|
||||
|
||||
inline uint8_t read() {
|
||||
return _spi->transfer(0);
|
||||
};
|
||||
};
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user