[mirror_ubuntu-bionic-kernel.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");

struct ntb_netdev {
	struct list_head list;
	struct pci_dev *pdev;
	struct net_device *ndev;
	struct ntb_transport_qp *qp;
};

#define	NTB_TX_TIMEOUT_MS	1000
#define	NTB_RXQ_SIZE		100

static LIST_HEAD(dev_list);

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 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;

	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);
}

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;

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

	return NETDEV_TX_OK;

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

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;
		}
	}

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

	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);

	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_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
	cmd->supported = SUPPORTED_Backplane;
	cmd->advertising = ADVERTISED_Backplane;
	ethtool_cmd_speed_set(cmd, SPEED_UNKNOWN);
	cmd->duplex = DUPLEX_FULL;
	cmd->port = PORT_OTHER;
	cmd->phy_address = 0;
	cmd->transceiver = XCVR_DUMMY1;
	cmd->autoneg = AUTONEG_ENABLE;
	cmd->maxtxpkt = 0;
	cmd->maxrxpkt = 0;

	return 0;
}

static const struct ethtool_ops ntb_ethtool_ops = {
	.get_drvinfo = ntb_get_drvinfo,
	.get_link = ethtool_op_get_link,
	.get_settings = ntb_get_settings,
};

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;

	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);

	random_ether_addr(ndev->perm_addr);
	memcpy(ndev->dev_addr, ndev->perm_addr, ndev->addr_len);

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

	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;

	list_add(&dev->list, &dev_list);
	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 ntb_dev *ntb;
	struct net_device *ndev;
	struct pci_dev *pdev;
	struct ntb_netdev *dev;
	bool found = false;

	ntb = dev_ntb(client_dev->parent);
	pdev = ntb->pdev;

	list_for_each_entry(dev, &dev_list, list) {
		if (dev->pdev == pdev) {
			found = true;
			break;
		}
	}
	if (!found)
		return;

	list_del(&dev->list);

	ndev = dev->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
	64	struct ntb_netdev {
	65	struct list_head list;
	66	struct pci_dev *pdev;
	67	struct net_device *ndev;
	68	struct ntb_transport_qp *qp;
	69	};
	70
	71	#define NTB_TX_TIMEOUT_MS 1000
	72	#define NTB_RXQ_SIZE 100
	73
	74	static LIST_HEAD(dev_list);
	75
