NFC: nfcmrvl: Initial commit for Marvell NFC driver

This patch adds NFC support for Marvell 8897 NFC-over-USB chipset.

Signed-off-by: Amitkumar Karwar <akarwar@marvell.com>
Signed-off-by: Bing Zhao <bzhao@marvell.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>

7 files changed, 680 insertions, 0 deletions

diff --git a/drivers/nfc/Kconfig b/drivers/nfc/Kconfig
index c1fb20603338..fe20e1cc0545 100644
--- a/drivers/nfc/Kconfig
+++ b/drivers/nfc/Kconfig
@@ -58,5 +58,6 @@ config NFC_PORT100
 
 source "drivers/nfc/pn544/Kconfig"
 source "drivers/nfc/microread/Kconfig"
+source "drivers/nfc/nfcmrvl/Kconfig"
 
 endmenu
diff --git a/drivers/nfc/Makefile b/drivers/nfc/Makefile
index c715fe8582a8..56ab822ba03d 100644
--- a/drivers/nfc/Makefile
+++ b/drivers/nfc/Makefile
@@ -9,5 +9,6 @@ obj-$(CONFIG_NFC_WILINK)	+= nfcwilink.o
 obj-$(CONFIG_NFC_MEI_PHY)       += mei_phy.o
 obj-$(CONFIG_NFC_SIM)           += nfcsim.o
 obj-$(CONFIG_NFC_PORT100)       += port100.o
+obj-$(CONFIG_NFC_MRVL)          += nfcmrvl/
 
 ccflags-$(CONFIG_NFC_DEBUG) := -DDEBUG
