[linux-block.git] / drivers / net / ntb_netdev.c

/*
 * This file is provided under a dual BSD/GPLv2 license.  When using or
 *   redistributing this file, you may do so under either license.
 *
 *   GPL LICENSE SUMMARY
 *
 *   Copyright(c) 2012 Intel Corporation. All rights reserved.
 *   Copyright (C) 2015 EMC Corporation. All Rights Reserved.
 *
 *   This program is free software; you can redistribute it and/or modify
 *   it under the terms of version 2 of the GNU General Public License as
 *   published by the Free Software Foundation.
 *
 *   BSD LICENSE
 *
 *   Copyright(c) 2012 Intel Corporation. All rights reserved.
 *   Copyright (C) 2015 EMC Corporation. All Rights Reserved.
 *
 *   Redistribution and use in source and binary forms, with or without
 *   modification, are permitted provided that the following conditions
 *   are met:
 *
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above copy
 *       notice, this list of conditions and the following disclaimer in
 *       the documentation and/or other materials provided with the
 *       distribution.
 *     * Neither the name of Intel Corporation nor the names of its
 *       contributors may be used to endorse or promote products derived
 *       from this software without specific prior written permission.
 *
 *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * PCIe NTB Network Linux driver
 *
 * Contact Information:
 * Jon Mason <jon.mason@intel.com>
 */
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/ntb.h>
#include <linux/ntb_transport.h>

#define NTB_NETDEV_VER	"0.7"

MODULE_DESCRIPTION(KBUILD_MODNAME);
MODULE_VERSION(NTB_NETDEV_VER);
MODULE_LICENSE("Dual BSD/GPL");
MODULE_AUTHOR("Intel Corporation");

/* Time in usecs for tx resource reaper */
static unsigned int tx_time = 1;

/* Number of descriptors to free before resuming tx */
static unsigned int tx_start = 10;

/* Number of descriptors still available before stop upper layer tx */
static unsigned int tx_stop = 5;

struct ntb_netdev {
	struct pci_dev *pdev;
	struct net_device *ndev;
	struct ntb_transport_qp *qp;
	struct timer_list tx_timer;
};

#define	NTB_TX_TIMEOUT_MS	1000
#define	NTB_RXQ_SIZE		100

static void ntb_netdev_event_handler(void *data, int link_is_up)
{
	struct net_device *ndev = data;
	struct ntb_netdev *dev = netdev_priv(ndev);

	netdev_dbg(ndev, "Event %x, Link %x\n", link_is_up,
		   ntb_transport_link_query(dev->qp));

	if (link_is_up) {
		if (ntb_transport_link_query(dev->qp))
			netif_carrier_on(ndev);
	} else {
		netif_carrier_off(ndev);
	}
}

static void ntb_netdev_rx_handler(struct ntb_transport_qp *qp, void *qp_data,
				  void *data, int len)
{
	struct net_device *ndev = qp_data;
	struct sk_buff *skb;
	int rc;

	skb = data;
	if (!skb)
		return;

	netdev_dbg(ndev, "%s: %d byte payload received\n", __func__, len);

	if (len < 0) {
		ndev->stats.rx_errors++;
		ndev->stats.rx_length_errors++;
		goto enqueue_again;
	}

	skb_put(skb, len);
	skb->protocol = eth_type_trans(skb, ndev);
	skb->ip_summed = CHECKSUM_NONE;

	if (__netif_rx(skb) == NET_RX_DROP) {
		ndev->stats.rx_errors++;
		ndev->stats.rx_dropped++;
	} else {
		ndev->stats.rx_packets++;
		ndev->stats.rx_bytes += len;
	}

	skb = netdev_alloc_skb(ndev, ndev->mtu + ETH_HLEN);
	if (!skb) {
		ndev->stats.rx_errors++;
		ndev->stats.rx_frame_errors++;
		return;
	}

enqueue_again:
	rc = ntb_transport_rx_enqueue(qp, skb, skb->data, ndev->mtu + ETH_HLEN);
	if (rc) {
		dev_kfree_skb(skb);
		ndev->stats.rx_errors++;
		ndev->stats.rx_fifo_errors++;
	}
}

static int __ntb_netdev_maybe_stop_tx(struct net_device *netdev,
				      struct ntb_transport_qp *qp, int size)
{
	struct ntb_netdev *dev = netdev_priv(netdev);