e26a5843	76	static void ntb_netdev_event_handler(void *data, int link_is_up)
548c237c JM	77	{
	78	struct net_device *ndev = data;
	79	struct ntb_netdev *dev = netdev_priv(ndev);
	80
e26a5843	81	netdev_dbg(ndev, "Event %x, Link %x\n", link_is_up,
548c237c JM	82	ntb_transport_link_query(dev->qp));
548c237c JM	83
e26a5843 AH	84	if (link_is_up) {
	85	if (ntb_transport_link_query(dev->qp))
	86	netif_carrier_on(ndev);
	87	} else {
548c237c	88	netif_carrier_off(ndev);
403c63cb	89	}
548c237c JM	90	}
	91
	92	static void ntb_netdev_rx_handler(struct ntb_transport_qp qp, void qp_data,
	93	void *data, int len)
	94	{
	95	struct net_device *ndev = qp_data;
	96	struct sk_buff *skb;
	97	int rc;
	98
	99	skb = data;
	100	if (!skb)
	101	return;
	102
	103	netdev_dbg(ndev, "%s: %d byte payload received\n", __func__, len);
	104
da2e5ae5 AH	105	if (len < 0) {
	106	ndev->stats.rx_errors++;
	107	ndev->stats.rx_length_errors++;
	108	goto enqueue_again;
	109	}
	110
548c237c JM	111	skb_put(skb, len);
	112	skb->protocol = eth_type_trans(skb, ndev);
	113	skb->ip_summed = CHECKSUM_NONE;
	114
	115	if (netif_rx(skb) == NET_RX_DROP) {
	116	ndev->stats.rx_errors++;
	117	ndev->stats.rx_dropped++;
	118	} else {
	119	ndev->stats.rx_packets++;
	120	ndev->stats.rx_bytes += len;
	121	}
	122
	123	skb = netdev_alloc_skb(ndev, ndev->mtu + ETH_HLEN);
	124	if (!skb) {
	125	ndev->stats.rx_errors++;
	126	ndev->stats.rx_frame_errors++;
	127	return;
	128	}
	129
da2e5ae5	130	enqueue_again:
548c237c JM	131	rc = ntb_transport_rx_enqueue(qp, skb, skb->data, ndev->mtu + ETH_HLEN);
548c237c JM	132	if (rc) {
765ccc7b	133	dev_kfree_skb(skb);
548c237c JM	134	ndev->stats.rx_errors++;
	135	ndev->stats.rx_fifo_errors++;
	136	}
	137	}
	138
	139	static void ntb_netdev_tx_handler(struct ntb_transport_qp qp, void qp_data,
	140	void *data, int len)
	141	{
	142	struct net_device *ndev = qp_data;
	143	struct sk_buff *skb;
	144
	145	skb = data;
	146	if (!skb \|\| !ndev)
	147	return;
	148
	149	if (len > 0) {
	150	ndev->stats.tx_packets++;
	151	ndev->stats.tx_bytes += skb->len;
	152	} else {
	153	ndev->stats.tx_errors++;
	154	ndev->stats.tx_aborted_errors++;
	155	}
	156
	157	dev_kfree_skb(skb);
548c237c JM	158	}
	159
	160	static netdev_tx_t ntb_netdev_start_xmit(struct sk_buff *skb,
	161	struct net_device *ndev)
	162	{
	163	struct ntb_netdev *dev = netdev_priv(ndev);
	164	int rc;
	165
548c237c JM	166	rc = ntb_transport_tx_enqueue(dev->qp, skb, skb->data, skb->len);
	167	if (rc)
	168	goto err;
	169
	170	return NETDEV_TX_OK;
	171
	172	err:
	173	ndev->stats.tx_dropped++;
	174	ndev->stats.tx_errors++;
548c237c JM	175	return NETDEV_TX_BUSY;
	176	}
	177
	178	static int ntb_netdev_open(struct net_device *ndev)
	179	{
	180	struct ntb_netdev *dev = netdev_priv(ndev);
	181	struct sk_buff *skb;
	182	int rc, i, len;
	183
	184	/* Add some empty rx bufs */
	185	for (i = 0; i < NTB_RXQ_SIZE; i++) {
	186	skb = netdev_alloc_skb(ndev, ndev->mtu + ETH_HLEN);
	187	if (!skb) {
	188	rc = -ENOMEM;
	189	goto err;
	190	}
	191
	192	rc = ntb_transport_rx_enqueue(dev->qp, skb, skb->data,
	193	ndev->mtu + ETH_HLEN);
da4eb27a	194	if (rc) {
e8bc2ebd	195	dev_kfree_skb(skb);
548c237c	196	goto err;
e8bc2ebd	197	}
548c237c JM	198	}
	199
	200	netif_carrier_off(ndev);
	201	ntb_transport_link_up(dev->qp);
	202
	203	return 0;
	204
	205	err:
	206	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
	207	dev_kfree_skb(skb);
	208	return rc;
	209	}
	210
	211	static int ntb_netdev_close(struct net_device *ndev)
	212	{
	213	struct ntb_netdev *dev = netdev_priv(ndev);
	214	struct sk_buff *skb;
	215	int len;
	216
	217	ntb_transport_link_down(dev->qp);
	218
	219	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
	220	dev_kfree_skb(skb);
	221
	222	return 0;
	223	}
	224
	225	static int ntb_netdev_change_mtu(struct net_device *ndev, int new_mtu)
	226	{
	227	struct ntb_netdev *dev = netdev_priv(ndev);
	228	struct sk_buff *skb;
	229	int len, rc;
	230
	231	if (new_mtu > ntb_transport_max_size(dev->qp) - ETH_HLEN)
	232	return -EINVAL;
	233
	234	if (!netif_running(ndev)) {
	235	ndev->mtu = new_mtu;
	236	return 0;
	237	}
	238
	239	/* Bring down the link and dispose of posted rx entries */
	240	ntb_transport_link_down(dev->qp);
	241
	242	if (ndev->mtu < new_mtu) {
	243	int i;
	244
	245	for (i = 0; (skb = ntb_transport_rx_remove(dev->qp, &len)); i++)
	246	dev_kfree_skb(skb);
	247
	248	for (; i; i--) {
	249	skb = netdev_alloc_skb(ndev, new_mtu + ETH_HLEN);
	250	if (!skb) {
	251	rc = -ENOMEM;
	252	goto err;
	253	}
	254
	255	rc = ntb_transport_rx_enqueue(dev->qp, skb, skb->data,
	256	new_mtu + ETH_HLEN);
	257	if (rc) {
	258	dev_kfree_skb(skb);
	259	goto err;
	260	}
	261	}
262	}
263
264	ndev->mtu = new_mtu;
265
266	ntb_transport_link_up(dev->qp);
267
268	return 0;
269
270	err:
271	ntb_transport_link_down(dev->qp);
272
273	while ((skb = ntb_transport_rx_remove(dev->qp, &len)))
274	dev_kfree_skb(skb);
275
276	netdev_err(ndev, "Error changing MTU, device inoperable\n");
277	return rc;
278	}
279
548c237c JM	280	static const struct net_device_ops ntb_netdev_ops = {
	281	.ndo_open = ntb_netdev_open,
	282	.ndo_stop = ntb_netdev_close,
	283	.ndo_start_xmit = ntb_netdev_start_xmit,
	284	.ndo_change_mtu = ntb_netdev_change_mtu,
548c237c JM	285	.ndo_set_mac_address = eth_mac_addr,
	286	};
	287
	288	static void ntb_get_drvinfo(struct net_device *ndev,
	289	struct ethtool_drvinfo *info)
	290	{
	291	struct ntb_netdev *dev = netdev_priv(ndev);
	292
	293	strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
	294	strlcpy(info->version, NTB_NETDEV_VER, sizeof(info->version));
	295	strlcpy(info->bus_info, pci_name(dev->pdev), sizeof(info->bus_info));
	296	}
	297
	298	static int ntb_get_settings(struct net_device dev, struct ethtool_cmd cmd)
	299	{
	300	cmd->supported = SUPPORTED_Backplane;
	301	cmd->advertising = ADVERTISED_Backplane;
548c237c JM	302	ethtool_cmd_speed_set(cmd, SPEED_UNKNOWN);
	303	cmd->duplex = DUPLEX_FULL;
	304	cmd->port = PORT_OTHER;
	305	cmd->phy_address = 0;
	306	cmd->transceiver = XCVR_DUMMY1;
	307	cmd->autoneg = AUTONEG_ENABLE;
	308	cmd->maxtxpkt = 0;
	309	cmd->maxrxpkt = 0;
	310
	311	return 0;
	312	}
	313
	314	static const struct ethtool_ops ntb_ethtool_ops = {
	315	.get_drvinfo = ntb_get_drvinfo,
	316	.get_link = ethtool_op_get_link,
	317	.get_settings = ntb_get_settings,
	318	};
	319
	320	static const struct ntb_queue_handlers ntb_netdev_handlers = {
	321	.tx_handler = ntb_netdev_tx_handler,
	322	.rx_handler = ntb_netdev_rx_handler,
	323	.event_handler = ntb_netdev_event_handler,
	324	};
	325
