[deliverable/linux.git] / drivers / nfc / nfcmrvl / usb.c

/**
 * 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_AND_INTERFACE_INFO(0x1286, 0x2046,
					USB_CLASS_VENDOR_SPEC, 4, 1) },
	{ }	/* 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;
	struct sk_buff *skb;
	int err;

	dev_dbg(&drv_data->udev->dev, "urb %p status %d count %d\n",
		urb, urb->status, urb->actual_length);

	if (!test_bit(NFCMRVL_NCI_RUNNING, &drv_data->flags))
		return;

	if (!urb->status) {
		skb = nci_skb_alloc(drv_data->priv->ndev, urb->actual_length,
				    GFP_ATOMIC);
		if (!skb) {
			nfc_err(&drv_data->udev->dev, "failed to alloc mem\n");
		} else {
			memcpy(skb_put(skb, urb->actual_length),
			       urb->transfer_buffer, urb->actual_length);
			if (nfcmrvl_nci_recv_frame(drv_data->priv, skb) < 0)
				nfc_err(&drv_data->udev->dev,
					"corrupted Rx packet\n");
		}
	}

	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)\n", 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)\n", 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\n",
		 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)\n", 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);
	struct nfcmrvl_platform_data config;

	/* No configuration for USB */
	memset(&config, 0, sizeof(config));

	nfc_info(&udev->dev, "intf %p id %p\n", 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, &config);
	if (IS_ERR(priv))
		return PTR_ERR(priv);

	drv_data->priv = priv;
	drv_data->priv->phy = NFCMRVL_PHY_USB;
	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\n", 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\n", 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\n", 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");