	netif_stop_queue(netdev);
	/* Make sure to see the latest value of ntb_transport_tx_free_entry()
	 * since the queue was last started.
	 */
	smp_mb();

	if (likely(ntb_transport_tx_free_entry(qp) < size)) {
		mod_timer(&dev->tx_timer, jiffies + usecs_to_jiffies(tx_time));
		return -EBUSY;
	}

	netif_start_queue(netdev);
	return 0;
}

static int ntb_netdev_maybe_stop_tx(struct net_device *ndev,
				    struct ntb_transport_qp *qp, int size)
{
	if (netif_queue_stopped(ndev) ||
	    (ntb_transport_tx_free_entry(qp) >= size))
		return 0;

	return __ntb_netdev_maybe_stop_tx(ndev, qp, size);
}

static void ntb_netdev_tx_handler(struct ntb_transport_qp *qp, void *qp_data,
				  void *data, int len)
{
	struct net_device *ndev = qp_data;
	struct sk_buff *skb;
	struct ntb_netdev *dev = netdev_priv(ndev);

	skb = data;
	if (!skb || !ndev)
		return;

	if (len > 0) {
		ndev->stats.tx_packets++;
		ndev->stats.tx_bytes += skb->len;
	} else {
		ndev->stats.tx_errors++;
		ndev->stats.tx_aborted_errors++;
	}

	dev_kfree_skb(skb);

	if (ntb_transport_tx_free_entry(dev->qp) >= tx_start) {
		/* Make sure anybody stopping the queue after this sees the new
		 * value of ntb_transport_tx_free_entry()
		 */
		smp_mb();
		if (netif_queue_stopped(ndev))
			netif_wake_queue(ndev);
	}
}

static netdev_tx_t ntb_netdev_start_xmit(struct sk_buff *skb,
					 struct net_device *ndev)
{
	struct ntb_netdev *dev = netdev_priv(ndev);
	int rc;

	ntb_netdev_maybe_stop_tx(ndev, dev->qp, tx_stop);

	rc = ntb_transport_tx_enqueue(dev->qp, skb, skb->data, skb->len);
	if (rc)
		goto err;

	/* check for next submit */
	ntb_netdev_maybe_stop_tx(ndev, dev->qp, tx_stop);

	return NETDEV_TX_OK;

err:
	ndev->stats.tx_dropped++;
	ndev->stats.tx_errors++;
	return NETDEV_TX_BUSY;
}

static void ntb_netdev_tx_timer(struct timer_list *t)
{
	struct ntb_netdev *dev = from_timer(dev, t, tx_timer);
	struct net_device *ndev = dev->ndev;

	if (ntb_transport_tx_free_entry(dev->qp) < tx_stop) {
		mod_timer(&dev->tx_timer, jiffies + usecs_to_jiffies(tx_time));
	} else {
		/* Make sure anybody stopping the queue after this sees the new
		 * value of ntb_transport_tx_free_entry()
		 */
		smp_mb();
		if (netif_queue_stopped(ndev))
			netif_wake_queue(ndev);
	}
}

static int ntb_netdev_open(struct net_device *ndev)
{
	struct ntb_netdev *dev = netdev_priv(ndev);
	struct sk_buff *skb;
	int rc, i, len;

	/* Add some empty rx bufs */
	for (i = 0; i < NTB_RXQ_SIZE; i++) {
		skb = netdev_alloc_skb(ndev, ndev->mtu + ETH_HLEN);
		if (!skb) {
			rc = -ENOMEM;
			goto err;
		}

		rc = ntb_transport_rx_enqueue(dev->qp, skb, skb->data,
					      ndev->mtu + ETH_HLEN);
		if (rc) {
			dev_kfree_skb(skb);
			goto err;
		}
	}

	timer_setup(&dev->tx_timer, ntb_netdev_tx_timer, 0);

	netif_carrier_off(ndev);
	ntb_transport_link_up(dev->qp);
	netif_start_queue(ndev);

	return 0;

err:
	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
		dev_kfree_skb(skb);
	return rc;
}

static int ntb_netdev_close(struct net_device *ndev)
{
	struct ntb_netdev *dev = netdev_priv(ndev);
	struct sk_buff *skb;
	int len;

	ntb_transport_link_down(dev->qp);

	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
		dev_kfree_skb(skb);

	del_timer_sync(&dev->tx_timer);

	return 0;
}

