0265515a0c
iAbortFd file descriptor array have been removed from nfc_device_t; nfc_abort_command() can now failed (return false); nfc_abort_command() now call abort_command pointer from drivers; pn532_uart and arygon drivers use a pipe-based mecanism (similar from previous one); pn53x_usb driver use a boolean flag-based mecanism (the previous one does not work as expected); pn53x_usb now print smarter messages on error at usb connection; pn53x_usb now handle a strange case: sometimes, the first sent command is not ACKed by PN53x USB device, a dummy command is now sent.
672 lines
21 KiB
C
672 lines
21 KiB
C
/*-
|
|
* Public platform independent Near Field Communication (NFC) library
|
|
*
|
|
* Copyright (C) 2009, Roel Verdult
|
|
* Copyright (C) 2010, Romain Tartière, Romuald Conty
|
|
* Copyright (C) 2011, Romain Tartière, Romuald Conty
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify it
|
|
* under the terms of the GNU Lesser General Public License as published by the
|
|
* Free Software Foundation, either version 3 of the License, or (at your
|
|
* option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>
|
|
*/
|
|
|
|
/**
|
|
* @file pn53x_usb.c
|
|
* @brief Driver for PN53x using USB
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
# include "config.h"
|
|
#endif // HAVE_CONFIG_H
|
|
|
|
/*
|
|
Thanks to d18c7db and Okko for example code
|
|
*/
|
|
|
|
#include <sys/select.h>
|
|
#include <errno.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <usb.h>
|
|
#include <string.h>
|
|
|
|
#include <nfc/nfc.h>
|
|
|
|
#include "nfc-internal.h"
|
|
#include "chips/pn53x.h"
|
|
#include "chips/pn53x-internal.h"
|
|
#include "drivers/pn53x_usb.h"
|
|
|
|
#define PN53X_USB_DRIVER_NAME "PN53x USB"
|
|
#define USB_TIMEOUT 0
|
|
|
|
#define DRIVER_DATA(pnd) ((struct pn53x_usb_data*)(pnd->driver_data))
|
|
|
|
typedef enum {
|
|
UNKNOWN,
|
|
NXP_PN531,
|
|
SONY_PN531,
|
|
NXP_PN533,
|
|
ASK_LOGO,
|
|
SCM_SCL3711
|
|
} pn53x_usb_model;
|
|
|
|
struct pn53x_usb_data {
|
|
usb_dev_handle *pudh;
|
|
pn53x_usb_model model;
|
|
uint32_t uiEndPointIn;
|
|
uint32_t uiEndPointOut;
|
|
uint32_t uiMaxPacketSize;
|
|
volatile bool abort_flag;
|
|
};
|
|
|
|
const struct pn53x_io pn53x_usb_io;
|
|
bool pn53x_usb_get_usb_device_name (struct usb_device *dev, usb_dev_handle *udev, char *buffer, size_t len);
|
|
bool pn53x_usb_init (nfc_device_t *pnd);
|
|
|
|
int
|
|
pn53x_usb_bulk_read (struct pn53x_usb_data *data, byte_t abtRx[], const size_t szRx)
|
|
{
|
|
int res = usb_bulk_read (data->pudh, data->uiEndPointIn, (char *) abtRx, szRx, USB_TIMEOUT);
|
|
PRINT_HEX ("RX", abtRx, res);
|
|
return res;
|
|
}
|
|
int
|
|
|
|
pn53x_usb_bulk_read_ex (struct pn53x_usb_data *data, byte_t abtRx[], const size_t szRx, int timeout)
|
|
{
|
|
int res = usb_bulk_read (data->pudh, data->uiEndPointIn, (char *) abtRx, szRx, timeout);
|
|
if (res > 0)
|
|
PRINT_HEX ("RX", abtRx, res);
|
|
return res;
|
|
}
|
|
|
|
int
|
|
pn53x_usb_bulk_write (struct pn53x_usb_data *data, byte_t abtTx[], const size_t szTx)
|
|
{
|
|
PRINT_HEX ("TX", abtTx, szTx);
|
|
return usb_bulk_write (data->pudh, data->uiEndPointOut, (char *) abtTx, szTx, USB_TIMEOUT);
|
|
}
|
|
|
|
struct pn53x_usb_supported_device {
|
|
uint16_t vendor_id;
|
|
uint16_t product_id;
|
|
pn53x_usb_model model;
|
|
const char *name;
|
|
};
|
|
|
|
const struct pn53x_usb_supported_device pn53x_usb_supported_devices[] = {
|
|
{ 0x04CC, 0x0531, NXP_PN531, "Philips / PN531" },
|
|
{ 0x04CC, 0x2533, NXP_PN533, "NXP / PN533" },
|
|
{ 0x04E6, 0x5591, SCM_SCL3711, "SCM Micro / SCL3711-NFC&RW" },
|
|
{ 0x054c, 0x0193, SONY_PN531, "Sony / PN531" },
|
|
{ 0x1FD3, 0x0608, ASK_LOGO, "ASK / LoGO" }
|
|
};
|
|
|
|
pn53x_usb_model
|
|
pn53x_usb_get_device_model (uint16_t vendor_id, uint16_t product_id)
|
|
{
|
|
for (size_t n = 0; n < sizeof (pn53x_usb_supported_devices) / sizeof (struct pn53x_usb_supported_device); n++) {
|
|
if ((vendor_id == pn53x_usb_supported_devices[n].vendor_id) &&
|
|
(product_id == pn53x_usb_supported_devices[n].product_id))
|
|
return pn53x_usb_supported_devices[n].model;
|
|
}
|
|
|
|
return UNKNOWN;
|
|
}
|
|
|
|
// TODO Move this HACK1 into an upper level in order to benefit to other devices that use PN53x
|
|
static const byte_t ack_frame[] = { 0x00, 0x00, 0xff, 0x00, 0xff, 0x00 };
|
|
|
|
int pn53x_usb_ack (nfc_device_t * pnd);
|
|
|
|
// Find transfer endpoints for bulk transfers
|
|
void
|
|
pn53x_usb_get_end_points (struct usb_device *dev, struct pn53x_usb_data *data)
|
|
{
|
|
uint32_t uiIndex;
|
|
uint32_t uiEndPoint;
|
|
struct usb_interface_descriptor *puid = dev->config->interface->altsetting;
|
|
|
|
// 3 Endpoints maximum: Interrupt In, Bulk In, Bulk Out
|
|
for (uiIndex = 0; uiIndex < puid->bNumEndpoints; uiIndex++) {
|
|
// Only accept bulk transfer endpoints (ignore interrupt endpoints)
|
|
if (puid->endpoint[uiIndex].bmAttributes != USB_ENDPOINT_TYPE_BULK)
|
|
continue;
|
|
|
|
// Copy the endpoint to a local var, makes it more readable code
|
|
uiEndPoint = puid->endpoint[uiIndex].bEndpointAddress;
|
|
|
|
// Test if we dealing with a bulk IN endpoint
|
|
if ((uiEndPoint & USB_ENDPOINT_DIR_MASK) == USB_ENDPOINT_IN) {
|
|
data->uiEndPointIn = uiEndPoint;
|
|
data->uiMaxPacketSize = puid->endpoint[uiIndex].wMaxPacketSize;
|
|
}
|
|
// Test if we dealing with a bulk OUT endpoint
|
|
if ((uiEndPoint & USB_ENDPOINT_DIR_MASK) == USB_ENDPOINT_OUT) {
|
|
data->uiEndPointOut = uiEndPoint;
|
|
data->uiMaxPacketSize = puid->endpoint[uiIndex].wMaxPacketSize;
|
|
}
|
|
}
|
|
}
|
|
|
|
bool
|
|
pn53x_usb_probe (nfc_device_desc_t pnddDevices[], size_t szDevices, size_t * pszDeviceFound)
|
|
{
|
|
usb_init ();
|
|
|
|
int res;
|
|
// usb_find_busses will find all of the busses on the system. Returns the number of changes since previous call to this function (total of new busses and busses removed).
|
|
if ((res = usb_find_busses () < 0))
|
|
return false;
|
|
// usb_find_devices will find all of the devices on each bus. This should be called after usb_find_busses. Returns the number of changes since the previous call to this function (total of new device and devices removed).
|
|
if ((res = usb_find_devices () < 0))
|
|
return false;
|
|
|
|
*pszDeviceFound = 0;
|
|
|
|
uint32_t uiBusIndex = 0;
|
|
struct usb_bus *bus;
|
|
for (bus = usb_get_busses (); bus; bus = bus->next) {
|
|
struct usb_device *dev;
|
|
for (dev = bus->devices; dev; dev = dev->next, uiBusIndex++) {
|
|
for (size_t n = 0; n < sizeof (pn53x_usb_supported_devices) / sizeof (struct pn53x_usb_supported_device); n++) {
|
|
// DBG("Checking device %04x:%04x (%04x:%04x)",dev->descriptor.idVendor,dev->descriptor.idProduct,candidates[i].idVendor,candidates[i].idProduct);
|
|
if ((pn53x_usb_supported_devices[n].vendor_id == dev->descriptor.idVendor) &&
|
|
(pn53x_usb_supported_devices[n].product_id == dev->descriptor.idProduct)) {
|
|
// Make sure there are 2 endpoints available
|
|
// with libusb-win32 we got some null pointers so be robust before looking at endpoints:
|
|
if (dev->config == NULL || dev->config->interface == NULL || dev->config->interface->altsetting == NULL) {
|
|
// Nope, we maybe want the next one, let's try to find another
|
|
continue;
|
|
}
|
|
if (dev->config->interface->altsetting->bNumEndpoints < 2) {
|
|
// Nope, we maybe want the next one, let's try to find another
|
|
continue;
|
|
}
|
|
|
|
usb_dev_handle *udev = usb_open (dev);
|
|
pn53x_usb_get_usb_device_name (dev, udev, pnddDevices[*pszDeviceFound].acDevice, sizeof (pnddDevices[*pszDeviceFound].acDevice));
|
|
usb_close (udev);
|
|
pnddDevices[*pszDeviceFound].pcDriver = PN53X_USB_DRIVER_NAME;
|
|
pnddDevices[*pszDeviceFound].uiBusIndex = uiBusIndex;
|
|
(*pszDeviceFound)++;
|
|
// Test if we reach the maximum "wanted" devices
|
|
if ((*pszDeviceFound) == szDevices) {
|
|
return true;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool
|
|
pn53x_usb_get_usb_device_name (struct usb_device *dev, usb_dev_handle *udev, char *buffer, size_t len)
|
|
{
|
|
*buffer = '\0';
|
|
|
|
if (dev->descriptor.iManufacturer || dev->descriptor.iProduct) {
|
|
if (udev) {
|
|
usb_get_string_simple (udev, dev->descriptor.iManufacturer, buffer, len);
|
|
if (strlen (buffer) > 0)
|
|
strcpy (buffer + strlen (buffer), " / ");
|
|
usb_get_string_simple (udev, dev->descriptor.iProduct, buffer + strlen (buffer), len - strlen (buffer));
|
|
}
|
|
}
|
|
|
|
if (!*buffer) {
|
|
for (size_t n = 0; n < sizeof (pn53x_usb_supported_devices) / sizeof (struct pn53x_usb_supported_device); n++) {
|
|
if ((pn53x_usb_supported_devices[n].vendor_id == dev->descriptor.idVendor) &&
|
|
(pn53x_usb_supported_devices[n].product_id == dev->descriptor.idProduct)) {
|
|
strncpy (buffer, pn53x_usb_supported_devices[n].name, len);
|
|
return true;
|
|
}
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
nfc_device_t *
|
|
pn53x_usb_connect (const nfc_device_desc_t *pndd)
|
|
{
|
|
nfc_device_t *pnd = NULL;
|
|
struct pn53x_usb_data data = {
|
|
.pudh = NULL,
|
|
.uiEndPointIn = 0,
|
|
.uiEndPointOut = 0,
|
|
};
|
|
struct usb_bus *bus;
|
|
struct usb_device *dev;
|
|
uint32_t uiBusIndex;
|
|
|
|
usb_init ();
|
|
|
|
uiBusIndex = pndd->uiBusIndex;
|
|
|
|
for (bus = usb_get_busses (); bus; bus = bus->next) {
|
|
for (dev = bus->devices; dev; dev = dev->next, uiBusIndex--) {
|
|
DBG ("Checking device %04x:%04x", dev->descriptor.idVendor, dev->descriptor.idProduct);
|
|
if (uiBusIndex == 0) {
|
|
// Open the USB device
|
|
data.pudh = usb_open (dev);
|
|
// Retrieve end points
|
|
pn53x_usb_get_end_points (dev, &data);
|
|
// Set configuration
|
|
int res = usb_set_configuration (data.pudh, 1);
|
|
if (res < 0) {
|
|
ERR ("Unable to set USB configuration (%s)", strerror (-res));
|
|
if (EPERM == -res) {
|
|
WARN ("Please double check USB permissions for device %04x:%04x", dev->descriptor.idVendor, dev->descriptor.idProduct);
|
|
}
|
|
usb_close (data.pudh);
|
|
// we failed to use the specified device
|
|
return NULL;
|
|
}
|
|
|
|
res = usb_claim_interface (data.pudh, 0);
|
|
if (res < 0) {
|
|
DBG ("Can't claim interface (%s)", strerror (-res));
|
|
usb_close (data.pudh);
|
|
// we failed to use the specified device
|
|
return NULL;
|
|
}
|
|
data.model = pn53x_usb_get_device_model (dev->descriptor.idVendor, dev->descriptor.idProduct);
|
|
// Allocate memory for the device info and specification, fill it and return the info
|
|
pnd = nfc_device_new ();
|
|
pn53x_usb_get_usb_device_name (dev, data.pudh, pnd->acName, sizeof (pnd->acName));
|
|
|
|
pnd->driver_data = malloc(sizeof(struct pn53x_usb_data));
|
|
*DRIVER_DATA (pnd) = data;
|
|
pnd->chip_data = malloc(sizeof(struct pn53x_data));
|
|
|
|
CHIP_DATA (pnd)->power_mode = NORMAL;
|
|
CHIP_DATA (pnd)->io = &pn53x_usb_io;
|
|
|
|
switch (DRIVER_DATA (pnd)->model) {
|
|
// empirical tuning
|
|
case ASK_LOGO:
|
|
CHIP_DATA (pnd)->timer_correction = 50;
|
|
break;
|
|
case SCM_SCL3711:
|
|
case NXP_PN533:
|
|
CHIP_DATA (pnd)->timer_correction = 46;
|
|
break;
|
|
case NXP_PN531:
|
|
CHIP_DATA (pnd)->timer_correction = 50;
|
|
break;
|
|
case SONY_PN531:
|
|
CHIP_DATA (pnd)->timer_correction = 54;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
pnd->driver = &pn53x_usb_driver;
|
|
|
|
// HACK1: Send first an ACK as Abort command, to reset chip before talking to it:
|
|
pn53x_usb_ack (pnd);
|
|
|
|
// HACK2: Then send a GetFirmware command to resync USB toggle bit between host & device
|
|
// in case host used set_configuration and expects the device to have reset its toggle bit, which PN53x doesn't do
|
|
if (!pn53x_usb_init (pnd)) {
|
|
usb_close (data.pudh);
|
|
goto error;
|
|
}
|
|
DRIVER_DATA (pnd)->abort_flag = false;
|
|
return pnd;
|
|
}
|
|
}
|
|
}
|
|
// We ran out of devices before the index required
|
|
return NULL;
|
|
|
|
error:
|
|
// Free allocated structure on error.
|
|
nfc_device_free (pnd);
|
|
return NULL;
|
|
}
|
|
|
|
void
|
|
pn53x_usb_disconnect (nfc_device_t * pnd)
|
|
{
|
|
int res;
|
|
|
|
pn53x_usb_ack (pnd);
|
|
|
|
if (DRIVER_DATA (pnd)->model == ASK_LOGO) {
|
|
/* Set P30, P31, P32, P33, P35 to logic 1 and P34 to 0 logic */
|
|
/* ie. Switch all LEDs off and turn off progressive field */
|
|
pn53x_write_register (pnd, SFR_P3, 0xFF, _BV (P30) | _BV (P31) | _BV (P32) | _BV (P33) | _BV (P35));
|
|
}
|
|
|
|
if ((res = usb_release_interface (DRIVER_DATA (pnd)->pudh, 0)) < 0) {
|
|
ERR ("usb_release_interface failed (%i)", res);
|
|
}
|
|
|
|
if ((res = usb_close (DRIVER_DATA (pnd)->pudh)) < 0) {
|
|
ERR ("usb_close failed (%i)", res);
|
|
}
|
|
nfc_device_free (pnd);
|
|
}
|
|
|
|
#define PN53X_USB_BUFFER_LEN (PN53x_EXTENDED_FRAME__DATA_MAX_LEN + PN53x_EXTENDED_FRAME__OVERHEAD)
|
|
|
|
bool
|
|
pn53x_usb_send (nfc_device_t * pnd, const byte_t * pbtData, const size_t szData)
|
|
{
|
|
byte_t abtFrame[PN53X_USB_BUFFER_LEN] = { 0x00, 0x00, 0xff }; // Every packet must start with "00 00 ff"
|
|
CHIP_DATA (pnd)->ui8LastCommand = pbtData[0];
|
|
size_t szFrame = 0;
|
|
|
|
pn53x_build_frame (abtFrame, &szFrame, pbtData, szData);
|
|
|
|
int res = pn53x_usb_bulk_write (DRIVER_DATA (pnd), abtFrame, szFrame);
|
|
// HACK This little hack is a well know problem of USB, see http://www.libusb.org/ticket/6 for more details
|
|
if ((res % DRIVER_DATA (pnd)->uiMaxPacketSize) == 0) {
|
|
usb_bulk_write (DRIVER_DATA (pnd)->pudh, DRIVER_DATA(pnd)->uiEndPointOut, "\0", 0, USB_TIMEOUT);
|
|
}
|
|
|
|
if (res < 0) {
|
|
DBG ("usb_bulk_write failed with error %d", res);
|
|
pnd->iLastError = DEIO;
|
|
return false;
|
|
}
|
|
|
|
byte_t abtRxBuf[PN53X_USB_BUFFER_LEN];
|
|
res = pn53x_usb_bulk_read (DRIVER_DATA (pnd), abtRxBuf, sizeof (abtRxBuf));
|
|
if (res < 0) {
|
|
DBG ("usb_bulk_read failed with error %d", res);
|
|
pnd->iLastError = DEIO;
|
|
// try to interrupt current device state
|
|
pn53x_usb_ack(pnd);
|
|
return false;
|
|
}
|
|
|
|
if (pn53x_check_ack_frame (pnd, abtRxBuf, res)) {
|
|
// The PN53x is running the sent command
|
|
} else {
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
int
|
|
pn53x_usb_receive (nfc_device_t * pnd, byte_t * pbtData, const size_t szDataLen)
|
|
{
|
|
size_t len;
|
|
off_t offset = 0;
|
|
bool delayed_reply = false;
|
|
|
|
switch (CHIP_DATA (pnd)->ui8LastCommand) {
|
|
case InJumpForDEP:
|
|
case TgInitAsTarget:
|
|
case TgGetData:
|
|
DBG ("Delayed reply detected");
|
|
delayed_reply = true;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
byte_t abtRxBuf[PN53X_USB_BUFFER_LEN];
|
|
int res;
|
|
|
|
read:
|
|
res = pn53x_usb_bulk_read_ex (DRIVER_DATA (pnd), abtRxBuf, sizeof (abtRxBuf), delayed_reply ? 250 : 0);
|
|
|
|
if (delayed_reply && (res == -ETIMEDOUT)) {
|
|
if (DRIVER_DATA (pnd)->abort_flag) {
|
|
DRIVER_DATA (pnd)->abort_flag = false;
|
|
pn53x_usb_ack (pnd);
|
|
pnd->iLastError = DEABORT;
|
|
return -1;
|
|
} else {
|
|
goto read;
|
|
}
|
|
}
|
|
|
|
if (res < 0) {
|
|
DBG ("usb_bulk_read failed with error %d (%s)", res, strerror(-res));
|
|
pnd->iLastError = DEIO;
|
|
// try to interrupt current device state
|
|
pn53x_usb_ack(pnd);
|
|
return false;
|
|
}
|
|
|
|
const byte_t pn53x_preamble[3] = { 0x00, 0x00, 0xff };
|
|
if (0 != (memcmp (abtRxBuf, pn53x_preamble, 3))) {
|
|
ERR ("%s", "Frame preamble+start code mismatch");
|
|
pnd->iLastError = DEIO;
|
|
return -1;
|
|
}
|
|
offset += 3;
|
|
|
|
if ((0x01 == abtRxBuf[offset]) && (0xff == abtRxBuf[offset + 1])) {
|
|
// Error frame
|
|
ERR ("%s", "Application level error detected");
|
|
pnd->iLastError = DEISERRFRAME;
|
|
return -1;
|
|
} else if ((0xff == abtRxBuf[offset]) && (0xff == abtRxBuf[offset + 1])) {
|
|
// Extended frame
|
|
// FIXME: Code this
|
|
abort ();
|
|
offset += 3;
|
|
} else {
|
|
// Normal frame
|
|
if (256 != (abtRxBuf[offset] + abtRxBuf[offset + 1])) {
|
|
// TODO: Retry
|
|
ERR ("%s", "Length checksum mismatch");
|
|
pnd->iLastError = DEIO;
|
|
return -1;
|
|
}
|
|
|
|
// abtRxBuf[3] (LEN) include TFI + (CC+1)
|
|
len = abtRxBuf[offset] - 2;
|
|
offset += 2;
|
|
}
|
|
|
|
if (len > szDataLen) {
|
|
ERR ("Unable to receive data: buffer too small. (szDataLen: %zu, len: %zu)", szDataLen, len);
|
|
pnd->iLastError = DEIO;
|
|
return -1;
|
|
}
|
|
|
|
// TFI + PD0 (CC+1)
|
|
if (abtRxBuf[offset] != 0xD5) {
|
|
ERR ("%s", "TFI Mismatch");
|
|
pnd->iLastError = DEIO;
|
|
return -1;
|
|
}
|
|
offset += 1;
|
|
|
|
if (abtRxBuf[offset] != CHIP_DATA (pnd)->ui8LastCommand + 1) {
|
|
ERR ("%s", "Command Code verification failed");
|
|
pnd->iLastError = DEIO;
|
|
return -1;
|
|
}
|
|
offset += 1;
|
|
|
|
memcpy (pbtData, abtRxBuf + offset, len);
|
|
offset += len;
|
|
|
|
byte_t btDCS = (256 - 0xD5);
|
|
btDCS -= CHIP_DATA (pnd)->ui8LastCommand + 1;
|
|
for (size_t szPos = 0; szPos < len; szPos++) {
|
|
btDCS -= pbtData[szPos];
|
|
}
|
|
|
|
if (btDCS != abtRxBuf[offset]) {
|
|
ERR ("%s", "Data checksum mismatch");
|
|
pnd->iLastError = DEIO;
|
|
return -1;
|
|
}
|
|
offset += 1;
|
|
|
|
if (0x00 != abtRxBuf[offset]) {
|
|
ERR ("%s", "Frame postamble mismatch");
|
|
pnd->iLastError = DEIO;
|
|
return -1;
|
|
}
|
|
// The PN53x command is done and we successfully received the reply
|
|
return len;
|
|
}
|
|
|
|
int
|
|
pn53x_usb_ack (nfc_device_t * pnd)
|
|
{
|
|
return pn53x_usb_bulk_write (DRIVER_DATA (pnd), (byte_t *) ack_frame, sizeof (ack_frame));
|
|
}
|
|
|
|
bool
|
|
pn53x_usb_init (nfc_device_t *pnd)
|
|
{
|
|
// Sometimes PN53x USB doesn't reply ACK one the first frame, so we need to send a dummy one...
|
|
pn53x_check_communication (pnd);
|
|
// ...and we don't care about error
|
|
pnd->iLastError = 0;
|
|
|
|
if (!pn53x_init (pnd))
|
|
return false;
|
|
|
|
if (ASK_LOGO == DRIVER_DATA (pnd)->model) {
|
|
DBG ("ASK LoGO initialization.");
|
|
/* Internal registers */
|
|
/* Disable 100mA current limit, Power on Secure IC (SVDD) */
|
|
pn53x_write_register (pnd, REG_CONTROL_SWITCH_RNG, 0xFF, SYMBOL_CURLIMOFF | SYMBOL_SIC_SWITCH_EN | SYMBOL_RANDOM_DATAREADY);
|
|
/* Select the signal to be output on SIGOUT: Modulation signal (envelope) from the internal coder */
|
|
pn53x_write_register (pnd, REG_CIU_TXSEL, 0xFF, 0x14);
|
|
|
|
/* SFR Registers */
|
|
/* Setup push-pulls for pins from P30 to P35 */
|
|
pn53x_write_register (pnd, SFR_P3CFGB, 0xFF, 0x37);
|
|
|
|
/*
|
|
On ASK LoGO hardware:
|
|
LEDs port bits definition:
|
|
* LED 1: bit 2 (P32)
|
|
* LED 2: bit 1 (P31)
|
|
* LED 3: bit 0 or 3 (depending of hardware revision) (P30 or P33)
|
|
* LED 4: bit 5 (P35)
|
|
Notes:
|
|
* Set logical 0 to switch LED on; logical 1 to switch LED off.
|
|
* Bit 4 should be maintained at 1 to keep RF field on.
|
|
|
|
Progressive field activation:
|
|
The ASK LoGO hardware can progressively power-up the antenna.
|
|
To use this feature we have to switch on the field by switching on
|
|
the field on PN533 (RFConfiguration) then set P34 to '1', and cut-off the
|
|
field by switching off the field on PN533 then set P34 to '0'.
|
|
*/
|
|
|
|
/* Set P30, P31, P33, P35, P34 to logic 1 and P32 to 0 logic */
|
|
/* ie. Switch LED1 on and turn on progressive field */
|
|
pn53x_write_register (pnd, SFR_P3, 0xFF, _BV (P30) | _BV (P31) | _BV (P33) | _BV (P34) | _BV (P35));
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool
|
|
pn53x_usb_initiator_select_passive_target (nfc_device_t * pnd,
|
|
const nfc_modulation_t nm,
|
|
const byte_t * pbtInitData, const size_t szInitData,
|
|
nfc_target_t * pnt)
|
|
{
|
|
if (nm.nmt == NMT_ISO14443B) {
|
|
if (DRIVER_DATA (pnd)->model == ASK_LOGO) {
|
|
/* Switch RF field off, progressive field off and LED2 off */
|
|
byte_t abtCmd[] = { RFConfiguration, RFCI_FIELD, 0x00 };
|
|
if (!pn53x_transceive (pnd, abtCmd, sizeof (abtCmd), NULL, NULL))
|
|
return false;
|
|
if (!pn53x_write_register (pnd, SFR_P3, _BV(P34) | _BV(P31), _BV(P31)))
|
|
return false;
|
|
/* Switch RF field on, progressive field on and LED2 on */
|
|
abtCmd[2] = 0x01;
|
|
if (!pn53x_transceive (pnd, abtCmd, sizeof (abtCmd), NULL, NULL))
|
|
return false;
|
|
if (!pn53x_write_register (pnd, SFR_P3, _BV(P34) | _BV(P31), _BV(P34)))
|
|
return false;
|
|
}
|
|
}
|
|
return (pn53x_initiator_select_passive_target (pnd, nm, pbtInitData, szInitData, pnt));
|
|
}
|
|
|
|
bool
|
|
pn53x_usb_configure (nfc_device_t * pnd, const nfc_device_option_t ndo, const bool bEnable)
|
|
{
|
|
if (!pn53x_configure (pnd, ndo, bEnable))
|
|
return false;
|
|
|
|
switch (DRIVER_DATA (pnd)->model) {
|
|
case ASK_LOGO:
|
|
if (NDO_ACTIVATE_FIELD == ndo) {
|
|
/* Switch on/off LED2 according to ACTIVATE_FIELD option */
|
|
if (!pn53x_write_register (pnd, SFR_P3, _BV(P31), bEnable ? 0 : _BV (P31)))
|
|
return false;
|
|
}
|
|
break;
|
|
case SCM_SCL3711:
|
|
if (NDO_ACTIVATE_FIELD == ndo) {
|
|
// Switch on/off LED according to ACTIVATE_FIELD option
|
|
if (!pn53x_write_register (pnd, SFR_P3, _BV (P32), bEnable ? 0 : _BV (P32)))
|
|
return false;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool
|
|
pn53x_usb_abort_command (nfc_device_t * pnd)
|
|
{
|
|
DRIVER_DATA (pnd)->abort_flag = true;
|
|
return true;
|
|
}
|
|
|
|
const struct pn53x_io pn53x_usb_io = {
|
|
.send = pn53x_usb_send,
|
|
.receive = pn53x_usb_receive,
|
|
};
|
|
|
|
const struct nfc_driver_t pn53x_usb_driver = {
|
|
.name = PN53X_USB_DRIVER_NAME,
|
|
.probe = pn53x_usb_probe,
|
|
.connect = pn53x_usb_connect,
|
|
.disconnect = pn53x_usb_disconnect,
|
|
.strerror = pn53x_strerror,
|
|
|
|
.initiator_init = pn53x_initiator_init,
|
|
.initiator_select_passive_target = pn53x_usb_initiator_select_passive_target,
|
|
.initiator_poll_targets = pn53x_initiator_poll_targets,
|
|
.initiator_select_dep_target = pn53x_initiator_select_dep_target,
|
|
.initiator_deselect_target = pn53x_initiator_deselect_target,
|
|
.initiator_transceive_bytes = pn53x_initiator_transceive_bytes,
|
|
.initiator_transceive_bits = pn53x_initiator_transceive_bits,
|
|
.initiator_transceive_bytes_timed = pn53x_initiator_transceive_bytes_timed,
|
|
.initiator_transceive_bits_timed = pn53x_initiator_transceive_bits_timed,
|
|
|
|
.target_init = pn53x_target_init,
|
|
.target_send_bytes = pn53x_target_send_bytes,
|
|
.target_receive_bytes = pn53x_target_receive_bytes,
|
|
.target_send_bits = pn53x_target_send_bits,
|
|
.target_receive_bits = pn53x_target_receive_bits,
|
|
|
|
.configure = pn53x_usb_configure,
|
|
|
|
.abort_command = pn53x_usb_abort_command,
|
|
};
|