Commit	Line	Data
f26e30cc AK	1	/**
	2	* Marvell NFC-over-USB driver: USB interface related functions
	3	*
	4	* Copyright (C) 2014, Marvell International Ltd.
	5	*
	6	* This software file (the "File") is distributed by Marvell International
	7	* Ltd. under the terms of the GNU General Public License Version 2, June 1991
	8	* (the "License"). You may use, redistribute and/or modify this File in
	9	* accordance with the terms and conditions of the License, a copy of which
	10	* is available on the worldwide web at
	11	* http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
	12	*
	13	* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
	14	* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
	15	* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
	16	* this warranty disclaimer.
	17	**/
	18
	19	#include <linux/module.h>
	20	#include <linux/usb.h>
	21	#include <linux/nfc.h>
	22	#include <net/nfc/nci.h>
	23	#include <net/nfc/nci_core.h>
	24	#include "nfcmrvl.h"
	25
	26	#define VERSION "1.0"
	27
	28	static struct usb_device_id nfcmrvl_table[] = {
8a81a96b VC	29	{ USB_DEVICE_AND_INTERFACE_INFO(0x1286, 0x2046,
8a81a96b VC	30	USB_CLASS_VENDOR_SPEC, 4, 1) },
f26e30cc AK	31	{ } /* Terminating entry */
	32	};
	33
	34	MODULE_DEVICE_TABLE(usb, nfcmrvl_table);
	35
	36	#define NFCMRVL_USB_BULK_RUNNING 1
	37	#define NFCMRVL_USB_SUSPENDING 2
	38
	39	struct nfcmrvl_usb_drv_data {
	40	struct usb_device *udev;
	41	struct usb_interface *intf;
	42	unsigned long flags;
	43	struct work_struct waker;
	44	struct usb_anchor tx_anchor;
	45	struct usb_anchor bulk_anchor;
	46	struct usb_anchor deferred;
	47	int tx_in_flight;
	48	/* protects tx_in_flight */
	49	spinlock_t txlock;
	50	struct usb_endpoint_descriptor *bulk_tx_ep;
	51	struct usb_endpoint_descriptor *bulk_rx_ep;
	52	int suspend_count;
	53	struct nfcmrvl_private *priv;
	54	};
	55
	56	static int nfcmrvl_inc_tx(struct nfcmrvl_usb_drv_data *drv_data)
	57	{
	58	unsigned long flags;
	59	int rv;
	60
	61	spin_lock_irqsave(&drv_data->txlock, flags);
	62	rv = test_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
	63	if (!rv)
	64	drv_data->tx_in_flight++;
	65	spin_unlock_irqrestore(&drv_data->txlock, flags);
	66
	67	return rv;
	68	}
	69
	70	static void nfcmrvl_bulk_complete(struct urb *urb)
	71	{
	72	struct nfcmrvl_usb_drv_data *drv_data = urb->context;
e1bf80c2	73	struct sk_buff *skb;
f26e30cc AK	74	int err;
f26e30cc AK	75
e1bf80c2	76	dev_dbg(&drv_data->udev->dev, "urb %p status %d count %d\n",
f26e30cc AK	77	urb, urb->status, urb->actual_length);
	78
	79	if (!test_bit(NFCMRVL_NCI_RUNNING, &drv_data->flags))
	80	return;
	81
	82	if (!urb->status) {
e1bf80c2 VC	83	skb = nci_skb_alloc(drv_data->priv->ndev, urb->actual_length,
	84	GFP_ATOMIC);
	85	if (!skb) {
	86	nfc_err(&drv_data->udev->dev, "failed to alloc mem\n");
	87	} else {
	88	memcpy(skb_put(skb, urb->actual_length),
	89	urb->transfer_buffer, urb->actual_length);
	90	if (nfcmrvl_nci_recv_frame(drv_data->priv, skb) < 0)
	91	nfc_err(&drv_data->udev->dev,
	92	"corrupted Rx packet\n");
	93	}
f26e30cc AK	94	}
	95
	96	if (!test_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags))
	97	return;
	98
	99	usb_anchor_urb(urb, &drv_data->bulk_anchor);
	100	usb_mark_last_busy(drv_data->udev);
	101
	102	err = usb_submit_urb(urb, GFP_ATOMIC);
	103	if (err) {
	104	/* -EPERM: urb is being killed;
	105	* -ENODEV: device got disconnected
	106	*/
	107	if (err != -EPERM && err != -ENODEV)
	108	nfc_err(&drv_data->udev->dev,
3590ebc0	109	"urb %p failed to resubmit (%d)\n", urb, -err);
f26e30cc AK	110	usb_unanchor_urb(urb);
	111	}
	112	}
	113
	114	static int
	115	nfcmrvl_submit_bulk_urb(struct nfcmrvl_usb_drv_data *drv_data, gfp_t mem_flags)
	116	{
	117	struct urb *urb;
	118	unsigned char *buf;
	119	unsigned int pipe;
	120	int err, size = NFCMRVL_NCI_MAX_EVENT_SIZE;
	121
	122	if (!drv_data->bulk_rx_ep)
	123	return -ENODEV;
	124
	125	urb = usb_alloc_urb(0, mem_flags);
	126	if (!urb)
	127	return -ENOMEM;
	128
	129	buf = kmalloc(size, mem_flags);
	130	if (!buf) {
	131	usb_free_urb(urb);
	132	return -ENOMEM;
	133	}
	134
	135	pipe = usb_rcvbulkpipe(drv_data->udev,
	136	drv_data->bulk_rx_ep->bEndpointAddress);
	137
	138	usb_fill_bulk_urb(urb, drv_data->udev, pipe, buf, size,
	139	nfcmrvl_bulk_complete, drv_data);
	140
	141	urb->transfer_flags \|= URB_FREE_BUFFER;
	142
	143	usb_mark_last_busy(drv_data->udev);
	144	usb_anchor_urb(urb, &drv_data->bulk_anchor);
	145
	146	err = usb_submit_urb(urb, mem_flags);
	147	if (err) {
	148	if (err != -EPERM && err != -ENODEV)
	149	nfc_err(&drv_data->udev->dev,
3590ebc0	150	"urb %p submission failed (%d)\n", urb, -err);
f26e30cc AK	151	usb_unanchor_urb(urb);
	152	}
	153
	154	usb_free_urb(urb);
	155
	156	return err;
	157	}
	158
	159	static void nfcmrvl_tx_complete(struct urb *urb)
	160	{
	161	struct sk_buff *skb = urb->context;
	162	struct nci_dev ndev = (struct nci_dev )skb->dev;
	163	struct nfcmrvl_private *priv = nci_get_drvdata(ndev);
	164	struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
	165
3590ebc0	166	nfc_info(priv->dev, "urb %p status %d count %d\n",
f26e30cc AK	167	urb, urb->status, urb->actual_length);
	168
	169	spin_lock(&drv_data->txlock);
	170	drv_data->tx_in_flight--;
	171	spin_unlock(&drv_data->txlock);
	172
	173	kfree(urb->setup_packet);
	174	kfree_skb(skb);
	175	}
	176
	177	static int nfcmrvl_usb_nci_open(struct nfcmrvl_private *priv)
	178	{
	179	struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
	180	int err;
	181
	182	err = usb_autopm_get_interface(drv_data->intf);
	183	if (err)
	184	return err;
	185
	186	drv_data->intf->needs_remote_wakeup = 1;
	187
	188	err = nfcmrvl_submit_bulk_urb(drv_data, GFP_KERNEL);
	189	if (err)
	190	goto failed;
	191
	192	set_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags);
	193	nfcmrvl_submit_bulk_urb(drv_data, GFP_KERNEL);
	194
	195	usb_autopm_put_interface(drv_data->intf);
	196	return 0;
	197
	198	failed:
	199	usb_autopm_put_interface(drv_data->intf);
	200	return err;
	201	}
	202
	203	static void nfcmrvl_usb_stop_traffic(struct nfcmrvl_usb_drv_data *drv_data)
	204	{
	205	usb_kill_anchored_urbs(&drv_data->bulk_anchor);
	206	}
	207
	208	static int nfcmrvl_usb_nci_close(struct nfcmrvl_private *priv)
	209	{
	210	struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
	211	int err;
	212
	213	cancel_work_sync(&drv_data->waker);
	214
	215	clear_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags);
	216
	217	nfcmrvl_usb_stop_traffic(drv_data);
	218	usb_kill_anchored_urbs(&drv_data->tx_anchor);
	219	err = usb_autopm_get_interface(drv_data->intf);
	220	if (err)
	221	goto failed;
	222
	223	drv_data->intf->needs_remote_wakeup = 0;
	224	usb_autopm_put_interface(drv_data->intf);
	225
	226	failed:
	227	usb_scuttle_anchored_urbs(&drv_data->deferred);
	228	return 0;
	229	}
	230