static int ntb_netdev_change_mtu(struct net_device *ndev, int new_mtu)
{
	struct ntb_netdev *dev = netdev_priv(ndev);
	struct sk_buff *skb;
	int len, rc;

	if (new_mtu > ntb_transport_max_size(dev->qp) - ETH_HLEN)
		return -EINVAL;

	if (!netif_running(ndev)) {
		ndev->mtu = new_mtu;
		return 0;
	}

	/* Bring down the link and dispose of posted rx entries */
	ntb_transport_link_down(dev->qp);

	if (ndev->mtu < new_mtu) {
		int i;

		for (i = 0; (skb = ntb_transport_rx_remove(dev->qp, &len)); i++)
			dev_kfree_skb(skb);

		for (; i; i--) {
			skb = netdev_alloc_skb(ndev, new_mtu + ETH_HLEN);
			if (!skb) {
				rc = -ENOMEM;
				goto err;
			}

			rc = ntb_transport_rx_enqueue(dev->qp, skb, skb->data,
						      new_mtu + ETH_HLEN);
			if (rc) {
				dev_kfree_skb(skb);
				goto err;
			}
		}
	}

	ndev->mtu = new_mtu;

	ntb_transport_link_up(dev->qp);

	return 0;

err:
	ntb_transport_link_down(dev->qp);

	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
		dev_kfree_skb(skb);

	netdev_err(ndev, "Error changing MTU, device inoperable\n");
	return rc;
}

static const struct net_device_ops ntb_netdev_ops = {
	.ndo_open = ntb_netdev_open,
	.ndo_stop = ntb_netdev_close,
	.ndo_start_xmit = ntb_netdev_start_xmit,
	.ndo_change_mtu = ntb_netdev_change_mtu,
	.ndo_set_mac_address = eth_mac_addr,
};

static void ntb_get_drvinfo(struct net_device *ndev,
			    struct ethtool_drvinfo *info)
{
	struct ntb_netdev *dev = netdev_priv(ndev);

	strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
	strlcpy(info->version, NTB_NETDEV_VER, sizeof(info->version));
	strlcpy(info->bus_info, pci_name(dev->pdev), sizeof(info->bus_info));
}

static int ntb_get_link_ksettings(struct net_device *dev,
				  struct ethtool_link_ksettings *cmd)
{
	ethtool_link_ksettings_zero_link_mode(cmd, supported);
	ethtool_link_ksettings_add_link_mode(cmd, supported, Backplane);
	ethtool_link_ksettings_zero_link_mode(cmd, advertising);
	ethtool_link_ksettings_add_link_mode(cmd, advertising, Backplane);

	cmd->base.speed = SPEED_UNKNOWN;
	cmd->base.duplex = DUPLEX_FULL;
	cmd->base.port = PORT_OTHER;
	cmd->base.phy_address = 0;
	cmd->base.autoneg = AUTONEG_ENABLE;

	return 0;
}

static const struct ethtool_ops ntb_ethtool_ops = {
	.get_drvinfo = ntb_get_drvinfo,
	.get_link = ethtool_op_get_link,
	.get_link_ksettings = ntb_get_link_ksettings,
};

static const struct ntb_queue_handlers ntb_netdev_handlers = {
	.tx_handler = ntb_netdev_tx_handler,
	.rx_handler = ntb_netdev_rx_handler,
	.event_handler = ntb_netdev_event_handler,
};

static int ntb_netdev_probe(struct device *client_dev)
{
	struct ntb_dev *ntb;
	struct net_device *ndev;
	struct pci_dev *pdev;
	struct ntb_netdev *dev;
	int rc;

	ntb = dev_ntb(client_dev->parent);
	pdev = ntb->pdev;
	if (!pdev)
		return -ENODEV;

	ndev = alloc_etherdev(sizeof(*dev));
	if (!ndev)
		return -ENOMEM;

	SET_NETDEV_DEV(ndev, client_dev);

	dev = netdev_priv(ndev);
	dev->ndev = ndev;
	dev->pdev = pdev;
	ndev->features = NETIF_F_HIGHDMA;

	ndev->priv_flags |= IFF_LIVE_ADDR_CHANGE;

	ndev->hw_features = ndev->features;
	ndev->watchdog_timeo = msecs_to_jiffies(NTB_TX_TIMEOUT_MS);

	eth_random_addr(ndev->perm_addr);
	dev_addr_set(ndev, ndev->perm_addr);

	ndev->netdev_ops = &ntb_netdev_ops;
	ndev->ethtool_ops = &ntb_ethtool_ops;

	ndev->min_mtu = 0;
	ndev->max_mtu = ETH_MAX_MTU;

	dev->qp = ntb_transport_create_queue(ndev, client_dev,
					     &ntb_netdev_handlers);
	if (!dev->qp) {
		rc = -EIO;
		goto err;
	}

	ndev->mtu = ntb_transport_max_size(dev->qp) - ETH_HLEN;

	rc = register_netdev(ndev);
	if (rc)
		goto err1;

	dev_set_drvdata(client_dev, ndev);
	dev_info(&pdev->dev, "%s created\n", ndev->name);
	return 0;

err1:
	ntb_transport_free_queue(dev->qp);
err:
	free_netdev(ndev);
	return rc;
}

