NFC: pn533: Separate physical layer from the core implementation
The driver now has all core stuff isolated in one file, and all the hardware link specifics in another. Writing a pn533 driver on top of another hardware link is now just a matter of adding a new file for that new hardware specifics. The first user of this separation will be the i2c based pn532 driver that reuses pn533 core implementation on top of an i2c layer. Signed-off-by: Michael Thalmeier <michael.thalmeier@hale.at> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
parent
37f895d7e8
commit
9815c7cf22
|
@ -5,16 +5,6 @@
|
|||
menu "Near Field Communication (NFC) devices"
|
||||
depends on NFC
|
||||
|
||||
config NFC_PN533
|
||||
tristate "NXP PN533 USB driver"
|
||||
depends on USB
|
||||
help
|
||||
NXP PN533 USB driver.
|
||||
This driver provides support for NFC NXP PN533 devices.
|
||||
|
||||
Say Y here to compile support for PN533 devices into the
|
||||
kernel or say M to compile it as module (pn533).
|
||||
|
||||
config NFC_WILINK
|
||||
tristate "Texas Instruments NFC WiLink driver"
|
||||
depends on TI_ST && NFC_NCI
|
||||
|
@ -70,6 +60,7 @@ config NFC_PORT100
|
|||
|
||||
source "drivers/nfc/fdp/Kconfig"
|
||||
source "drivers/nfc/pn544/Kconfig"
|
||||
source "drivers/nfc/pn533/Kconfig"
|
||||
source "drivers/nfc/microread/Kconfig"
|
||||
source "drivers/nfc/nfcmrvl/Kconfig"
|
||||
source "drivers/nfc/st21nfca/Kconfig"
|
||||
|
|
|
@ -5,7 +5,7 @@
|
|||
obj-$(CONFIG_NFC_FDP) += fdp/
|
||||
obj-$(CONFIG_NFC_PN544) += pn544/
|
||||
obj-$(CONFIG_NFC_MICROREAD) += microread/
|
||||
obj-$(CONFIG_NFC_PN533) += pn533.o
|
||||
obj-$(CONFIG_NFC_PN533) += pn533/
|
||||
obj-$(CONFIG_NFC_WILINK) += nfcwilink.o
|
||||
obj-$(CONFIG_NFC_MEI_PHY) += mei_phy.o
|
||||
obj-$(CONFIG_NFC_SIM) += nfcsim.o
|
||||
|
|
16
drivers/nfc/pn533/Kconfig
Normal file
16
drivers/nfc/pn533/Kconfig
Normal file
|
@ -0,0 +1,16 @@
|
|||
config NFC_PN533
|
||||
tristate
|
||||
help
|
||||
NXP PN533 core driver.
|
||||
This driver provides core functionality for NXP PN533 NFC devices.
|
||||
|
||||
config NFC_PN533_USB
|
||||
tristate "NFC PN533 device support (USB)"
|
||||
depends on USB
|
||||
select NFC_PN533
|
||||
---help---
|
||||
This module adds support for the NXP pn533 USB interface.
|
||||
Select this if your platform is using the USB bus.
|
||||
|
||||
If you choose to build a module, it'll be called pn533_usb.
|
||||
Say N if unsure.
|
7
drivers/nfc/pn533/Makefile
Normal file
7
drivers/nfc/pn533/Makefile
Normal file
|
@ -0,0 +1,7 @@
|
|||
#
|
||||
# Makefile for PN533 NFC driver
|
||||
#
|
||||
pn533_usb-objs = usb.o
|
||||
|
||||
obj-$(CONFIG_NFC_PN533) += pn533.o
|
||||
obj-$(CONFIG_NFC_PN533_USB) += pn533_usb.o
|
File diff suppressed because it is too large
Load diff
235
drivers/nfc/pn533/pn533.h
Normal file
235
drivers/nfc/pn533/pn533.h
Normal file
|
@ -0,0 +1,235 @@
|
|||
/*
|
||||
* Driver for NXP PN533 NFC Chip
|
||||
*
|
||||
* Copyright (C) 2011 Instituto Nokia de Tecnologia
|
||||
* Copyright (C) 2012-2013 Tieto Poland
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 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 General Public License
|
||||
* along with this program; if not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#define PN533_DEVICE_STD 0x1
|
||||
#define PN533_DEVICE_PASORI 0x2
|
||||
#define PN533_DEVICE_ACR122U 0x3
|
||||
|
||||
#define PN533_ALL_PROTOCOLS (NFC_PROTO_JEWEL_MASK | NFC_PROTO_MIFARE_MASK |\
|
||||
NFC_PROTO_FELICA_MASK | NFC_PROTO_ISO14443_MASK |\
|
||||
NFC_PROTO_NFC_DEP_MASK |\
|
||||
NFC_PROTO_ISO14443_B_MASK)
|
||||
|
||||
#define PN533_NO_TYPE_B_PROTOCOLS (NFC_PROTO_JEWEL_MASK | \
|
||||
NFC_PROTO_MIFARE_MASK | \
|
||||
NFC_PROTO_FELICA_MASK | \
|
||||
NFC_PROTO_ISO14443_MASK | \
|
||||
NFC_PROTO_NFC_DEP_MASK)
|
||||
|
||||
/* Standard pn533 frame definitions (standard and extended)*/
|
||||
#define PN533_STD_FRAME_HEADER_LEN (sizeof(struct pn533_std_frame) \
|
||||
+ 2) /* data[0] TFI, data[1] CC */
|
||||
#define PN533_STD_FRAME_TAIL_LEN 2 /* data[len] DCS, data[len + 1] postamble*/
|
||||
|
||||
#define PN533_EXT_FRAME_HEADER_LEN (sizeof(struct pn533_ext_frame) \
|
||||
+ 2) /* data[0] TFI, data[1] CC */
|
||||
|
||||
#define PN533_CMD_DATAEXCH_HEAD_LEN 1
|
||||
#define PN533_CMD_DATAEXCH_DATA_MAXLEN 262
|
||||
#define PN533_CMD_DATAFRAME_MAXLEN 240 /* max data length (send) */
|
||||
|
||||
/*
|
||||
* Max extended frame payload len, excluding TFI and CC
|
||||
* which are already in PN533_FRAME_HEADER_LEN.
|
||||
*/
|
||||
#define PN533_STD_FRAME_MAX_PAYLOAD_LEN 263
|
||||
|
||||
|
||||
/* Preamble (1), SoPC (2), ACK Code (2), Postamble (1) */
|
||||
#define PN533_STD_FRAME_ACK_SIZE 6
|
||||
#define PN533_STD_FRAME_CHECKSUM(f) (f->data[f->datalen])
|
||||
#define PN533_STD_FRAME_POSTAMBLE(f) (f->data[f->datalen + 1])
|
||||
/* Half start code (3), LEN (4) should be 0xffff for extended frame */
|
||||
#define PN533_STD_IS_EXTENDED(hdr) ((hdr)->datalen == 0xFF \
|
||||
&& (hdr)->datalen_checksum == 0xFF)
|
||||
#define PN533_EXT_FRAME_CHECKSUM(f) (f->data[be16_to_cpu(f->datalen)])
|
||||
|
||||
/* start of frame */
|
||||
#define PN533_STD_FRAME_SOF 0x00FF
|
||||
|
||||
/* standard frame identifier: in/out/error */
|
||||
#define PN533_STD_FRAME_IDENTIFIER(f) (f->data[0]) /* TFI */
|
||||
#define PN533_STD_FRAME_DIR_OUT 0xD4
|
||||
#define PN533_STD_FRAME_DIR_IN 0xD5
|
||||
|
||||
/* PN533 Commands */
|
||||
#define PN533_FRAME_CMD(f) (f->data[1])
|
||||
|
||||
#define PN533_CMD_GET_FIRMWARE_VERSION 0x02
|
||||
#define PN533_CMD_RF_CONFIGURATION 0x32
|
||||
#define PN533_CMD_IN_DATA_EXCHANGE 0x40
|
||||
#define PN533_CMD_IN_COMM_THRU 0x42
|
||||
#define PN533_CMD_IN_LIST_PASSIVE_TARGET 0x4A
|
||||
#define PN533_CMD_IN_ATR 0x50
|
||||
#define PN533_CMD_IN_RELEASE 0x52
|
||||
#define PN533_CMD_IN_JUMP_FOR_DEP 0x56
|
||||
|
||||
#define PN533_CMD_TG_INIT_AS_TARGET 0x8c
|
||||
#define PN533_CMD_TG_GET_DATA 0x86
|
||||
#define PN533_CMD_TG_SET_DATA 0x8e
|
||||
#define PN533_CMD_TG_SET_META_DATA 0x94
|
||||
#define PN533_CMD_UNDEF 0xff
|
||||
|
||||
#define PN533_CMD_RESPONSE(cmd) (cmd + 1)
|
||||
|
||||
/* PN533 Return codes */
|
||||
#define PN533_CMD_RET_MASK 0x3F
|
||||
#define PN533_CMD_MI_MASK 0x40
|
||||
#define PN533_CMD_RET_SUCCESS 0x00
|
||||
|
||||
|
||||
enum pn533_protocol_type {
|
||||
PN533_PROTO_REQ_ACK_RESP = 0,
|
||||
PN533_PROTO_REQ_RESP
|
||||
};
|
||||
|
||||
/* Poll modulations */
|
||||
enum {
|
||||
PN533_POLL_MOD_106KBPS_A,
|
||||
PN533_POLL_MOD_212KBPS_FELICA,
|
||||
PN533_POLL_MOD_424KBPS_FELICA,
|
||||
PN533_POLL_MOD_106KBPS_JEWEL,
|
||||
PN533_POLL_MOD_847KBPS_B,
|
||||
PN533_LISTEN_MOD,
|
||||
|
||||
__PN533_POLL_MOD_AFTER_LAST,
|
||||
};
|
||||
#define PN533_POLL_MOD_MAX (__PN533_POLL_MOD_AFTER_LAST - 1)
|
||||
|
||||
struct pn533_std_frame {
|
||||
u8 preamble;
|
||||
__be16 start_frame;
|
||||
u8 datalen;
|
||||
u8 datalen_checksum;
|
||||
u8 data[];
|
||||
} __packed;
|
||||
|
||||
struct pn533_ext_frame { /* Extended Information frame */
|
||||
u8 preamble;
|
||||
__be16 start_frame;
|
||||
__be16 eif_flag; /* fixed to 0xFFFF */
|
||||
__be16 datalen;
|
||||
u8 datalen_checksum;
|
||||
u8 data[];
|
||||
} __packed;
|
||||
|
||||
struct pn533 {
|
||||
struct nfc_dev *nfc_dev;
|
||||
u32 device_type;
|
||||
enum pn533_protocol_type protocol_type;
|
||||
|
||||
struct sk_buff_head resp_q;
|
||||
struct sk_buff_head fragment_skb;
|
||||
|
||||
struct workqueue_struct *wq;
|
||||
struct work_struct cmd_work;
|
||||
struct work_struct cmd_complete_work;
|
||||
struct delayed_work poll_work;
|
||||
struct work_struct mi_rx_work;
|
||||
struct work_struct mi_tx_work;
|
||||
struct work_struct mi_tm_rx_work;
|
||||
struct work_struct mi_tm_tx_work;
|
||||
struct work_struct tg_work;
|
||||
struct work_struct rf_work;
|
||||
|
||||
struct list_head cmd_queue;
|
||||
struct pn533_cmd *cmd;
|
||||
u8 cmd_pending;
|
||||
struct mutex cmd_lock; /* protects cmd queue */
|
||||
|
||||
void *cmd_complete_mi_arg;
|
||||
void *cmd_complete_dep_arg;
|
||||
|
||||
struct pn533_poll_modulations *poll_mod_active[PN533_POLL_MOD_MAX + 1];
|
||||
u8 poll_mod_count;
|
||||
u8 poll_mod_curr;
|
||||
u8 poll_dep;
|
||||
u32 poll_protocols;
|
||||
u32 listen_protocols;
|
||||
struct timer_list listen_timer;
|
||||
int cancel_listen;
|
||||
|
||||
u8 *gb;
|
||||
size_t gb_len;
|
||||
|
||||
u8 tgt_available_prots;
|
||||
u8 tgt_active_prot;
|
||||
u8 tgt_mode;
|
||||
|
||||
struct pn533_frame_ops *ops;
|
||||
|
||||
struct device *dev;
|
||||
void *phy;
|
||||
struct pn533_phy_ops *phy_ops;
|
||||
};
|
||||
|
||||
typedef int (*pn533_send_async_complete_t) (struct pn533 *dev, void *arg,
|
||||
struct sk_buff *resp);
|
||||
|
||||
struct pn533_cmd {
|
||||
struct list_head queue;
|
||||
u8 code;
|
||||
int status;
|
||||
struct sk_buff *req;
|
||||
struct sk_buff *resp;
|
||||
pn533_send_async_complete_t complete_cb;
|
||||
void *complete_cb_context;
|
||||
};
|
||||
|
||||
|
||||
struct pn533_frame_ops {
|
||||
void (*tx_frame_init)(void *frame, u8 cmd_code);
|
||||
void (*tx_frame_finish)(void *frame);
|
||||
void (*tx_update_payload_len)(void *frame, int len);
|
||||
int tx_header_len;
|
||||
int tx_tail_len;
|
||||
|
||||
bool (*rx_is_frame_valid)(void *frame, struct pn533 *dev);
|
||||
bool (*rx_frame_is_ack)(void *frame);
|
||||
int (*rx_frame_size)(void *frame);
|
||||
int rx_header_len;
|
||||
int rx_tail_len;
|
||||
|
||||
int max_payload_len;
|
||||
u8 (*get_cmd_code)(void *frame);
|
||||
};
|
||||
|
||||
|
||||
struct pn533_phy_ops {
|
||||
int (*send_frame)(struct pn533 *priv,
|
||||
struct sk_buff *out);
|
||||
int (*send_ack)(struct pn533 *dev, gfp_t flags);
|
||||
void (*abort_cmd)(struct pn533 *priv, gfp_t flags);
|
||||
};
|
||||
|
||||
|
||||
struct pn533 *pn533_register_device(u32 device_type,
|
||||
u32 protocols,
|
||||
enum pn533_protocol_type protocol_type,
|
||||
void *phy,
|
||||
struct pn533_phy_ops *phy_ops,
|
||||
struct pn533_frame_ops *fops,
|
||||
struct device *dev);
|
||||
|
||||
void pn533_unregister_device(struct pn533 *priv);
|
||||
void pn533_recv_frame(struct pn533 *dev, struct sk_buff *skb, int status);
|
||||
|
||||
bool pn533_rx_frame_is_cmd_response(struct pn533 *dev, void *frame);
|
||||
bool pn533_rx_frame_is_ack(void *_frame);
|
598
drivers/nfc/pn533/usb.c
Normal file
598
drivers/nfc/pn533/usb.c
Normal file
|
@ -0,0 +1,598 @@
|
|||
/*
|
||||
* Driver for NXP PN533 NFC Chip - USB transport layer
|
||||
*
|
||||
* Copyright (C) 2011 Instituto Nokia de Tecnologia
|
||||
* Copyright (C) 2012-2013 Tieto Poland
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 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 General Public License
|
||||
* along with this program; if not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <linux/device.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/usb.h>
|
||||
#include <linux/nfc.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include <net/nfc/nfc.h>
|
||||
#include "pn533.h"
|
||||
|
||||
#define VERSION "0.1"
|
||||
|
||||
#define PN533_VENDOR_ID 0x4CC
|
||||
#define PN533_PRODUCT_ID 0x2533
|
||||
|
||||
#define SCM_VENDOR_ID 0x4E6
|
||||
#define SCL3711_PRODUCT_ID 0x5591
|
||||
|
||||
#define SONY_VENDOR_ID 0x054c
|
||||
#define PASORI_PRODUCT_ID 0x02e1
|
||||
|
||||
#define ACS_VENDOR_ID 0x072f
|
||||
#define ACR122U_PRODUCT_ID 0x2200
|
||||
|
||||
static const struct usb_device_id pn533_usb_table[] = {
|
||||
{ USB_DEVICE(PN533_VENDOR_ID, PN533_PRODUCT_ID),
|
||||
.driver_info = PN533_DEVICE_STD },
|
||||
{ USB_DEVICE(SCM_VENDOR_ID, SCL3711_PRODUCT_ID),
|
||||
.driver_info = PN533_DEVICE_STD },
|
||||
{ USB_DEVICE(SONY_VENDOR_ID, PASORI_PRODUCT_ID),
|
||||
.driver_info = PN533_DEVICE_PASORI },
|
||||
{ USB_DEVICE(ACS_VENDOR_ID, ACR122U_PRODUCT_ID),
|
||||
.driver_info = PN533_DEVICE_ACR122U },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(usb, pn533_usb_table);
|
||||
|
||||
struct pn533_usb_phy {
|
||||
struct usb_device *udev;
|
||||
struct usb_interface *interface;
|
||||
|
||||
struct urb *out_urb;
|
||||
struct urb *in_urb;
|
||||
|
||||
struct pn533 *priv;
|
||||
};
|
||||
|
||||
static void pn533_recv_response(struct urb *urb)
|
||||
{
|
||||
struct pn533_usb_phy *phy = urb->context;
|
||||
struct sk_buff *skb = NULL;
|
||||
|
||||
if (!urb->status) {
|
||||
skb = alloc_skb(urb->actual_length, GFP_KERNEL);
|
||||
if (!skb) {
|
||||
nfc_err(&phy->udev->dev, "failed to alloc memory\n");
|
||||
} else {
|
||||
memcpy(skb_put(skb, urb->actual_length),
|
||||
urb->transfer_buffer, urb->actual_length);
|
||||
}
|
||||
}
|
||||
|
||||
pn533_recv_frame(phy->priv, skb, urb->status);
|
||||
}
|
||||
|
||||
static int pn533_submit_urb_for_response(struct pn533_usb_phy *phy, gfp_t flags)
|
||||
{
|
||||
phy->in_urb->complete = pn533_recv_response;
|
||||
|
||||
return usb_submit_urb(phy->in_urb, flags);
|
||||
}
|
||||
|
||||
static void pn533_recv_ack(struct urb *urb)
|
||||
{
|
||||
struct pn533_usb_phy *phy = urb->context;
|
||||
struct pn533 *priv = phy->priv;
|
||||
struct pn533_cmd *cmd = priv->cmd;
|
||||
struct pn533_std_frame *in_frame;
|
||||
int rc;
|
||||
|
||||
cmd->status = urb->status;
|
||||
|
||||
switch (urb->status) {
|
||||
case 0:
|
||||
break; /* success */
|
||||
case -ECONNRESET:
|
||||
case -ENOENT:
|
||||
dev_dbg(&phy->udev->dev,
|
||||
"The urb has been stopped (status %d)\n",
|
||||
urb->status);
|
||||
goto sched_wq;
|
||||
case -ESHUTDOWN:
|
||||
default:
|
||||
nfc_err(&phy->udev->dev,
|
||||
"Urb failure (status %d)\n", urb->status);
|
||||
goto sched_wq;
|
||||
}
|
||||
|
||||
in_frame = phy->in_urb->transfer_buffer;
|
||||
|
||||
if (!pn533_rx_frame_is_ack(in_frame)) {
|
||||
nfc_err(&phy->udev->dev, "Received an invalid ack\n");
|
||||
cmd->status = -EIO;
|
||||
goto sched_wq;
|
||||
}
|
||||
|
||||
rc = pn533_submit_urb_for_response(phy, GFP_ATOMIC);
|
||||
if (rc) {
|
||||
nfc_err(&phy->udev->dev,
|
||||
"usb_submit_urb failed with result %d\n", rc);
|
||||
cmd->status = rc;
|
||||
goto sched_wq;
|
||||
}
|
||||
|
||||
return;
|
||||
|
||||
sched_wq:
|
||||
queue_work(priv->wq, &priv->cmd_complete_work);
|
||||
}
|
||||
|
||||
static int pn533_submit_urb_for_ack(struct pn533_usb_phy *phy, gfp_t flags)
|
||||
{
|
||||
phy->in_urb->complete = pn533_recv_ack;
|
||||
|
||||
return usb_submit_urb(phy->in_urb, flags);
|
||||
}
|
||||
|
||||
static int pn533_usb_send_ack(struct pn533 *dev, gfp_t flags)
|
||||
{
|
||||
struct pn533_usb_phy *phy = dev->phy;
|
||||
u8 ack[6] = {0x00, 0x00, 0xff, 0x00, 0xff, 0x00};
|
||||
/* spec 7.1.1.3: Preamble, SoPC (2), ACK Code (2), Postamble */
|
||||
int rc;
|
||||
|
||||
phy->out_urb->transfer_buffer = ack;
|
||||
phy->out_urb->transfer_buffer_length = sizeof(ack);
|
||||
rc = usb_submit_urb(phy->out_urb, flags);
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
static int pn533_usb_send_frame(struct pn533 *dev,
|
||||
struct sk_buff *out)
|
||||
{
|
||||
struct pn533_usb_phy *phy = dev->phy;
|
||||
int rc;
|
||||
|
||||
if (phy->priv == NULL)
|
||||
phy->priv = dev;
|
||||
|
||||
phy->out_urb->transfer_buffer = out->data;
|
||||
phy->out_urb->transfer_buffer_length = out->len;
|
||||
|
||||
print_hex_dump_debug("PN533 TX: ", DUMP_PREFIX_NONE, 16, 1,
|
||||
out->data, out->len, false);
|
||||
|
||||
rc = usb_submit_urb(phy->out_urb, GFP_KERNEL);
|
||||
if (rc)
|
||||
return rc;
|
||||
|
||||
if (dev->protocol_type == PN533_PROTO_REQ_RESP) {
|
||||
/* request for response for sent packet directly */
|
||||
rc = pn533_submit_urb_for_response(phy, GFP_ATOMIC);
|
||||
if (rc)
|
||||
goto error;
|
||||
} else if (dev->protocol_type == PN533_PROTO_REQ_ACK_RESP) {
|
||||
/* request for ACK if that's the case */
|
||||
rc = pn533_submit_urb_for_ack(phy, GFP_KERNEL);
|
||||
if (rc)
|
||||
goto error;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
error:
|
||||
usb_unlink_urb(phy->out_urb);
|
||||
return rc;
|
||||
}
|
||||
|
||||
static void pn533_usb_abort_cmd(struct pn533 *dev, gfp_t flags)
|
||||
{
|
||||
struct pn533_usb_phy *phy = dev->phy;
|
||||
|
||||
/* ACR122U does not support any command which aborts last
|
||||
* issued command i.e. as ACK for standard PN533. Additionally,
|
||||
* it behaves stange, sending broken or incorrect responses,
|
||||
* when we cancel urb before the chip will send response.
|
||||
*/
|
||||
if (dev->device_type == PN533_DEVICE_ACR122U)
|
||||
return;
|
||||
|
||||
/* An ack will cancel the last issued command */
|
||||
pn533_usb_send_ack(dev, flags);
|
||||
|
||||
/* cancel the urb request */
|
||||
usb_kill_urb(phy->in_urb);
|
||||
}
|
||||
|
||||
/* ACR122 specific structs and fucntions */
|
||||
|
||||
/* ACS ACR122 pn533 frame definitions */
|
||||
#define PN533_ACR122_TX_FRAME_HEADER_LEN (sizeof(struct pn533_acr122_tx_frame) \
|
||||
+ 2)
|
||||
#define PN533_ACR122_TX_FRAME_TAIL_LEN 0
|
||||
#define PN533_ACR122_RX_FRAME_HEADER_LEN (sizeof(struct pn533_acr122_rx_frame) \
|
||||
+ 2)
|
||||
#define PN533_ACR122_RX_FRAME_TAIL_LEN 2
|
||||
#define PN533_ACR122_FRAME_MAX_PAYLOAD_LEN PN533_STD_FRAME_MAX_PAYLOAD_LEN
|
||||
|
||||
/* CCID messages types */
|
||||
#define PN533_ACR122_PC_TO_RDR_ICCPOWERON 0x62
|
||||
#define PN533_ACR122_PC_TO_RDR_ESCAPE 0x6B
|
||||
|
||||
#define PN533_ACR122_RDR_TO_PC_ESCAPE 0x83
|
||||
|
||||
|
||||
struct pn533_acr122_ccid_hdr {
|
||||
u8 type;
|
||||
u32 datalen;
|
||||
u8 slot;
|
||||
u8 seq;
|
||||
|
||||
/*
|
||||
* 3 msg specific bytes or status, error and 1 specific
|
||||
* byte for reposnse msg
|
||||
*/
|
||||
u8 params[3];
|
||||
u8 data[]; /* payload */
|
||||
} __packed;
|
||||
|
||||
struct pn533_acr122_apdu_hdr {
|
||||
u8 class;
|
||||
u8 ins;
|
||||
u8 p1;
|
||||
u8 p2;
|
||||
} __packed;
|
||||
|
||||
struct pn533_acr122_tx_frame {
|
||||
struct pn533_acr122_ccid_hdr ccid;
|
||||
struct pn533_acr122_apdu_hdr apdu;
|
||||
u8 datalen;
|
||||
u8 data[]; /* pn533 frame: TFI ... */
|
||||
} __packed;
|
||||
|
||||
struct pn533_acr122_rx_frame {
|
||||
struct pn533_acr122_ccid_hdr ccid;
|
||||
u8 data[]; /* pn533 frame : TFI ... */
|
||||
} __packed;
|
||||
|
||||
static void pn533_acr122_tx_frame_init(void *_frame, u8 cmd_code)
|
||||
{
|
||||
struct pn533_acr122_tx_frame *frame = _frame;
|
||||
|
||||
frame->ccid.type = PN533_ACR122_PC_TO_RDR_ESCAPE;
|
||||
/* sizeof(apdu_hdr) + sizeof(datalen) */
|
||||
frame->ccid.datalen = sizeof(frame->apdu) + 1;
|
||||
frame->ccid.slot = 0;
|
||||
frame->ccid.seq = 0;
|
||||
frame->ccid.params[0] = 0;
|
||||
frame->ccid.params[1] = 0;
|
||||
frame->ccid.params[2] = 0;
|
||||
|
||||
frame->data[0] = PN533_STD_FRAME_DIR_OUT;
|
||||
frame->data[1] = cmd_code;
|
||||
frame->datalen = 2; /* data[0] + data[1] */
|
||||
|
||||
frame->apdu.class = 0xFF;
|
||||
frame->apdu.ins = 0;
|
||||
frame->apdu.p1 = 0;
|
||||
frame->apdu.p2 = 0;
|
||||
}
|
||||
|
||||
static void pn533_acr122_tx_frame_finish(void *_frame)
|
||||
{
|
||||
struct pn533_acr122_tx_frame *frame = _frame;
|
||||
|
||||
frame->ccid.datalen += frame->datalen;
|
||||
}
|
||||
|
||||
static void pn533_acr122_tx_update_payload_len(void *_frame, int len)
|
||||
{
|
||||
struct pn533_acr122_tx_frame *frame = _frame;
|
||||
|
||||
frame->datalen += len;
|
||||
}
|
||||
|
||||
static bool pn533_acr122_is_rx_frame_valid(void *_frame, struct pn533 *dev)
|
||||
{
|
||||
struct pn533_acr122_rx_frame *frame = _frame;
|
||||
|
||||
if (frame->ccid.type != 0x83)
|
||||
return false;
|
||||
|
||||
if (!frame->ccid.datalen)
|
||||
return false;
|
||||
|
||||
if (frame->data[frame->ccid.datalen - 2] == 0x63)
|
||||
return false;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
static int pn533_acr122_rx_frame_size(void *frame)
|
||||
{
|
||||
struct pn533_acr122_rx_frame *f = frame;
|
||||
|
||||
/* f->ccid.datalen already includes tail length */
|
||||
return sizeof(struct pn533_acr122_rx_frame) + f->ccid.datalen;
|
||||
}
|
||||
|
||||
static u8 pn533_acr122_get_cmd_code(void *frame)
|
||||
{
|
||||
struct pn533_acr122_rx_frame *f = frame;
|
||||
|
||||
return PN533_FRAME_CMD(f);
|
||||
}
|
||||
|
||||
static struct pn533_frame_ops pn533_acr122_frame_ops = {
|
||||
.tx_frame_init = pn533_acr122_tx_frame_init,
|
||||
.tx_frame_finish = pn533_acr122_tx_frame_finish,
|
||||
.tx_update_payload_len = pn533_acr122_tx_update_payload_len,
|
||||
.tx_header_len = PN533_ACR122_TX_FRAME_HEADER_LEN,
|
||||
.tx_tail_len = PN533_ACR122_TX_FRAME_TAIL_LEN,
|
||||
|
||||
.rx_is_frame_valid = pn533_acr122_is_rx_frame_valid,
|
||||
.rx_header_len = PN533_ACR122_RX_FRAME_HEADER_LEN,
|
||||
.rx_tail_len = PN533_ACR122_RX_FRAME_TAIL_LEN,
|
||||
.rx_frame_size = pn533_acr122_rx_frame_size,
|
||||
|
||||
.max_payload_len = PN533_ACR122_FRAME_MAX_PAYLOAD_LEN,
|
||||
.get_cmd_code = pn533_acr122_get_cmd_code,
|
||||
};
|
||||
|
||||
struct pn533_acr122_poweron_rdr_arg {
|
||||
int rc;
|
||||
struct completion done;
|
||||
};
|
||||
|
||||
static void pn533_acr122_poweron_rdr_resp(struct urb *urb)
|
||||
{
|
||||
struct pn533_acr122_poweron_rdr_arg *arg = urb->context;
|
||||
|
||||
dev_dbg(&urb->dev->dev, "%s\n", __func__);
|
||||
|
||||
print_hex_dump_debug("ACR122 RX: ", DUMP_PREFIX_NONE, 16, 1,
|
||||
urb->transfer_buffer, urb->transfer_buffer_length,
|
||||
false);
|
||||
|
||||
arg->rc = urb->status;
|
||||
complete(&arg->done);
|
||||
}
|
||||
|
||||
static int pn533_acr122_poweron_rdr(struct pn533_usb_phy *phy)
|
||||
{
|
||||
/* Power on th reader (CCID cmd) */
|
||||
u8 cmd[10] = {PN533_ACR122_PC_TO_RDR_ICCPOWERON,
|
||||
0, 0, 0, 0, 0, 0, 3, 0, 0};
|
||||
int rc;
|
||||
void *cntx;
|
||||
struct pn533_acr122_poweron_rdr_arg arg;
|
||||
|
||||
dev_dbg(&phy->udev->dev, "%s\n", __func__);
|
||||
|
||||
init_completion(&arg.done);
|
||||
cntx = phy->in_urb->context; /* backup context */
|
||||
|
||||
phy->in_urb->complete = pn533_acr122_poweron_rdr_resp;
|
||||
phy->in_urb->context = &arg;
|
||||
|
||||
phy->out_urb->transfer_buffer = cmd;
|
||||
phy->out_urb->transfer_buffer_length = sizeof(cmd);
|
||||
|
||||
print_hex_dump_debug("ACR122 TX: ", DUMP_PREFIX_NONE, 16, 1,
|
||||
cmd, sizeof(cmd), false);
|
||||
|
||||
rc = usb_submit_urb(phy->out_urb, GFP_KERNEL);
|
||||
if (rc) {
|
||||
nfc_err(&phy->udev->dev,
|
||||
"Reader power on cmd error %d\n", rc);
|
||||
return rc;
|
||||
}
|
||||
|
||||
rc = usb_submit_urb(phy->in_urb, GFP_KERNEL);
|
||||
if (rc) {
|
||||
nfc_err(&phy->udev->dev,
|
||||
"Can't submit reader poweron cmd response %d\n", rc);
|
||||
return rc;
|
||||
}
|
||||
|
||||
wait_for_completion(&arg.done);
|
||||
phy->in_urb->context = cntx; /* restore context */
|
||||
|
||||
return arg.rc;
|
||||
}
|
||||
|
||||
static void pn533_send_complete(struct urb *urb)
|
||||
{
|
||||
struct pn533_usb_phy *phy = urb->context;
|
||||
|
||||
switch (urb->status) {
|
||||
case 0:
|
||||
break; /* success */
|
||||
case -ECONNRESET:
|
||||
case -ENOENT:
|
||||
dev_dbg(&phy->udev->dev,
|
||||
"The urb has been stopped (status %d)\n",
|
||||
urb->status);
|
||||
break;
|
||||
case -ESHUTDOWN:
|
||||
default:
|
||||
nfc_err(&phy->udev->dev,
|
||||
"Urb failure (status %d)\n",
|
||||
urb->status);
|
||||
}
|
||||
}
|
||||
|
||||
static struct pn533_phy_ops usb_phy_ops = {
|
||||
.send_frame = pn533_usb_send_frame,
|
||||
.send_ack = pn533_usb_send_ack,
|
||||
.abort_cmd = pn533_usb_abort_cmd,
|
||||
};
|
||||
|
||||
static int pn533_usb_probe(struct usb_interface *interface,
|
||||
const struct usb_device_id *id)
|
||||
{
|
||||
struct pn533 *priv;
|
||||
struct pn533_usb_phy *phy;
|
||||
struct usb_host_interface *iface_desc;
|
||||
struct usb_endpoint_descriptor *endpoint;
|
||||
int in_endpoint = 0;
|
||||
int out_endpoint = 0;
|
||||
int rc = -ENOMEM;
|
||||
int i;
|
||||
u32 protocols;
|
||||
enum pn533_protocol_type protocol_type = PN533_PROTO_REQ_ACK_RESP;
|
||||
struct pn533_frame_ops *fops = NULL;
|
||||
unsigned char *in_buf;
|
||||
int in_buf_len = PN533_EXT_FRAME_HEADER_LEN +
|
||||
PN533_STD_FRAME_MAX_PAYLOAD_LEN +
|
||||
PN533_STD_FRAME_TAIL_LEN;
|
||||
|
||||
phy = devm_kzalloc(&interface->dev, sizeof(*phy), GFP_KERNEL);
|
||||
if (!phy)
|
||||
return -ENOMEM;
|
||||
|
||||
in_buf = kzalloc(in_buf_len, GFP_KERNEL);
|
||||
if (!in_buf) {
|
||||
rc = -ENOMEM;
|
||||
goto out_free_phy;
|
||||
}
|
||||
|
||||
phy->udev = usb_get_dev(interface_to_usbdev(interface));
|
||||
phy->interface = interface;
|
||||
|
||||
iface_desc = interface->cur_altsetting;
|
||||
for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
|
||||
endpoint = &iface_desc->endpoint[i].desc;
|
||||
|
||||
if (!in_endpoint && usb_endpoint_is_bulk_in(endpoint))
|
||||
in_endpoint = endpoint->bEndpointAddress;
|
||||
|
||||
if (!out_endpoint && usb_endpoint_is_bulk_out(endpoint))
|
||||
out_endpoint = endpoint->bEndpointAddress;
|
||||
}
|
||||
|
||||
if (!in_endpoint || !out_endpoint) {
|
||||
nfc_err(&interface->dev,
|
||||
"Could not find bulk-in or bulk-out endpoint\n");
|
||||
rc = -ENODEV;
|
||||
goto error;
|
||||
}
|
||||
|
||||
phy->in_urb = usb_alloc_urb(0, GFP_KERNEL);
|
||||
phy->out_urb = usb_alloc_urb(0, GFP_KERNEL);
|
||||
|
||||
if (!phy->in_urb || !phy->out_urb)
|
||||
goto error;
|
||||
|
||||
usb_fill_bulk_urb(phy->in_urb, phy->udev,
|
||||
usb_rcvbulkpipe(phy->udev, in_endpoint),
|
||||
in_buf, in_buf_len, NULL, phy);
|
||||
|
||||
usb_fill_bulk_urb(phy->out_urb, phy->udev,
|
||||
usb_sndbulkpipe(phy->udev, out_endpoint),
|
||||
NULL, 0, pn533_send_complete, phy);
|
||||
|
||||
|
||||
switch (id->driver_info) {
|
||||
case PN533_DEVICE_STD:
|
||||
protocols = PN533_ALL_PROTOCOLS;
|
||||
break;
|
||||
|
||||
case PN533_DEVICE_PASORI:
|
||||
protocols = PN533_NO_TYPE_B_PROTOCOLS;
|
||||
break;
|
||||
|
||||
case PN533_DEVICE_ACR122U:
|
||||
protocols = PN533_NO_TYPE_B_PROTOCOLS;
|
||||
fops = &pn533_acr122_frame_ops;
|
||||
protocol_type = PN533_PROTO_REQ_RESP,
|
||||
|
||||
rc = pn533_acr122_poweron_rdr(phy);
|
||||
if (rc < 0) {
|
||||
nfc_err(&interface->dev,
|
||||
"Couldn't poweron the reader (error %d)\n", rc);
|
||||
goto error;
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
nfc_err(&interface->dev, "Unknown device type %lu\n",
|
||||
id->driver_info);
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
|
||||
priv = pn533_register_device(id->driver_info, protocols, protocol_type,
|
||||
phy, &usb_phy_ops, fops,
|
||||
&phy->udev->dev);
|
||||
|
||||
if (IS_ERR(priv)) {
|
||||
rc = PTR_ERR(priv);
|
||||
goto error;
|
||||
}
|
||||
|
||||
phy->priv = priv;
|
||||
nfc_set_parent_dev(priv->nfc_dev, &interface->dev);
|
||||
|
||||
usb_set_intfdata(interface, phy);
|
||||
|
||||
return 0;
|
||||
|
||||
error:
|
||||
usb_free_urb(phy->in_urb);
|
||||
usb_free_urb(phy->out_urb);
|
||||
usb_put_dev(phy->udev);
|
||||
kfree(in_buf);
|
||||
out_free_phy:
|
||||
kfree(phy);
|
||||
return rc;
|
||||
}
|
||||
|
||||
static void pn533_usb_disconnect(struct usb_interface *interface)
|
||||
{
|
||||
struct pn533_usb_phy *phy = usb_get_intfdata(interface);
|
||||
|
||||
if (!phy)
|
||||
return;
|
||||
|
||||
pn533_unregister_device(phy->priv);
|
||||
|
||||
usb_set_intfdata(interface, NULL);
|
||||
|
||||
usb_kill_urb(phy->in_urb);
|
||||
usb_kill_urb(phy->out_urb);
|
||||
|
||||
kfree(phy->in_urb->transfer_buffer);
|
||||
usb_free_urb(phy->in_urb);
|
||||
usb_free_urb(phy->out_urb);
|
||||
|
||||
nfc_info(&interface->dev, "NXP PN533 NFC device disconnected\n");
|
||||
}
|
||||
|
||||
static struct usb_driver pn533_usb_driver = {
|
||||
.name = "pn533_usb",
|
||||
.probe = pn533_usb_probe,
|
||||
.disconnect = pn533_usb_disconnect,
|
||||
.id_table = pn533_usb_table,
|
||||
};
|
||||
|
||||
module_usb_driver(pn533_usb_driver);
|
||||
|
||||
MODULE_AUTHOR("Lauro Ramos Venancio <lauro.venancio@openbossa.org>");
|
||||
MODULE_AUTHOR("Aloisio Almeida Jr <aloisio.almeida@openbossa.org>");
|
||||
MODULE_AUTHOR("Waldemar Rymarkiewicz <waldemar.rymarkiewicz@tieto.com>");
|
||||
MODULE_DESCRIPTION("PN533 USB driver ver " VERSION);
|
||||
MODULE_VERSION(VERSION);
|
||||
MODULE_LICENSE("GPL");
|
Loading…
Reference in a new issue