231	static int nfcmrvl_usb_nci_send(struct nfcmrvl_private *priv,
232	struct sk_buff *skb)
233	{
234	struct nfcmrvl_usb_drv_data *drv_data = priv->drv_data;
235	struct urb *urb;
236	unsigned int pipe;
237	int err;
238
239	if (!drv_data->bulk_tx_ep)
240	return -ENODEV;
241
242	urb = usb_alloc_urb(0, GFP_ATOMIC);
243	if (!urb)
244	return -ENOMEM;
245
246	pipe = usb_sndbulkpipe(drv_data->udev,
247	drv_data->bulk_tx_ep->bEndpointAddress);
248
249	usb_fill_bulk_urb(urb, drv_data->udev, pipe, skb->data, skb->len,
250	nfcmrvl_tx_complete, skb);
251
252	err = nfcmrvl_inc_tx(drv_data);
253	if (err) {
254	usb_anchor_urb(urb, &drv_data->deferred);
255	schedule_work(&drv_data->waker);
256	err = 0;
257	goto done;
258	}
259
260	usb_anchor_urb(urb, &drv_data->tx_anchor);
261
262	err = usb_submit_urb(urb, GFP_ATOMIC);
263	if (err) {
264	if (err != -EPERM && err != -ENODEV)
265	nfc_err(&drv_data->udev->dev,
3590ebc0	266	"urb %p submission failed (%d)\n", urb, -err);
f26e30cc AK	267	kfree(urb->setup_packet);
	268	usb_unanchor_urb(urb);
	269	} else {
	270	usb_mark_last_busy(drv_data->udev);
	271	}
	272
	273	done:
	274	usb_free_urb(urb);
	275	return err;
	276	}
	277
	278	static struct nfcmrvl_if_ops usb_ops = {
	279	.nci_open = nfcmrvl_usb_nci_open,
	280	.nci_close = nfcmrvl_usb_nci_close,
	281	.nci_send = nfcmrvl_usb_nci_send,
	282	};
	283
	284	static void nfcmrvl_waker(struct work_struct *work)
	285	{
	286	struct nfcmrvl_usb_drv_data *drv_data =
	287	container_of(work, struct nfcmrvl_usb_drv_data, waker);
	288	int err;
	289
	290	err = usb_autopm_get_interface(drv_data->intf);
	291	if (err)
	292	return;
	293
	294	usb_autopm_put_interface(drv_data->intf);
	295	}
	296
	297	static int nfcmrvl_probe(struct usb_interface *intf,
	298	const struct usb_device_id *id)
	299	{
	300	struct usb_endpoint_descriptor *ep_desc;
	301	struct nfcmrvl_usb_drv_data *drv_data;
	302	struct nfcmrvl_private *priv;
	303	int i;
	304	struct usb_device *udev = interface_to_usbdev(intf);
dc14bdef VC	305	struct nfcmrvl_platform_data config;
	306
	307	/* No configuration for USB */
	308	memset(&config, 0, sizeof(config));
f26e30cc	309
3590ebc0	310	nfc_info(&udev->dev, "intf %p id %p\n", intf, id);
f26e30cc AK	311
	312	drv_data = devm_kzalloc(&intf->dev, sizeof(*drv_data), GFP_KERNEL);
	313	if (!drv_data)
	314	return -ENOMEM;
	315
	316	for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
	317	ep_desc = &intf->cur_altsetting->endpoint[i].desc;
	318
	319	if (!drv_data->bulk_tx_ep &&
	320	usb_endpoint_is_bulk_out(ep_desc)) {
	321	drv_data->bulk_tx_ep = ep_desc;
	322	continue;
	323	}
	324
	325	if (!drv_data->bulk_rx_ep &&
	326	usb_endpoint_is_bulk_in(ep_desc)) {
	327	drv_data->bulk_rx_ep = ep_desc;
	328	continue;
	329	}
	330	}
	331
	332	if (!drv_data->bulk_tx_ep \|\| !drv_data->bulk_rx_ep)
	333	return -ENODEV;
	334
	335	drv_data->udev = udev;
	336	drv_data->intf = intf;
	337
	338	INIT_WORK(&drv_data->waker, nfcmrvl_waker);
	339	spin_lock_init(&drv_data->txlock);
	340
	341	init_usb_anchor(&drv_data->tx_anchor);
	342	init_usb_anchor(&drv_data->bulk_anchor);
	343	init_usb_anchor(&drv_data->deferred);
	344
	345	priv = nfcmrvl_nci_register_dev(drv_data, &usb_ops,
dc14bdef	346	&drv_data->udev->dev, &config);
f26e30cc AK	347	if (IS_ERR(priv))
	348	return PTR_ERR(priv);
	349
	350	drv_data->priv = priv;