static void ntb_netdev_remove(struct device *client_dev)
{
	struct net_device *ndev = dev_get_drvdata(client_dev);
	struct ntb_netdev *dev = netdev_priv(ndev);

	unregister_netdev(ndev);
	ntb_transport_free_queue(dev->qp);
	free_netdev(ndev);
}

static struct ntb_transport_client ntb_netdev_client = {
	.driver.name = KBUILD_MODNAME,
	.driver.owner = THIS_MODULE,
	.probe = ntb_netdev_probe,
	.remove = ntb_netdev_remove,
};

static int __init ntb_netdev_init_module(void)
{
	int rc;

	rc = ntb_transport_register_client_dev(KBUILD_MODNAME);
	if (rc)
		return rc;
	return ntb_transport_register_client(&ntb_netdev_client);
}
module_init(ntb_netdev_init_module);

static void __exit ntb_netdev_exit_module(void)
{
	ntb_transport_unregister_client(&ntb_netdev_client);
	ntb_transport_unregister_client_dev(KBUILD_MODNAME);
}
module_exit(ntb_netdev_exit_module);
Commit	Line	Data
548c237c JM	1	/*
	2	* This file is provided under a dual BSD/GPLv2 license. When using or
	3	* redistributing this file, you may do so under either license.
	4	*
	5	* GPL LICENSE SUMMARY
	6	*
	7	* Copyright(c) 2012 Intel Corporation. All rights reserved.
e26a5843	8	* Copyright (C) 2015 EMC Corporation. All Rights Reserved.
548c237c JM	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of version 2 of the GNU General Public License as
	12	* published by the Free Software Foundation.
	13	*
	14	* BSD LICENSE
	15	*
	16	* Copyright(c) 2012 Intel Corporation. All rights reserved.
e26a5843	17	* Copyright (C) 2015 EMC Corporation. All Rights Reserved.
548c237c JM	18	*
	19	* Redistribution and use in source and binary forms, with or without
	20	* modification, are permitted provided that the following conditions
	21	* are met:
	22	*
	23	* * Redistributions of source code must retain the above copyright
	24	* notice, this list of conditions and the following disclaimer.
	25	* * Redistributions in binary form must reproduce the above copy
	26	* notice, this list of conditions and the following disclaimer in
	27	* the documentation and/or other materials provided with the
	28	* distribution.
	29	* * Neither the name of Intel Corporation nor the names of its
	30	* contributors may be used to endorse or promote products derived
	31	* from this software without specific prior written permission.
	32	*
	33	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
	34	* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
	35	* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
	36	* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
	37	* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
	38	* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
	39	* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
	40	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
	41	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	42	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
	43	* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	44	*
e26a5843	45	* PCIe NTB Network Linux driver
548c237c JM	46	*
	47	* Contact Information:
	48	* Jon Mason <jon.mason@intel.com>
	49	*/
	50	#include <linux/etherdevice.h>
	51	#include <linux/ethtool.h>
	52	#include <linux/module.h>
	53	#include <linux/pci.h>
e26a5843	54	#include <linux/ntb.h>
ec110bc7	55	#include <linux/ntb_transport.h>
548c237c	56
24208bbe	57	#define NTB_NETDEV_VER "0.7"
548c237c JM	58
	59	MODULE_DESCRIPTION(KBUILD_MODNAME);
	60	MODULE_VERSION(NTB_NETDEV_VER);
	61	MODULE_LICENSE("Dual BSD/GPL");
	62	MODULE_AUTHOR("Intel Corporation");
	63