e26a5843	326	static int ntb_netdev_probe(struct device *client_dev)
548c237c	327	{
e26a5843	328	struct ntb_dev *ntb;
548c237c	329	struct net_device *ndev;
e26a5843	330	struct pci_dev *pdev;
548c237c JM	331	struct ntb_netdev *dev;
	332	int rc;
	333
e26a5843 AH	334	ntb = dev_ntb(client_dev->parent);
	335	pdev = ntb->pdev;
	336	if (!pdev)
	337	return -ENODEV;
	338
	339	ndev = alloc_etherdev(sizeof(*dev));
548c237c JM	340	if (!ndev)
	341	return -ENOMEM;
	342
	343	dev = netdev_priv(ndev);
	344	dev->ndev = ndev;
	345	dev->pdev = pdev;
548c237c JM	346	ndev->features = NETIF_F_HIGHDMA;
	347
	348	ndev->priv_flags \|= IFF_LIVE_ADDR_CHANGE;
	349
	350	ndev->hw_features = ndev->features;
	351	ndev->watchdog_timeo = msecs_to_jiffies(NTB_TX_TIMEOUT_MS);
	352
	353	random_ether_addr(ndev->perm_addr);
	354	memcpy(ndev->dev_addr, ndev->perm_addr, ndev->addr_len);
	355
	356	ndev->netdev_ops = &ntb_netdev_ops;
7ad24ea4	357	ndev->ethtool_ops = &ntb_ethtool_ops;
548c237c	358
e26a5843 AH	359	dev->qp = ntb_transport_create_queue(ndev, client_dev,
e26a5843 AH	360	&ntb_netdev_handlers);
548c237c JM	361	if (!dev->qp) {
	362	rc = -EIO;
	363	goto err;
	364	}
	365
	366	ndev->mtu = ntb_transport_max_size(dev->qp) - ETH_HLEN;
	367
	368	rc = register_netdev(ndev);
	369	if (rc)
	370	goto err1;
	371
	372	list_add(&dev->list, &dev_list);
7bcd2b11	373	dev_info(&pdev->dev, "%s created\n", ndev->name);
548c237c JM	374	return 0;
	375
	376	err1:
	377	ntb_transport_free_queue(dev->qp);
	378	err:
	379	free_netdev(ndev);
	380	return rc;
	381	}
	382