43465b7a	351	drv_data->priv->phy = NFCMRVL_PHY_USB;
f26e30cc AK	352	priv->dev = &drv_data->udev->dev;
	353
	354	usb_set_intfdata(intf, drv_data);
	355
	356	return 0;
	357	}
	358
	359	static void nfcmrvl_disconnect(struct usb_interface *intf)
	360	{
	361	struct nfcmrvl_usb_drv_data *drv_data = usb_get_intfdata(intf);
	362
	363	if (!drv_data)
	364	return;
	365
3590ebc0	366	nfc_info(&drv_data->udev->dev, "intf %p\n", intf);
f26e30cc AK	367
	368	nfcmrvl_nci_unregister_dev(drv_data->priv);
	369
	370	usb_set_intfdata(drv_data->intf, NULL);
	371	}
	372
	373	#ifdef CONFIG_PM
	374	static int nfcmrvl_suspend(struct usb_interface *intf, pm_message_t message)
	375	{
	376	struct nfcmrvl_usb_drv_data *drv_data = usb_get_intfdata(intf);
	377
3590ebc0	378	nfc_info(&drv_data->udev->dev, "intf %p\n", intf);
f26e30cc AK	379
	380	if (drv_data->suspend_count++)
	381	return 0;
	382
	383	spin_lock_irq(&drv_data->txlock);
	384	if (!(PMSG_IS_AUTO(message) && drv_data->tx_in_flight)) {
	385	set_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
	386	spin_unlock_irq(&drv_data->txlock);
	387	} else {
	388	spin_unlock_irq(&drv_data->txlock);
	389	drv_data->suspend_count--;
	390	return -EBUSY;
	391	}
	392
	393	nfcmrvl_usb_stop_traffic(drv_data);
	394	usb_kill_anchored_urbs(&drv_data->tx_anchor);
	395
	396	return 0;
	397	}
	398
	399	static void nfcmrvl_play_deferred(struct nfcmrvl_usb_drv_data *drv_data)
	400	{
	401	struct urb *urb;
	402	int err;
	403
	404	while ((urb = usb_get_from_anchor(&drv_data->deferred))) {
	405	err = usb_submit_urb(urb, GFP_ATOMIC);
	406	if (err)
	407	break;
	408
	409	drv_data->tx_in_flight++;
	410	}
	411	usb_scuttle_anchored_urbs(&drv_data->deferred);
	412	}
	413
	414	static int nfcmrvl_resume(struct usb_interface *intf)
	415	{
	416	struct nfcmrvl_usb_drv_data *drv_data = usb_get_intfdata(intf);
	417	int err = 0;
	418
3590ebc0	419	nfc_info(&drv_data->udev->dev, "intf %p\n", intf);
f26e30cc AK	420
	421	if (--drv_data->suspend_count)
	422	return 0;
	423
	424	if (!test_bit(NFCMRVL_NCI_RUNNING, &drv_data->flags))
	425	goto done;
	426
	427	if (test_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags)) {
	428	err = nfcmrvl_submit_bulk_urb(drv_data, GFP_NOIO);
	429	if (err) {
	430	clear_bit(NFCMRVL_USB_BULK_RUNNING, &drv_data->flags);
	431	goto failed;
	432	}
	433
	434	nfcmrvl_submit_bulk_urb(drv_data, GFP_NOIO);
	435	}
	436
	437	spin_lock_irq(&drv_data->txlock);
	438	nfcmrvl_play_deferred(drv_data);
	439	clear_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
	440	spin_unlock_irq(&drv_data->txlock);
	441
	442	return 0;
	443
	444	failed:
	445	usb_scuttle_anchored_urbs(&drv_data->deferred);
	446	done:
	447	spin_lock_irq(&drv_data->txlock);
	448	clear_bit(NFCMRVL_USB_SUSPENDING, &drv_data->flags);
	449	spin_unlock_irq(&drv_data->txlock);
	450
	451	return err;
	452	}
	453	#endif
	454
	455	static struct usb_driver nfcmrvl_usb_driver = {
	456	.name = "nfcmrvl",
	457	.probe = nfcmrvl_probe,
	458	.disconnect = nfcmrvl_disconnect,
	459	#ifdef CONFIG_PM
	460	.suspend = nfcmrvl_suspend,
	461	.resume = nfcmrvl_resume,
	462	.reset_resume = nfcmrvl_resume,
	463	#endif
	464	.id_table = nfcmrvl_table,
	465	.supports_autosuspend = 1,
	466	.disable_hub_initiated_lpm = 1,
	467	.soft_unbind = 1,
	468	};
	469	module_usb_driver(nfcmrvl_usb_driver);
	470
	471	MODULE_AUTHOR("Marvell International Ltd.");
	472	MODULE_DESCRIPTION("Marvell NFC-over-USB driver ver " VERSION);
	473	MODULE_VERSION(VERSION);
	474	MODULE_LICENSE("GPL v2");