e74bfeed DJ	64	/* Time in usecs for tx resource reaper */
	65	static unsigned int tx_time = 1;
	66
	67	/* Number of descriptors to free before resuming tx */
	68	static unsigned int tx_start = 10;
	69
	70	/* Number of descriptors still available before stop upper layer tx */
	71	static unsigned int tx_stop = 5;
	72
548c237c	73	struct ntb_netdev {
548c237c JM	74	struct pci_dev *pdev;
	75	struct net_device *ndev;
	76	struct ntb_transport_qp *qp;
e74bfeed	77	struct timer_list tx_timer;
548c237c JM	78	};
	79
	80	#define NTB_TX_TIMEOUT_MS 1000
	81	#define NTB_RXQ_SIZE 100
	82
e26a5843	83	static void ntb_netdev_event_handler(void *data, int link_is_up)
548c237c JM	84	{
	85	struct net_device *ndev = data;
	86	struct ntb_netdev *dev = netdev_priv(ndev);
	87
e26a5843	88	netdev_dbg(ndev, "Event %x, Link %x\n", link_is_up,
548c237c JM	89	ntb_transport_link_query(dev->qp));
548c237c JM	90
e26a5843 AH	91	if (link_is_up) {
	92	if (ntb_transport_link_query(dev->qp))
	93	netif_carrier_on(ndev);
	94	} else {
548c237c	95	netif_carrier_off(ndev);
403c63cb	96	}
548c237c JM	97	}
	98
	99	static void ntb_netdev_rx_handler(struct ntb_transport_qp qp, void qp_data,
	100	void *data, int len)
	101	{
	102	struct net_device *ndev = qp_data;
	103	struct sk_buff *skb;
	104	int rc;
	105
	106	skb = data;
	107	if (!skb)
	108	return;
	109
	110	netdev_dbg(ndev, "%s: %d byte payload received\n", __func__, len);
	111
da2e5ae5 AH	112	if (len < 0) {
	113	ndev->stats.rx_errors++;
	114	ndev->stats.rx_length_errors++;
	115	goto enqueue_again;
	116	}
	117
548c237c JM	118	skb_put(skb, len);
	119	skb->protocol = eth_type_trans(skb, ndev);
	120	skb->ip_summed = CHECKSUM_NONE;
	121
baebdf48	122	if (__netif_rx(skb) == NET_RX_DROP) {
548c237c JM	123	ndev->stats.rx_errors++;
	124	ndev->stats.rx_dropped++;
	125	} else {
	126	ndev->stats.rx_packets++;
	127	ndev->stats.rx_bytes += len;
	128	}
	129
	130	skb = netdev_alloc_skb(ndev, ndev->mtu + ETH_HLEN);
	131	if (!skb) {
	132	ndev->stats.rx_errors++;
	133	ndev->stats.rx_frame_errors++;
	134	return;
	135	}
	136
da2e5ae5	137	enqueue_again:
548c237c JM	138	rc = ntb_transport_rx_enqueue(qp, skb, skb->data, ndev->mtu + ETH_HLEN);
548c237c JM	139	if (rc) {
765ccc7b	140	dev_kfree_skb(skb);
548c237c JM	141	ndev->stats.rx_errors++;
	142	ndev->stats.rx_fifo_errors++;
	143	}
	144	}
	145
e74bfeed DJ	146	static int __ntb_netdev_maybe_stop_tx(struct net_device *netdev,
	147	struct ntb_transport_qp *qp, int size)
	148	{
	149	struct ntb_netdev *dev = netdev_priv(netdev);
	150
	151	netif_stop_queue(netdev);
	152	/* Make sure to see the latest value of ntb_transport_tx_free_entry()
	153	* since the queue was last started.
	154	*/
	155	smp_mb();
	156
	157	if (likely(ntb_transport_tx_free_entry(qp) < size)) {
	158	mod_timer(&dev->tx_timer, jiffies + usecs_to_jiffies(tx_time));
	159	return -EBUSY;
	160	}
	161
	162	netif_start_queue(netdev);
	163	return 0;
	164	}
	165
	166	static int ntb_netdev_maybe_stop_tx(struct net_device *ndev,
	167	struct ntb_transport_qp *qp, int size)
	168	{
	169	if (netif_queue_stopped(ndev) \|\|
	170	(ntb_transport_tx_free_entry(qp) >= size))
	171	return 0;
	172
	173	return __ntb_netdev_maybe_stop_tx(ndev, qp, size);
	174	}
	175