diff --git a/drivers/nfc/nfcmrvl/Kconfig b/drivers/nfc/nfcmrvl/Kconfig
new file mode 100644
index 000000000000..5e18afd9abe2
--- /dev/null
+++ b/drivers/nfc/nfcmrvl/Kconfig
@@ -0,0 +1,23 @@
+config NFC_MRVL
+        tristate "Marvell NFC driver support"
+        depends on NFC_NCI
+        help
+          The core driver to support Marvell NFC devices.
+
+          This driver is required if you want to support
+          Marvell NFC device 8897.
+
+          Say Y here to compile Marvell NFC driver into the kernel or
+          say M to compile it as module.
+
+config NFC_MRVL_USB
+        tristate "Marvell NFC-over-USB driver"
+        depends on NFC_MRVL && USB
+        help
+          Marvell NFC-over-USB driver.
+
+          This driver provides support for Marvell NFC-over-USB devices:
+          8897.
+
+          Say Y here to compile support for Marvell NFC-over-USB driver
+          into the kernel or say M to compile it as module.
diff --git a/drivers/nfc/nfcmrvl/Makefile b/drivers/nfc/nfcmrvl/Makefile
new file mode 100644
index 000000000000..97a0de72dc01
--- /dev/null
+++ b/drivers/nfc/nfcmrvl/Makefile
@@ -0,0 +1,9 @@
+#
+# Makefile for NFCMRVL NCI based NFC driver
+#
+
+nfcmrvl-y += main.o
+obj-$(CONFIG_NFC_MRVL) += nfcmrvl.o
+
+nfcmrvl_usb-y += usb.o
+obj-$(CONFIG_NFC_MRVL_USB) += nfcmrvl_usb.o
diff --git a/drivers/nfc/nfcmrvl/main.c b/drivers/nfc/nfcmrvl/main.c
new file mode 100644
index 000000000000..396fc270ffc3
--- /dev/null
+++ b/drivers/nfc/nfcmrvl/main.c
@@ -0,0 +1,145 @@
+/*
+ * Marvell NFC driver: major functions
+ *
+ * Copyright (C) 2014, Marvell International Ltd.
+ *
+ * This software file (the "File") is distributed by Marvell International
+ * Ltd. under the terms of the GNU General Public License Version 2, June 1991
+ * (the "License").  You may use, redistribute and/or modify this File in
+ * accordance with the terms and conditions of the License, a copy of which
+ * is available on the worldwide web at
+ * http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
+ *
+ * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
+ * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
+ * this warranty disclaimer.
+ */
+
+#include <linux/module.h>
+#include <linux/nfc.h>
+#include <net/nfc/nci.h>
+#include <net/nfc/nci_core.h>
+#include "nfcmrvl.h"
+
+#define VERSION "1.0"
+
+static int nfcmrvl_nci_open(struct nci_dev *ndev)
+{
+        struct nfcmrvl_private *priv = nci_get_drvdata(ndev);
+        int err;
+
+        if (test_and_set_bit(NFCMRVL_NCI_RUNNING, &priv->flags))
+                return 0;
+
+        err = priv->if_ops->nci_open(priv);
+
+        if (err)
+                clear_bit(NFCMRVL_NCI_RUNNING, &priv->flags);
+
+        return err;
+}
+
+static int nfcmrvl_nci_close(struct nci_dev *ndev)
+{
+        struct nfcmrvl_private *priv = nci_get_drvdata(ndev);
+
+        if (!test_and_clear_bit(NFCMRVL_NCI_RUNNING, &priv->flags))
+                return 0;
+
+        priv->if_ops->nci_close(priv);
+
+        return 0;
+}
+
+static int nfcmrvl_nci_send(struct nci_dev *ndev, struct sk_buff *skb)
+{
+        struct nfcmrvl_private *priv = nci_get_drvdata(ndev);
+
+        nfc_info(priv->dev, "send entry, len %d\n", skb->len);
+
+        skb->dev = (void *)ndev;
+
+        if (!test_bit(NFCMRVL_NCI_RUNNING, &priv->flags))
+                return -EBUSY;
+
+        return priv->if_ops->nci_send(priv, skb);
+}
+
+static struct nci_ops nfcmrvl_nci_ops = {
+        .open = nfcmrvl_nci_open,
+        .close = nfcmrvl_nci_close,
+        .send = nfcmrvl_nci_send,
+};
+
+struct nfcmrvl_private *nfcmrvl_nci_register_dev(void *drv_data,
+                                                 struct nfcmrvl_if_ops *ops,
+                                                 struct device *dev)
+{
+        struct nfcmrvl_private *priv;
+        int rc;
+        u32 protocols;
+
+        priv = kzalloc(sizeof(*priv), GFP_KERNEL);
+        if (!priv)
+                return ERR_PTR(-ENOMEM);
+
+        priv->drv_data = drv_data;
+        priv->if_ops = ops;
+        priv->dev = dev;
+
+        protocols = NFC_PROTO_JEWEL_MASK
+                | NFC_PROTO_MIFARE_MASK | NFC_PROTO_FELICA_MASK
+                | NFC_PROTO_ISO14443_MASK
+                | NFC_PROTO_ISO14443_B_MASK
+                | NFC_PROTO_NFC_DEP_MASK;
+
+        priv->ndev = nci_allocate_device(&nfcmrvl_nci_ops, protocols, 0, 0);
+        if (!priv->ndev) {
+                nfc_err(dev, "nci_allocate_device failed");
+                return ERR_PTR(-ENOMEM);
+        }
+
+        nci_set_drvdata(priv->ndev, priv);
+
+        rc = nci_register_device(priv->ndev);
+        if (rc) {
+                nfc_err(dev, "nci_register_device failed %d", rc);
+                nci_free_device(priv->ndev);
+                return ERR_PTR(rc);
+        }
+
+        nfc_info(dev, "registered with nci successfully\n");
+        return priv;
+}
+EXPORT_SYMBOL_GPL(nfcmrvl_nci_register_dev);
+
+void nfcmrvl_nci_unregister_dev(struct nfcmrvl_private *priv)
+{
+        struct nci_dev *ndev = priv->ndev;
+
+        nci_unregister_device(ndev);
+        nci_free_device(ndev);
+        kfree(priv);
+}
+EXPORT_SYMBOL_GPL(nfcmrvl_nci_unregister_dev);
+
+int nfcmrvl_nci_recv_frame(struct nfcmrvl_private *priv, void *data, int count)
+{
+        struct sk_buff *skb;
+
+        skb = nci_skb_alloc(priv->ndev, count, GFP_ATOMIC);
+        if (!skb)
+                return -ENOMEM;
+
+        memcpy(skb_put(skb, count), data, count);
+        nci_recv_frame(priv->ndev, skb);
+
+        return count;
+}
+EXPORT_SYMBOL_GPL(nfcmrvl_nci_recv_frame);
+
+MODULE_AUTHOR("Marvell International Ltd.");
+MODULE_DESCRIPTION("Marvell NFC driver ver " VERSION);
+MODULE_VERSION(VERSION);
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/nfc/nfcmrvl/nfcmrvl.h b/drivers/nfc/nfcmrvl/nfcmrvl.h
new file mode 100644
index 000000000000..a007175f77fe
--- /dev/null
+++ b/drivers/nfc/nfcmrvl/nfcmrvl.h
@@ -0,0 +1,42 @@
+/**
+ * Marvell NFC driver
+ *
+ * Copyright (C) 2014, Marvell International Ltd.
+ *
+ * This software file (the "File") is distributed by Marvell International
+ * Ltd. under the terms of the GNU General Public License Version 2, June 1991
+ * (the "License").  You may use, redistribute and/or modify this File in
+ * accordance with the terms and conditions of the License, a copy of which
+ * is available on the worldwide web at
+ * http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
+ *
+ * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
+ * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
+ * this warranty disclaimer.
+ **/
+
+/* Define private flags: */
+#define NFCMRVL_NCI_RUNNING                     1
+
+#define NFCMRVL_NCI_MAX_EVENT_SIZE              260
+
+struct nfcmrvl_private {
+        struct nci_dev *ndev;
+        unsigned long flags;
+        void *drv_data;
+        struct device *dev;
+        struct nfcmrvl_if_ops *if_ops;
+};
+
+struct nfcmrvl_if_ops {
+        int (*nci_open) (struct nfcmrvl_private *priv);
+        int (*nci_close) (struct nfcmrvl_private *priv);
+        int (*nci_send) (struct nfcmrvl_private *priv, struct sk_buff *skb);
+};
+
+void nfcmrvl_nci_unregister_dev(struct nfcmrvl_private *priv);
+int nfcmrvl_nci_recv_frame(struct nfcmrvl_private *priv, void *data, int count);
+struct nfcmrvl_private *nfcmrvl_nci_register_dev(void *drv_data,
+                                                 struct nfcmrvl_if_ops *ops,
+                                                 struct device *dev);
diff --git a/drivers/nfc/nfcmrvl/usb.c b/drivers/nfc/nfcmrvl/usb.c
new file mode 100644
index 000000000000..3221ca37d6c9
--- /dev/null
+++ b/drivers/nfc/nfcmrvl/usb.c
@@ -0,0 +1,459 @@
+/**
+ * Marvell NFC-over-USB driver: USB interface related functions
+ *
+ * Copyright (C) 2014, Marvell International Ltd.
+ *
+ * This software file (the "File") is distributed by Marvell International
+ * Ltd. under the terms of the GNU General Public License Version 2, June 1991
+ * (the "License").  You may use, redistribute and/or modify this File in
+ * accordance with the terms and conditions of the License, a copy of which
+ * is available on the worldwide web at
+ * http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
+ *
+ * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
+ * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
+ * this warranty disclaimer.
+ **/
+
+#include <linux/module.h>
+#include <linux/usb.h>
+#include <linux/nfc.h>
+#include <net/nfc/nci.h>
+#include <net/nfc/nci_core.h>
+#include "nfcmrvl.h"
+
+#define VERSION "1.0"
+
+static struct usb_device_id nfcmrvl_table[] = {
+        { USB_DEVICE_INTERFACE_CLASS(0x1286, 0x2046, 0xff) },
+        { }     /* Terminating entry */
+};
+
+MODULE_DEVICE_TABLE(usb, nfcmrvl_table);
+
+#define NFCMRVL_USB_BULK_RUNNING        1
+#define NFCMRVL_USB_SUSPENDING          2
+
+struct nfcmrvl_usb_drv_data {
+        struct usb_device *udev;
+        struct usb_interface *intf;
+        unsigned long flags;
+        struct work_struct waker;
+        struct usb_anchor tx_anchor;
+        struct usb_anchor bulk_anchor;
+        struct usb_anchor deferred;
+        int tx_in_flight;
+        /* protects tx_in_flight */
+        spinlock_t txlock;
+        struct usb_endpoint_descriptor *bulk_tx_ep;
+        struct usb_endpoint_descriptor *bulk_rx_ep;
+        int suspend_count;
+        struct nfcmrvl_private *priv;
+};
+
+static int nfcmrvl_inc_tx(struct nfcmrvl_usb_drv_data *drv_data)
+{
+        unsigned long flags;
+        int rv;
+
+        spin_lock_irqsave(&drv_data->txlock, flags);
+        rv = test_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
+        if (!rv)
+                drv_data->tx_in_flight++;
+        spin_unlock_irqrestore(&drv_data->txlock, flags);
+
+        return rv;
+}
+
+static void nfcmrvl_bulk_complete(struct urb *urb)
+{
+        struct nfcmrvl_usb_drv_data *drv_data = urb->context;
+        int err;
+
+        dev_dbg(&drv_data->udev->dev, "urb %p status %d count %d",
+                urb, urb->status, urb->actual_length);
+
+        if (!test_bit(NFCMRVL_NCI_RUNNING, &drv_data->flags))
+                return;
+
+        if (!urb->status) {
+                if (nfcmrvl_nci_recv_frame(drv_data->priv, urb->transfer_buffer,
+                                           urb->actual_length) < 0)
+                        nfc_err(&drv_data->udev->dev, "corrupted Rx packet");
+        }
+
+        if (!test_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags))
+                return;
+
+        usb_anchor_urb(urb, &drv_data->bulk_anchor);
+        usb_mark_last_busy(drv_data->udev);
+
+        err = usb_submit_urb(urb, GFP_ATOMIC);
+        if (err) {
+                /* -EPERM: urb is being killed;
+                 * -ENODEV: device got disconnected
+                 */
+                if (err != -EPERM && err != -ENODEV)
+                        nfc_err(&drv_data->udev->dev,
+                                "urb %p failed to resubmit (%d)", urb, -err);
+                usb_unanchor_urb(urb);
+        }
+}
+
+static int
+nfcmrvl_submit_bulk_urb(struct nfcmrvl_usb_drv_data *drv_data, gfp_t mem_flags)
+{
+        struct urb *urb;
+        unsigned char *buf;
+        unsigned int pipe;
+        int err, size = NFCMRVL_NCI_MAX_EVENT_SIZE;
+
+        if (!drv_data->bulk_rx_ep)
+                return -ENODEV;
+
+        urb = usb_alloc_urb(0, mem_flags);
+        if (!urb)
+                return -ENOMEM;
+
+        buf = kmalloc(size, mem_flags);
+        if (!buf) {
+                usb_free_urb(urb);
+                return -ENOMEM;
+        }
+
+        pipe = usb_rcvbulkpipe(drv_data->udev,
+                               drv_data->bulk_rx_ep->bEndpointAddress);
+
+        usb_fill_bulk_urb(urb, drv_data->udev, pipe, buf, size,
+                          nfcmrvl_bulk_complete, drv_data);
+
+        urb->transfer_flags |= URB_FREE_BUFFER;
+
+        usb_mark_last_busy(drv_data->udev);
+        usb_anchor_urb(urb, &drv_data->bulk_anchor);
+
+        err = usb_submit_urb(urb, mem_flags);
+        if (err) {
+                if (err != -EPERM && err != -ENODEV)
+                        nfc_err(&drv_data->udev->dev,
+                                "urb %p submission failed (%d)", urb, -err);
+                usb_unanchor_urb(urb);
+        }
+
+        usb_free_urb(urb);
+
+        return err;
+}
+
+static void nfcmrvl_tx_complete(struct urb *urb)
+{
+        struct sk_buff *skb = urb->context;
+        struct nci_dev *ndev = (struct nci_dev *)skb->dev;
+        struct nfcmrvl_private *priv = nci_get_drvdata(ndev);
+        struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
+
+        nfc_info(priv->dev, "urb %p status %d count %d",
+                 urb, urb->status, urb->actual_length);
+
+        spin_lock(&drv_data->txlock);
+        drv_data->tx_in_flight--;
+        spin_unlock(&drv_data->txlock);
+
+        kfree(urb->setup_packet);
+        kfree_skb(skb);
+}
+
+static int nfcmrvl_usb_nci_open(struct nfcmrvl_private *priv)
+{
+        struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
+        int err;
+
+        err = usb_autopm_get_interface(drv_data->intf);
+        if (err)
+                return err;
+
+        drv_data->intf->needs_remote_wakeup = 1;
+
+        err = nfcmrvl_submit_bulk_urb(drv_data, GFP_KERNEL);
+        if (err)
+                goto failed;
+
+        set_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags);
+        nfcmrvl_submit_bulk_urb(drv_data, GFP_KERNEL);
+
+        usb_autopm_put_interface(drv_data->intf);
+        return 0;
+
+failed:
+        usb_autopm_put_interface(drv_data->intf);
+        return err;
+}
+
+static void nfcmrvl_usb_stop_traffic(struct nfcmrvl_usb_drv_data *drv_data)
+{
+        usb_kill_anchored_urbs(&drv_data->bulk_anchor);
+}
+
+static int nfcmrvl_usb_nci_close(struct nfcmrvl_private *priv)
+{
+        struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
+        int err;
+
+        cancel_work_sync(&drv_data->waker);
+
+        clear_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags);
+
+        nfcmrvl_usb_stop_traffic(drv_data);
+        usb_kill_anchored_urbs(&drv_data->tx_anchor);
+        err = usb_autopm_get_interface(drv_data->intf);
+        if (err)
+                goto failed;
+
+        drv_data->intf->needs_remote_wakeup = 0;
+        usb_autopm_put_interface(drv_data->intf);
+
+failed:
+        usb_scuttle_anchored_urbs(&drv_data->deferred);
+        return 0;
+}
+
+static int nfcmrvl_usb_nci_send(struct nfcmrvl_private *priv,
+                                struct sk_buff *skb)
+{
+        struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
+        struct urb *urb;
+        unsigned int pipe;
+        int err;
+
+        if (!drv_data->bulk_tx_ep)
+                return -ENODEV;
+
+        urb = usb_alloc_urb(0, GFP_ATOMIC);
+        if (!urb)
+                return -ENOMEM;
+
+        pipe = usb_sndbulkpipe(drv_data->udev,
+                                drv_data->bulk_tx_ep->bEndpointAddress);
+
+        usb_fill_bulk_urb(urb, drv_data->udev, pipe, skb->data, skb->len,
+                          nfcmrvl_tx_complete, skb);
+
+        err = nfcmrvl_inc_tx(drv_data);
+        if (err) {
+                usb_anchor_urb(urb, &drv_data->deferred);
+                schedule_work(&drv_data->waker);
+                err = 0;
+                goto done;
+        }
+
+        usb_anchor_urb(urb, &drv_data->tx_anchor);
+
+        err = usb_submit_urb(urb, GFP_ATOMIC);
+        if (err) {
+                if (err != -EPERM && err != -ENODEV)
+                        nfc_err(&drv_data->udev->dev,
+                                "urb %p submission failed (%d)", urb, -err);
+                kfree(urb->setup_packet);
+                usb_unanchor_urb(urb);
+        } else {
+                usb_mark_last_busy(drv_data->udev);
+        }
+
+done:
+        usb_free_urb(urb);
+        return err;
+}
+
+static struct nfcmrvl_if_ops usb_ops = {
+        .nci_open = nfcmrvl_usb_nci_open,
+        .nci_close = nfcmrvl_usb_nci_close,
+        .nci_send = nfcmrvl_usb_nci_send,
+};
+
+static void nfcmrvl_waker(struct work_struct *work)
+{
+        struct nfcmrvl_usb_drv_data *drv_data =
+                        container_of(work, struct nfcmrvl_usb_drv_data, waker);
+        int err;
+
+        err = usb_autopm_get_interface(drv_data->intf);
+        if (err)
+                return;
+
+        usb_autopm_put_interface(drv_data->intf);
+}
+
+static int nfcmrvl_probe(struct usb_interface *intf,
+                         const struct usb_device_id *id)
+{
+        struct usb_endpoint_descriptor *ep_desc;
+        struct nfcmrvl_usb_drv_data *drv_data;
+        struct nfcmrvl_private *priv;
+        int i;
+        struct usb_device *udev = interface_to_usbdev(intf);
+
+        nfc_info(&udev->dev, "intf %p id %p", intf, id);
+
+        drv_data = devm_kzalloc(&intf->dev, sizeof(*drv_data), GFP_KERNEL);
+        if (!drv_data)
+                return -ENOMEM;
+
+        for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
+                ep_desc = &intf->cur_altsetting->endpoint[i].desc;
+
+                if (!drv_data->bulk_tx_ep &&
+                    usb_endpoint_is_bulk_out(ep_desc)) {
+                        drv_data->bulk_tx_ep = ep_desc;
+                        continue;
+                }
+
+                if (!drv_data->bulk_rx_ep &&
+                    usb_endpoint_is_bulk_in(ep_desc)) {
+                        drv_data->bulk_rx_ep = ep_desc;
+                        continue;
+                }
+        }
+
+        if (!drv_data->bulk_tx_ep || !drv_data->bulk_rx_ep)
+                return -ENODEV;
+
+        drv_data->udev = udev;
+        drv_data->intf = intf;
+
+        INIT_WORK(&drv_data->waker, nfcmrvl_waker);
+        spin_lock_init(&drv_data->txlock);
+
+        init_usb_anchor(&drv_data->tx_anchor);
+        init_usb_anchor(&drv_data->bulk_anchor);
+        init_usb_anchor(&drv_data->deferred);
+
+        priv = nfcmrvl_nci_register_dev(drv_data, &usb_ops,
+                                        &drv_data->udev->dev);
+        if (IS_ERR(priv))
+                return PTR_ERR(priv);
+
+        drv_data->priv = priv;
+        priv->dev = &drv_data->udev->dev;
+
+        usb_set_intfdata(intf, drv_data);
+
+        return 0;
+}
+
+static void nfcmrvl_disconnect(struct usb_interface *intf)
+{
+        struct nfcmrvl_usb_drv_data *drv_data = usb_get_intfdata(intf);
+
+        if (!drv_data)
+                return;
+
+        nfc_info(&drv_data->udev->dev, "intf %p", intf);
+
+        nfcmrvl_nci_unregister_dev(drv_data->priv);
+
+        usb_set_intfdata(drv_data->intf, NULL);
+}
+
+#ifdef CONFIG_PM
+static int nfcmrvl_suspend(struct usb_interface *intf, pm_message_t message)
+{
+        struct nfcmrvl_usb_drv_data *drv_data = usb_get_intfdata(intf);
+
+        nfc_info(&drv_data->udev->dev, "intf %p", intf);
+
+        if (drv_data->suspend_count++)
+                return 0;
+
+        spin_lock_irq(&drv_data->txlock);
+        if (!(PMSG_IS_AUTO(message) && drv_data->tx_in_flight)) {
+                set_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
+                spin_unlock_irq(&drv_data->txlock);
+        } else {
+                spin_unlock_irq(&drv_data->txlock);
+                drv_data->suspend_count--;
+                return -EBUSY;
+        }
+
+        nfcmrvl_usb_stop_traffic(drv_data);
+        usb_kill_anchored_urbs(&drv_data->tx_anchor);
+
+        return 0;
+}
+
+static void nfcmrvl_play_deferred(struct nfcmrvl_usb_drv_data *drv_data)
+{
+        struct urb *urb;
+        int err;
+
+        while ((urb = usb_get_from_anchor(&drv_data->deferred))) {
+                err = usb_submit_urb(urb, GFP_ATOMIC);
+                if (err)
+                        break;
+
+                drv_data->tx_in_flight++;
+        }
+        usb_scuttle_anchored_urbs(&drv_data->deferred);
+}
+
+static int nfcmrvl_resume(struct usb_interface *intf)
+{
+        struct nfcmrvl_usb_drv_data *drv_data = usb_get_intfdata(intf);
+        int err = 0;
+
+        nfc_info(&drv_data->udev->dev, "intf %p", intf);
+
+        if (--drv_data->suspend_count)
+                return 0;
+
+        if (!test_bit(NFCMRVL_NCI_RUNNING, &drv_data->flags))
+                goto done;
+
+        if (test_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags)) {
+                err = nfcmrvl_submit_bulk_urb(drv_data, GFP_NOIO);
+                if (err) {
+                        clear_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags);
+                        goto failed;
+                }
+
+                nfcmrvl_submit_bulk_urb(drv_data, GFP_NOIO);
+        }
+
+        spin_lock_irq(&drv_data->txlock);
+        nfcmrvl_play_deferred(drv_data);
+        clear_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
+        spin_unlock_irq(&drv_data->txlock);
+
+        return 0;
+
+failed:
+        usb_scuttle_anchored_urbs(&drv_data->deferred);
+done:
+        spin_lock_irq(&drv_data->txlock);
+        clear_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
+        spin_unlock_irq(&drv_data->txlock);
+
+        return err;
+}
+#endif
+
+static struct usb_driver nfcmrvl_usb_driver = {
+        .name           = "nfcmrvl",
+        .probe          = nfcmrvl_probe,
+        .disconnect     = nfcmrvl_disconnect,
+#ifdef CONFIG_PM
+        .suspend        = nfcmrvl_suspend,
+        .resume         = nfcmrvl_resume,
+        .reset_resume   = nfcmrvl_resume,
+#endif
+        .id_table       = nfcmrvl_table,
+        .supports_autosuspend = 1,
+        .disable_hub_initiated_lpm = 1,
+        .soft_unbind = 1,
+};
+module_usb_driver(nfcmrvl_usb_driver);
+
+MODULE_AUTHOR("Marvell International Ltd.");
+MODULE_DESCRIPTION("Marvell NFC-over-USB driver ver " VERSION);
+MODULE_VERSION(VERSION);
+MODULE_LICENSE("GPL v2");