e26a5843	383	static void ntb_netdev_remove(struct device *client_dev)
548c237c	384	{
e26a5843	385	struct ntb_dev *ntb;
548c237c	386	struct net_device *ndev;
e26a5843	387	struct pci_dev *pdev;
548c237c	388	struct ntb_netdev *dev;
53ca4fea	389	bool found = false;
548c237c	390
e26a5843 AH	391	ntb = dev_ntb(client_dev->parent);
	392	pdev = ntb->pdev;
	393
548c237c	394	list_for_each_entry(dev, &dev_list, list) {
fea903ec JM	395	if (dev->pdev == pdev) {
fea903ec JM	396	found = true;
548c237c	397	break;
fea903ec	398	}
548c237c	399	}
fea903ec	400	if (!found)
548c237c JM	401	return;
548c237c JM	402
904435cf JM	403	list_del(&dev->list);
904435cf JM	404
548c237c JM	405	ndev = dev->ndev;
	406
	407	unregister_netdev(ndev);
	408	ntb_transport_free_queue(dev->qp);
	409	free_netdev(ndev);
	410	}
	411
e26a5843	412	static struct ntb_transport_client ntb_netdev_client = {
548c237c JM	413	.driver.name = KBUILD_MODNAME,
	414	.driver.owner = THIS_MODULE,
	415	.probe = ntb_netdev_probe,
	416	.remove = ntb_netdev_remove,
	417	};
	418
	419	static int __init ntb_netdev_init_module(void)
	420	{
	421	int rc;
	422
e26a5843	423	rc = ntb_transport_register_client_dev(KBUILD_MODNAME);
548c237c JM	424	if (rc)
548c237c JM	425	return rc;
ec110bc7	426	return ntb_transport_register_client(&ntb_netdev_client);
548c237c JM	427	}
	428	module_init(ntb_netdev_init_module);
	429
	430	static void __exit ntb_netdev_exit_module(void)
	431	{
ec110bc7	432	ntb_transport_unregister_client(&ntb_netdev_client);
e26a5843	433	ntb_transport_unregister_client_dev(KBUILD_MODNAME);
548c237c JM	434	}
548c237c JM	435	module_exit(ntb_netdev_exit_module);