548c237c JM	176	static void ntb_netdev_tx_handler(struct ntb_transport_qp qp, void qp_data,
	177	void *data, int len)
	178	{
	179	struct net_device *ndev = qp_data;
	180	struct sk_buff *skb;
e74bfeed	181	struct ntb_netdev *dev = netdev_priv(ndev);
548c237c JM	182
	183	skb = data;
	184	if (!skb \|\| !ndev)
	185	return;
	186
	187	if (len > 0) {
	188	ndev->stats.tx_packets++;
	189	ndev->stats.tx_bytes += skb->len;
	190	} else {
	191	ndev->stats.tx_errors++;
	192	ndev->stats.tx_aborted_errors++;
	193	}
	194
	195	dev_kfree_skb(skb);
e74bfeed DJ	196
	197	if (ntb_transport_tx_free_entry(dev->qp) >= tx_start) {
	198	/* Make sure anybody stopping the queue after this sees the new
	199	* value of ntb_transport_tx_free_entry()
	200	*/
	201	smp_mb();
	202	if (netif_queue_stopped(ndev))
	203	netif_wake_queue(ndev);
	204	}
548c237c JM	205	}
	206
	207	static netdev_tx_t ntb_netdev_start_xmit(struct sk_buff *skb,
	208	struct net_device *ndev)
	209	{
	210	struct ntb_netdev *dev = netdev_priv(ndev);
	211	int rc;
	212
e74bfeed DJ	213	ntb_netdev_maybe_stop_tx(ndev, dev->qp, tx_stop);
e74bfeed DJ	214
548c237c JM	215	rc = ntb_transport_tx_enqueue(dev->qp, skb, skb->data, skb->len);
	216	if (rc)
	217	goto err;
	218
e74bfeed DJ	219	/* check for next submit */
	220	ntb_netdev_maybe_stop_tx(ndev, dev->qp, tx_stop);
	221
548c237c JM	222	return NETDEV_TX_OK;
	223
	224	err:
	225	ndev->stats.tx_dropped++;
	226	ndev->stats.tx_errors++;
548c237c JM	227	return NETDEV_TX_BUSY;
	228	}
	229
2fd2f61e	230	static void ntb_netdev_tx_timer(struct timer_list *t)
e74bfeed	231	{
2fd2f61e KC	232	struct ntb_netdev *dev = from_timer(dev, t, tx_timer);
2fd2f61e KC	233	struct net_device *ndev = dev->ndev;
e74bfeed DJ	234
e74bfeed DJ	235	if (ntb_transport_tx_free_entry(dev->qp) < tx_stop) {
a861594b	236	mod_timer(&dev->tx_timer, jiffies + usecs_to_jiffies(tx_time));
e74bfeed DJ	237	} else {
	238	/* Make sure anybody stopping the queue after this sees the new
	239	* value of ntb_transport_tx_free_entry()
	240	*/
	241	smp_mb();
	242	if (netif_queue_stopped(ndev))
	243	netif_wake_queue(ndev);
	244	}
	245	}
	246
548c237c JM	247	static int ntb_netdev_open(struct net_device *ndev)
	248	{
	249	struct ntb_netdev *dev = netdev_priv(ndev);
	250	struct sk_buff *skb;
	251	int rc, i, len;
	252
	253	/* Add some empty rx bufs */
	254	for (i = 0; i < NTB_RXQ_SIZE; i++) {
	255	skb = netdev_alloc_skb(ndev, ndev->mtu + ETH_HLEN);
	256	if (!skb) {
	257	rc = -ENOMEM;
	258	goto err;
	259	}
	260
	261	rc = ntb_transport_rx_enqueue(dev->qp, skb, skb->data,
	262	ndev->mtu + ETH_HLEN);
da4eb27a	263	if (rc) {
e8bc2ebd	264	dev_kfree_skb(skb);
548c237c	265	goto err;
e8bc2ebd	266	}
548c237c JM	267	}
548c237c JM	268
2fd2f61e	269	timer_setup(&dev->tx_timer, ntb_netdev_tx_timer, 0);
e74bfeed	270
548c237c JM	271	netif_carrier_off(ndev);
548c237c JM	272	ntb_transport_link_up(dev->qp);
e74bfeed	273	netif_start_queue(ndev);
548c237c JM	274
	275	return 0;
	276
	277	err:
	278	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
	279	dev_kfree_skb(skb);
	280	return rc;
	281	}
	282
	283	static int ntb_netdev_close(struct net_device *ndev)
	284	{
	285	struct ntb_netdev *dev = netdev_priv(ndev);
	286	struct sk_buff *skb;
	287	int len;
	288
	289	ntb_transport_link_down(dev->qp);
	290
	291	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
	292	dev_kfree_skb(skb);
	293
e74bfeed DJ	294	del_timer_sync(&dev->tx_timer);
e74bfeed DJ	295
548c237c JM	296	return 0;
	297	}
	298
	299	static int ntb_netdev_change_mtu(struct net_device *ndev, int new_mtu)
	300	{
	301	struct ntb_netdev *dev = netdev_priv(ndev);
	302	struct sk_buff *skb;
	303	int len, rc;
	304
	305	if (new_mtu > ntb_transport_max_size(dev->qp) - ETH_HLEN)
	306	return -EINVAL;
	307
	308	if (!netif_running(ndev)) {
	309	ndev->mtu = new_mtu;
	310	return 0;
	311	}
	312
	313	/* Bring down the link and dispose of posted rx entries */
	314	ntb_transport_link_down(dev->qp);
	315
	316	if (ndev->mtu < new_mtu) {
	317	int i;
	318
	319	for (i = 0; (skb = ntb_transport_rx_remove(dev->qp, &len)); i++)
	320	dev_kfree_skb(skb);
	321
	322	for (; i; i--) {
	323	skb = netdev_alloc_skb(ndev, new_mtu + ETH_HLEN);
	324	if (!skb) {
	325	rc = -ENOMEM;
	326	goto err;
	327	}
	328
	329	rc = ntb_transport_rx_enqueue(dev->qp, skb, skb->data,
	330	new_mtu + ETH_HLEN);
	331	if (rc) {
	332	dev_kfree_skb(skb);
	333	goto err;
	334	}
	335	}
	336	}
	337
	338	ndev->mtu = new_mtu;
	339
	340	ntb_transport_link_up(dev->qp);
	341
	342	return 0;
	343
	344	err:
	345	ntb_transport_link_down(dev->qp);
	346
	347	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
	348	dev_kfree_skb(skb);
	349
	350	netdev_err(ndev, "Error changing MTU, device inoperable\n");
	351	return rc;
	352	}
	353
548c237c JM	354	static const struct net_device_ops ntb_netdev_ops = {
	355	.ndo_open = ntb_netdev_open,
	356	.ndo_stop = ntb_netdev_close,
	357	.ndo_start_xmit = ntb_netdev_start_xmit,
	358	.ndo_change_mtu = ntb_netdev_change_mtu,
548c237c JM	359	.ndo_set_mac_address = eth_mac_addr,
	360	};
	361
	362	static void ntb_get_drvinfo(struct net_device *ndev,
	363	struct ethtool_drvinfo *info)
	364	{
	365	struct ntb_netdev *dev = netdev_priv(ndev);
	366
	367	strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
	368	strlcpy(info->version, NTB_NETDEV_VER, sizeof(info->version));
	369	strlcpy(info->bus_info, pci_name(dev->pdev), sizeof(info->bus_info));
	370	}
	371
a062d19e PR	372	static int ntb_get_link_ksettings(struct net_device *dev,
a062d19e PR	373	struct ethtool_link_ksettings *cmd)
548c237c	374	{
a062d19e PR	375	ethtool_link_ksettings_zero_link_mode(cmd, supported);
	376	ethtool_link_ksettings_add_link_mode(cmd, supported, Backplane);
	377	ethtool_link_ksettings_zero_link_mode(cmd, advertising);
	378	ethtool_link_ksettings_add_link_mode(cmd, advertising, Backplane);
	379
	380	cmd->base.speed = SPEED_UNKNOWN;
	381	cmd->base.duplex = DUPLEX_FULL;
	382	cmd->base.port = PORT_OTHER;
	383	cmd->base.phy_address = 0;
	384	cmd->base.autoneg = AUTONEG_ENABLE;
548c237c JM	385
	386	return 0;
	387	}
	388
	389	static const struct ethtool_ops ntb_ethtool_ops = {
	390	.get_drvinfo = ntb_get_drvinfo,
	391	.get_link = ethtool_op_get_link,
a062d19e	392	.get_link_ksettings = ntb_get_link_ksettings,
548c237c JM	393	};
	394
	395	static const struct ntb_queue_handlers ntb_netdev_handlers = {
	396	.tx_handler = ntb_netdev_tx_handler,
	397	.rx_handler = ntb_netdev_rx_handler,
	398	.event_handler = ntb_netdev_event_handler,
	399	};
	400
e26a5843	401	static int ntb_netdev_probe(struct device *client_dev)
548c237c	402	{
e26a5843	403	struct ntb_dev *ntb;
548c237c	404	struct net_device *ndev;
e26a5843	405	struct pci_dev *pdev;
548c237c JM	406	struct ntb_netdev *dev;
	407	int rc;
	408
e26a5843 AH	409	ntb = dev_ntb(client_dev->parent);
	410	pdev = ntb->pdev;
	411	if (!pdev)
	412	return -ENODEV;
	413
	414	ndev = alloc_etherdev(sizeof(*dev));
548c237c JM	415	if (!ndev)
	416	return -ENOMEM;
	417
854b1dd9 LG	418	SET_NETDEV_DEV(ndev, client_dev);
854b1dd9 LG	419
548c237c JM	420	dev = netdev_priv(ndev);
	421	dev->ndev = ndev;
	422	dev->pdev = pdev;
548c237c JM	423	ndev->features = NETIF_F_HIGHDMA;
	424
	425	ndev->priv_flags \|= IFF_LIVE_ADDR_CHANGE;
	426
	427	ndev->hw_features = ndev->features;
	428	ndev->watchdog_timeo = msecs_to_jiffies(NTB_TX_TIMEOUT_MS);
	429
6c1f0a1f	430	eth_random_addr(ndev->perm_addr);
ea52a0b5	431	dev_addr_set(ndev, ndev->perm_addr);
548c237c JM	432
548c237c JM	433	ndev->netdev_ops = &ntb_netdev_ops;
7ad24ea4	434	ndev->ethtool_ops = &ntb_ethtool_ops;
548c237c	435
91572088 JW	436	ndev->min_mtu = 0;
	437	ndev->max_mtu = ETH_MAX_MTU;
	438
e26a5843 AH	439	dev->qp = ntb_transport_create_queue(ndev, client_dev,
e26a5843 AH	440	&ntb_netdev_handlers);
548c237c JM	441	if (!dev->qp) {
	442	rc = -EIO;
	443	goto err;
	444	}
	445
	446	ndev->mtu = ntb_transport_max_size(dev->qp) - ETH_HLEN;
	447
	448	rc = register_netdev(ndev);
	449	if (rc)
	450	goto err1;
	451
906e86b2	452	dev_set_drvdata(client_dev, ndev);
7bcd2b11	453	dev_info(&pdev->dev, "%s created\n", ndev->name);
548c237c JM	454	return 0;
	455
	456	err1:
	457	ntb_transport_free_queue(dev->qp);
	458	err:
	459	free_netdev(ndev);
	460	return rc;
	461	}
	462
e26a5843	463	static void ntb_netdev_remove(struct device *client_dev)
548c237c	464	{
906e86b2 AS	465	struct net_device *ndev = dev_get_drvdata(client_dev);
906e86b2 AS	466	struct ntb_netdev *dev = netdev_priv(ndev);
548c237c JM	467
	468	unregister_netdev(ndev);
	469	ntb_transport_free_queue(dev->qp);
	470	free_netdev(ndev);
	471	}
	472
e26a5843	473	static struct ntb_transport_client ntb_netdev_client = {
548c237c JM	474	.driver.name = KBUILD_MODNAME,
	475	.driver.owner = THIS_MODULE,
	476	.probe = ntb_netdev_probe,
	477	.remove = ntb_netdev_remove,
	478	};
	479
	480	static int __init ntb_netdev_init_module(void)
	481	{
	482	int rc;
	483
e26a5843	484	rc = ntb_transport_register_client_dev(KBUILD_MODNAME);
548c237c JM	485	if (rc)
548c237c JM	486	return rc;
ec110bc7	487	return ntb_transport_register_client(&ntb_netdev_client);
548c237c JM	488	}
	489	module_init(ntb_netdev_init_module);
	490
	491	static void __exit ntb_netdev_exit_module(void)
	492	{
ec110bc7	493	ntb_transport_unregister_client(&ntb_netdev_client);
e26a5843	494	ntb_transport_unregister_client_dev(KBUILD_MODNAME);
548c237c JM	495	}
548c237c JM	496	module_exit(ntb_netdev_exit_module);