kern/drivers/net/mlx4/en_main.c - upstream - Git at Google

 /*
  * Copyright (c) 2007 Mellanox Technologies. All rights reserved.
  *
  * This software is available to you under a choice of one of two
  * licenses.  You may choose to be licensed under the terms of the GNU
  * General Public License (GPL) Version 2, available from the file
  * COPYING in the main directory of this source tree, or the
  * OpenIB.org BSD license below:
  *
  *     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
  *        copyright notice, this list of conditions and the following
  *        disclaimer in the documentation and/or other materials
  *        provided with the distribution.
  *
  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  * SOFTWARE.
  *
  */

 #include <linux_compat.h>
 #include <linux/mlx4/driver.h>
 #include <linux/mlx4/device.h>
 #include <linux/mlx4/cmd.h>

 #include "mlx4_en.h"

 MODULE_AUTHOR("Liran Liss, Yevgeny Petrilin");
 MODULE_DESCRIPTION("Mellanox ConnectX HCA Ethernet driver");
 MODULE_LICENSE("Dual BSD/GPL");
 MODULE_VERSION(DRV_VERSION " ("DRV_RELDATE")");

 static const char mlx4_en_version[] =
 	DRV_NAME ": Mellanox ConnectX HCA Ethernet driver v"
 	DRV_VERSION " (" DRV_RELDATE ")\n";

 #define MLX4_EN_PARM_INT(X, def_val, desc) \
 	static unsigned int X = def_val;\
 	module_param(X , uint, 0444); \
 	MODULE_PARM_DESC(X, desc);


 /*
  * Device scope module parameters
  */

 /* Enable RSS UDP traffic */
 MLX4_EN_PARM_INT(udp_rss, 1,
 		 "Enable RSS for incoming UDP traffic or disabled (0)");

 /* Priority pausing */
 MLX4_EN_PARM_INT(pfctx, 0, "Priority based Flow Control policy on TX[7:0]."
 			   " Per priority bit mask");
 MLX4_EN_PARM_INT(pfcrx, 0, "Priority based Flow Control policy on RX[7:0]."
 			   " Per priority bit mask");

 MLX4_EN_PARM_INT(inline_thold, MAX_INLINE,
 		 "Threshold for using inline data (range: 17-104, default: 104)");

 #define MAX_PFC_TX     0xff
 #define MAX_PFC_RX     0xff

 void en_print(const char *level, const struct mlx4_en_priv *priv,
 	      const char *format, ...)
 {
 #if 0 // AKAROS_PORT
 	va_list args;
 	struct va_format vaf;

 	va_start(args, format);

 	vaf.fmt = format;
 	vaf.va = &args;
 	if (priv->registered)
 		printk("%s%s: %s: %pV",
 		       level, DRV_NAME, priv->dev->name, &vaf);
 	else
 		printk("%s%s: %s: Port %d: %pV",
 		       level, DRV_NAME, dev_name(&priv->mdev->pdev->dev),
 		       priv->port, &vaf);
 	va_end(args);
 #else
 	va_list args;

 	va_start(args, format);
 	if (priv->registered)
 		printk("%s%s: %s: ", level, DRV_NAME, priv->dev->name);
 	else
 		printk("%s%s: %s: Port %d: ", level, DRV_NAME,
 		       dev_name(&priv->mdev->pdev->dev), priv->port);
 	vcprintf(format, args);
 	va_end(args);
 #endif
 }

 void mlx4_en_update_loopback_state(struct ether *dev,
 				   netdev_features_t features)
 {
 	struct mlx4_en_priv *priv = netdev_priv(dev);

 	if (features & NETIF_F_LOOPBACK)
 		priv->ctrl_flags |= cpu_to_be32(MLX4_WQE_CTRL_FORCE_LOOPBACK);
 	else
 		priv->ctrl_flags &= cpu_to_be32(~MLX4_WQE_CTRL_FORCE_LOOPBACK);

 	priv->flags &= ~(MLX4_EN_FLAG_RX_FILTER_NEEDED|
 			MLX4_EN_FLAG_ENABLE_HW_LOOPBACK);

 	/* Drop the packet if SRIOV is not enabled
 	 * and not performing the selftest or flb disabled
 	 */
 	if (mlx4_is_mfunc(priv->mdev->dev) &&
 	    !(features & NETIF_F_LOOPBACK) && !priv->validate_loopback)
 		priv->flags |= MLX4_EN_FLAG_RX_FILTER_NEEDED;

 	/* Set dmac in Tx WQE if we are in SRIOV mode or if loopback selftest
 	 * is requested
 	 */
 	if (mlx4_is_mfunc(priv->mdev->dev) || priv->validate_loopback)
 		priv->flags |= MLX4_EN_FLAG_ENABLE_HW_LOOPBACK;
 }

 static int mlx4_en_get_profile(struct mlx4_en_dev *mdev)
 {
 	struct mlx4_en_profile *params = &mdev->profile;
 	int i;

 	params->udp_rss = udp_rss;
 	params->num_tx_rings_p_up = mlx4_low_memory_profile() ?
 		MLX4_EN_MIN_TX_RING_P_UP :
 		MIN_T(int, num_online_cpus(), MLX4_EN_MAX_TX_RING_P_UP);

 	if (params->udp_rss && !(mdev->dev->caps.flags
 					& MLX4_DEV_CAP_FLAG_UDP_RSS)) {
 		mlx4_warn(mdev, "UDP RSS is not supported on this device\n");
 		params->udp_rss = 0;
 	}
 	for (i = 1; i <= MLX4_MAX_PORTS; i++) {
 		params->prof[i].rx_pause = 1;
 		params->prof[i].rx_ppp = pfcrx;
 		params->prof[i].tx_pause = 1;
 		params->prof[i].tx_ppp = pfctx;
 		params->prof[i].tx_ring_size = MLX4_EN_DEF_TX_RING_SIZE;
 		params->prof[i].rx_ring_size = MLX4_EN_DEF_RX_RING_SIZE;
 		params->prof[i].tx_ring_num = params->num_tx_rings_p_up *
 			MLX4_EN_NUM_UP;
 		params->prof[i].rss_rings = 0;
 		params->prof[i].inline_thold = inline_thold;
 	}

 	return 0;
 }

 static void *mlx4_en_get_netdev(struct mlx4_dev *dev, void *ctx, uint8_t port)
 {
 	struct mlx4_en_dev *endev = ctx;

 	return endev->pndev[port];
 }

 static void mlx4_en_event(struct mlx4_dev *dev, void *endev_ptr,
 			  enum mlx4_dev_event event, unsigned long port)
 {
 	struct mlx4_en_dev *mdev = (struct mlx4_en_dev *) endev_ptr;
 	struct mlx4_en_priv *priv;

 	switch (event) {
 	case MLX4_DEV_EVENT_PORT_UP:
 	case MLX4_DEV_EVENT_PORT_DOWN:
 		if (!mdev->pndev[port])
 			return;
 		priv = netdev_priv(mdev->pndev[port]);
 		/* To prevent races, we poll the link state in a separate
 		  task rather than changing it here */
 		priv->link_state = event;
 		queue_work(mdev->workqueue, &priv->linkstate_task);
 		break;

 	case MLX4_DEV_EVENT_CATASTROPHIC_ERROR:
 		mlx4_err(mdev, "Internal error detected, restarting device\n");
 		break;

 	case MLX4_DEV_EVENT_SLAVE_INIT:
 	case MLX4_DEV_EVENT_SLAVE_SHUTDOWN:
 		break;
 	default:
 		if (port < 1 || port > dev->caps.num_ports ||
 		    !mdev->pndev[port])
 			return;
 		mlx4_warn(mdev, "Unhandled event %d for port %d\n", event,
 			  (int) port);
 	}
 }

 static void mlx4_en_remove(struct mlx4_dev *dev, void *endev_ptr)
 {
 	panic("Disabled");
 #if 0 // AKAROS_PORT
 	struct mlx4_en_dev *mdev = endev_ptr;
 	int i;

 	qlock(&mdev->state_lock);
 	mdev->device_up = false;
 	qunlock(&mdev->state_lock);

 	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH)
 		if (mdev->pndev[i])
 			mlx4_en_destroy_netdev(mdev->pndev[i]);

 	if (mdev->dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_TS)
 		mlx4_en_remove_timestamp(mdev);

 	flush_workqueue(mdev->workqueue);
 	destroy_workqueue(mdev->workqueue);
 	(void) mlx4_mr_free(dev, &mdev->mr);
 	iounmap(mdev->uar_map);
 	mlx4_uar_free(dev, &mdev->priv_uar);
 	mlx4_pd_free(dev, mdev->priv_pdn);
 	if (mdev->nb.notifier_call)
 		unregister_netdevice_notifier(&mdev->nb);
 	kfree(mdev);
 #endif
 }

 static void *mlx4_en_add(struct mlx4_dev *dev)
 {
 	struct mlx4_en_dev *mdev;
 	int i;

 	printk_once(KERN_INFO "%s", mlx4_en_version);

 	mdev = kzmalloc(sizeof(*mdev), MEM_WAIT);
 	if (!mdev)
 		goto err_free_res;

 	if (mlx4_pd_alloc(dev, &mdev->priv_pdn))
 		goto err_free_dev;

 	if (mlx4_uar_alloc(dev, &mdev->priv_uar))
 		goto err_pd;

 	mdev->uar_map = ioremap((phys_addr_t) mdev->priv_uar.pfn << PAGE_SHIFT,
 				PAGE_SIZE);
 	if (!mdev->uar_map)
 		goto err_uar;
 	spinlock_init_irqsave(&mdev->uar_lock);

 	mdev->dev = dev;
 #if 0 // AKAROS_PORT
 	mdev->dma_device = &dev->persist->pdev->dev;
 #else
 	mdev->dma_device = 0;
 #endif
 	mdev->pdev = dev->persist->pdev;
 	mdev->device_up = false;

 	mdev->LSO_support = !!(dev->caps.flags & (1 << 15));
 	if (!mdev->LSO_support)
 		mlx4_warn(mdev, "LSO not supported, please upgrade to later FW version to enable LSO\n");

 	if (mlx4_mr_alloc(mdev->dev, mdev->priv_pdn, 0, ~0ull,
 			 MLX4_PERM_LOCAL_WRITE |  MLX4_PERM_LOCAL_READ,
 			 0, 0, &mdev->mr)) {
 		mlx4_err(mdev, "Failed allocating memory region\n");
 		goto err_map;
 	}
 	if (mlx4_mr_enable(mdev->dev, &mdev->mr)) {
 		mlx4_err(mdev, "Failed enabling memory region\n");
 		goto err_mr;
 	}

 	/* Build device profile according to supplied module parameters */
 	if (mlx4_en_get_profile(mdev)) {
 		mlx4_err(mdev, "Bad module parameters, aborting\n");
 		goto err_mr;
 	}

 	/* Configure which ports to start according to module parameters */
 	mdev->port_cnt = 0;
 	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH)
 		mdev->port_cnt++;

 #if 0 // AKAROS_PORT
 	/* Initialize time stamp mechanism */
 	if (mdev->dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_TS)
 		mlx4_en_init_timestamp(mdev);
 #endif

 	/* Set default number of RX rings*/
 	mlx4_en_set_num_rx_rings(mdev);

 	/* Create our own workqueue for reset/multicast tasks
 	 * Note: we cannot use the shared workqueue because of deadlocks caused
 	 *       by the rtnl lock */
 	mdev->workqueue = create_singlethread_workqueue("mlx4_en");
 	if (!mdev->workqueue)
 		goto err_mr;

 	/* At this stage all non-port specific tasks are complete:
 	 * mark the card state as up */
 	qlock_init(&mdev->state_lock);
 	mdev->device_up = true;

 	/* Setup ports */

 #if 0 // AKAROS_PORT
 	/* Create a netdev for each port */
 	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH) {
 		mlx4_info(mdev, "Activating port:%d\n", i);
 		if (mlx4_en_init_netdev(mdev, i, &mdev->profile.prof[i]))
 			mdev->pndev[i] = NULL;
 	}
 	/* register notifier */
 	mdev->nb.notifier_call = mlx4_en_netdev_event;
 	if (register_netdevice_notifier(&mdev->nb)) {
 		mdev->nb.notifier_call = NULL;
 		mlx4_err(mdev, "Failed to create notifier\n");
 	}
 #else
 	/* FIXME initialize all ports */
 	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH) {
 		if (i == 1) {
 			mlx4_en_init_netdev(mdev, i, dev->persist->edev,
 					    &mdev->profile.prof[i]);
 		} else {
 			mdev->pndev[i] = NULL;
 		}
 	}
 #endif

 	return mdev;

 err_mr:
 	(void) mlx4_mr_free(dev, &mdev->mr);
 err_map:
 	if (mdev->uar_map)
 		iounmap(mdev->uar_map);
 err_uar:
 	mlx4_uar_free(dev, &mdev->priv_uar);
 err_pd:
 	mlx4_pd_free(dev, mdev->priv_pdn);
 err_free_dev:
 	kfree(mdev);
 err_free_res:
 	return NULL;
 }

 static struct mlx4_interface mlx4_en_interface = {
 	.add		= mlx4_en_add,
 	.remove		= mlx4_en_remove,
 	.event		= mlx4_en_event,
 	.get_dev	= mlx4_en_get_netdev,
 	.protocol	= MLX4_PROT_ETH,
 };

 static void mlx4_en_verify_params(void)
 {
 	if (pfctx > MAX_PFC_TX) {
 		pr_warn("mlx4_en: WARNING: illegal module parameter pfctx 0x%x - should be in range 0-0x%x, will be changed to default (0)\n",
 			pfctx, MAX_PFC_TX);
 		pfctx = 0;
 	}

 	if (pfcrx > MAX_PFC_RX) {
 		pr_warn("mlx4_en: WARNING: illegal module parameter pfcrx 0x%x - should be in range 0-0x%x, will be changed to default (0)\n",
 			pfcrx, MAX_PFC_RX);
 		pfcrx = 0;
 	}

 	if (inline_thold < MIN_PKT_LEN || inline_thold > MAX_INLINE) {
 		pr_warn("mlx4_en: WARNING: illegal module parameter inline_thold %d - should be in range %d-%d, will be changed to default (%d)\n",
 			inline_thold, MIN_PKT_LEN, MAX_INLINE, MAX_INLINE);
 		inline_thold = MAX_INLINE;
 	}
 }

 int mlx4_en_init(void)
 {
 	mlx4_en_verify_params();

 	return mlx4_register_interface(&mlx4_en_interface);
 }

 #if 0 // AKAROS_PORT
 static void __exit mlx4_en_cleanup(void)
 {
 	mlx4_unregister_interface(&mlx4_en_interface);
 }

 module_init(mlx4_en_init);
 module_exit(mlx4_en_cleanup);
 #endif
	/*
	* Copyright (c) 2007 Mellanox Technologies. All rights reserved.
	*
	* This software is available to you under a choice of one of two
	* licenses. You may choose to be licensed under the terms of the GNU
	* General Public License (GPL) Version 2, available from the file
	* COPYING in the main directory of this source tree, or the
	* OpenIB.org BSD license below:
	*
	* 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
	* copyright notice, this list of conditions and the following
	* disclaimer in the documentation and/or other materials
	* provided with the distribution.
	*
	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
	* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
	* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
	* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	* SOFTWARE.
	*
	*/

	#include <linux_compat.h>
	#include <linux/mlx4/driver.h>
	#include <linux/mlx4/device.h>
	#include <linux/mlx4/cmd.h>

	#include "mlx4_en.h"

	MODULE_AUTHOR("Liran Liss, Yevgeny Petrilin");
	MODULE_DESCRIPTION("Mellanox ConnectX HCA Ethernet driver");
	MODULE_LICENSE("Dual BSD/GPL");
	MODULE_VERSION(DRV_VERSION " ("DRV_RELDATE")");

	static const char mlx4_en_version[] =
	DRV_NAME ": Mellanox ConnectX HCA Ethernet driver v"
	DRV_VERSION " (" DRV_RELDATE ")\n";

	#define MLX4_EN_PARM_INT(X, def_val, desc) \
	static unsigned int X = def_val;\
	module_param(X , uint, 0444); \
	MODULE_PARM_DESC(X, desc);


	/*
	* Device scope module parameters
	*/

	/* Enable RSS UDP traffic */
	MLX4_EN_PARM_INT(udp_rss, 1,
	"Enable RSS for incoming UDP traffic or disabled (0)");

	/* Priority pausing */
	MLX4_EN_PARM_INT(pfctx, 0, "Priority based Flow Control policy on TX[7:0]."
	" Per priority bit mask");
	MLX4_EN_PARM_INT(pfcrx, 0, "Priority based Flow Control policy on RX[7:0]."
	" Per priority bit mask");

	MLX4_EN_PARM_INT(inline_thold, MAX_INLINE,
	"Threshold for using inline data (range: 17-104, default: 104)");

	#define MAX_PFC_TX 0xff
	#define MAX_PFC_RX 0xff

	void en_print(const char level, const struct mlx4_en_priv priv,
	const char *format, ...)
	{
	#if 0 // AKAROS_PORT
	va_list args;
	struct va_format vaf;

	va_start(args, format);

	vaf.fmt = format;
	vaf.va = &args;
	if (priv->registered)
	printk("%s%s: %s: %pV",
	level, DRV_NAME, priv->dev->name, &vaf);
	else
	printk("%s%s: %s: Port %d: %pV",
	level, DRV_NAME, dev_name(&priv->mdev->pdev->dev),
	priv->port, &vaf);
	va_end(args);
	#else
	va_list args;

	va_start(args, format);
	if (priv->registered)
	printk("%s%s: %s: ", level, DRV_NAME, priv->dev->name);
	else
	printk("%s%s: %s: Port %d: ", level, DRV_NAME,
	dev_name(&priv->mdev->pdev->dev), priv->port);
	vcprintf(format, args);
	va_end(args);
	#endif
	}

	void mlx4_en_update_loopback_state(struct ether *dev,
	netdev_features_t features)
	{
	struct mlx4_en_priv *priv = netdev_priv(dev);

	if (features & NETIF_F_LOOPBACK)
	priv->ctrl_flags \|= cpu_to_be32(MLX4_WQE_CTRL_FORCE_LOOPBACK);
	else
	priv->ctrl_flags &= cpu_to_be32(~MLX4_WQE_CTRL_FORCE_LOOPBACK);

	priv->flags &= ~(MLX4_EN_FLAG_RX_FILTER_NEEDED\|
	MLX4_EN_FLAG_ENABLE_HW_LOOPBACK);

	/* Drop the packet if SRIOV is not enabled
	* and not performing the selftest or flb disabled
	*/
	if (mlx4_is_mfunc(priv->mdev->dev) &&
	!(features & NETIF_F_LOOPBACK) && !priv->validate_loopback)
	priv->flags \|= MLX4_EN_FLAG_RX_FILTER_NEEDED;

	/* Set dmac in Tx WQE if we are in SRIOV mode or if loopback selftest
	* is requested
	*/
	if (mlx4_is_mfunc(priv->mdev->dev) \|\| priv->validate_loopback)
	priv->flags \|= MLX4_EN_FLAG_ENABLE_HW_LOOPBACK;
	}

	static int mlx4_en_get_profile(struct mlx4_en_dev *mdev)
	{
	struct mlx4_en_profile *params = &mdev->profile;
	int i;

	params->udp_rss = udp_rss;
	params->num_tx_rings_p_up = mlx4_low_memory_profile() ?
	MLX4_EN_MIN_TX_RING_P_UP :
	MIN_T(int, num_online_cpus(), MLX4_EN_MAX_TX_RING_P_UP);

	if (params->udp_rss && !(mdev->dev->caps.flags
	& MLX4_DEV_CAP_FLAG_UDP_RSS)) {
	mlx4_warn(mdev, "UDP RSS is not supported on this device\n");
	params->udp_rss = 0;
	}
	for (i = 1; i <= MLX4_MAX_PORTS; i++) {
	params->prof[i].rx_pause = 1;
	params->prof[i].rx_ppp = pfcrx;
	params->prof[i].tx_pause = 1;
	params->prof[i].tx_ppp = pfctx;
	params->prof[i].tx_ring_size = MLX4_EN_DEF_TX_RING_SIZE;
	params->prof[i].rx_ring_size = MLX4_EN_DEF_RX_RING_SIZE;
	params->prof[i].tx_ring_num = params->num_tx_rings_p_up *
	MLX4_EN_NUM_UP;
	params->prof[i].rss_rings = 0;
	params->prof[i].inline_thold = inline_thold;
	}

	return 0;
	}

	static void mlx4_en_get_netdev(struct mlx4_dev dev, void *ctx, uint8_t port)
	{
	struct mlx4_en_dev *endev = ctx;

	return endev->pndev[port];
	}

	static void mlx4_en_event(struct mlx4_dev dev, void endev_ptr,
	enum mlx4_dev_event event, unsigned long port)
	{
	struct mlx4_en_dev mdev = (struct mlx4_en_dev ) endev_ptr;
	struct mlx4_en_priv *priv;

	switch (event) {
	case MLX4_DEV_EVENT_PORT_UP:
	case MLX4_DEV_EVENT_PORT_DOWN:
	if (!mdev->pndev[port])
	return;
	priv = netdev_priv(mdev->pndev[port]);
	/* To prevent races, we poll the link state in a separate
	task rather than changing it here */
	priv->link_state = event;
	queue_work(mdev->workqueue, &priv->linkstate_task);
	break;

	case MLX4_DEV_EVENT_CATASTROPHIC_ERROR:
	mlx4_err(mdev, "Internal error detected, restarting device\n");
	break;

	case MLX4_DEV_EVENT_SLAVE_INIT:
	case MLX4_DEV_EVENT_SLAVE_SHUTDOWN:
	break;
	default:
	if (port < 1 \|\| port > dev->caps.num_ports \|\|
	!mdev->pndev[port])
	return;
	mlx4_warn(mdev, "Unhandled event %d for port %d\n", event,
	(int) port);
	}
	}

	static void mlx4_en_remove(struct mlx4_dev dev, void endev_ptr)
	{
	panic("Disabled");
	#if 0 // AKAROS_PORT
	struct mlx4_en_dev *mdev = endev_ptr;
	int i;

	qlock(&mdev->state_lock);
	mdev->device_up = false;
	qunlock(&mdev->state_lock);

	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH)
	if (mdev->pndev[i])
	mlx4_en_destroy_netdev(mdev->pndev[i]);

	if (mdev->dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_TS)
	mlx4_en_remove_timestamp(mdev);

	flush_workqueue(mdev->workqueue);
	destroy_workqueue(mdev->workqueue);
	(void) mlx4_mr_free(dev, &mdev->mr);
	iounmap(mdev->uar_map);
	mlx4_uar_free(dev, &mdev->priv_uar);
	mlx4_pd_free(dev, mdev->priv_pdn);
	if (mdev->nb.notifier_call)
	unregister_netdevice_notifier(&mdev->nb);
	kfree(mdev);
	#endif
	}

	static void mlx4_en_add(struct mlx4_dev dev)
	{
	struct mlx4_en_dev *mdev;
	int i;

	printk_once(KERN_INFO "%s", mlx4_en_version);

	mdev = kzmalloc(sizeof(*mdev), MEM_WAIT);
	if (!mdev)
	goto err_free_res;

	if (mlx4_pd_alloc(dev, &mdev->priv_pdn))
	goto err_free_dev;

	if (mlx4_uar_alloc(dev, &mdev->priv_uar))
	goto err_pd;

	mdev->uar_map = ioremap((phys_addr_t) mdev->priv_uar.pfn << PAGE_SHIFT,
	PAGE_SIZE);
	if (!mdev->uar_map)
	goto err_uar;
	spinlock_init_irqsave(&mdev->uar_lock);

	mdev->dev = dev;
	#if 0 // AKAROS_PORT
	mdev->dma_device = &dev->persist->pdev->dev;
	#else
	mdev->dma_device = 0;
	#endif
	mdev->pdev = dev->persist->pdev;
	mdev->device_up = false;

	mdev->LSO_support = !!(dev->caps.flags & (1 << 15));
	if (!mdev->LSO_support)
	mlx4_warn(mdev, "LSO not supported, please upgrade to later FW version to enable LSO\n");

	if (mlx4_mr_alloc(mdev->dev, mdev->priv_pdn, 0, ~0ull,
	MLX4_PERM_LOCAL_WRITE \| MLX4_PERM_LOCAL_READ,
	0, 0, &mdev->mr)) {
	mlx4_err(mdev, "Failed allocating memory region\n");
	goto err_map;
	}
	if (mlx4_mr_enable(mdev->dev, &mdev->mr)) {
	mlx4_err(mdev, "Failed enabling memory region\n");
	goto err_mr;
	}

	/* Build device profile according to supplied module parameters */
	if (mlx4_en_get_profile(mdev)) {
	mlx4_err(mdev, "Bad module parameters, aborting\n");
	goto err_mr;
	}

	/* Configure which ports to start according to module parameters */
	mdev->port_cnt = 0;
	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH)
	mdev->port_cnt++;

	#if 0 // AKAROS_PORT
	/* Initialize time stamp mechanism */
	if (mdev->dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_TS)
	mlx4_en_init_timestamp(mdev);
	#endif

	/* Set default number of RX rings*/
	mlx4_en_set_num_rx_rings(mdev);

	/* Create our own workqueue for reset/multicast tasks
	* Note: we cannot use the shared workqueue because of deadlocks caused
	* by the rtnl lock */
	mdev->workqueue = create_singlethread_workqueue("mlx4_en");
	if (!mdev->workqueue)
	goto err_mr;

	/* At this stage all non-port specific tasks are complete:
	* mark the card state as up */
	qlock_init(&mdev->state_lock);
	mdev->device_up = true;

	/* Setup ports */

	#if 0 // AKAROS_PORT
	/* Create a netdev for each port */
	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH) {
	mlx4_info(mdev, "Activating port:%d\n", i);
	if (mlx4_en_init_netdev(mdev, i, &mdev->profile.prof[i]))
	mdev->pndev[i] = NULL;
	}
	/* register notifier */
	mdev->nb.notifier_call = mlx4_en_netdev_event;
	if (register_netdevice_notifier(&mdev->nb)) {
	mdev->nb.notifier_call = NULL;
	mlx4_err(mdev, "Failed to create notifier\n");
	}
	#else
	/* FIXME initialize all ports */
	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH) {
	if (i == 1) {
	mlx4_en_init_netdev(mdev, i, dev->persist->edev,
	&mdev->profile.prof[i]);
	} else {
	mdev->pndev[i] = NULL;
	}
	}
	#endif

	return mdev;

	err_mr:
	(void) mlx4_mr_free(dev, &mdev->mr);
	err_map:
	if (mdev->uar_map)
	iounmap(mdev->uar_map);
	err_uar:
	mlx4_uar_free(dev, &mdev->priv_uar);
	err_pd:
	mlx4_pd_free(dev, mdev->priv_pdn);
	err_free_dev:
	kfree(mdev);
	err_free_res:
	return NULL;
	}

	static struct mlx4_interface mlx4_en_interface = {
	.add = mlx4_en_add,
	.remove = mlx4_en_remove,
	.event = mlx4_en_event,
	.get_dev = mlx4_en_get_netdev,
	.protocol = MLX4_PROT_ETH,
	};

	static void mlx4_en_verify_params(void)
	{
	if (pfctx > MAX_PFC_TX) {
	pr_warn("mlx4_en: WARNING: illegal module parameter pfctx 0x%x - should be in range 0-0x%x, will be changed to default (0)\n",
	pfctx, MAX_PFC_TX);
	pfctx = 0;
	}

	if (pfcrx > MAX_PFC_RX) {
	pr_warn("mlx4_en: WARNING: illegal module parameter pfcrx 0x%x - should be in range 0-0x%x, will be changed to default (0)\n",
	pfcrx, MAX_PFC_RX);
	pfcrx = 0;
	}

	if (inline_thold < MIN_PKT_LEN \|\| inline_thold > MAX_INLINE) {
	pr_warn("mlx4_en: WARNING: illegal module parameter inline_thold %d - should be in range %d-%d, will be changed to default (%d)\n",
	inline_thold, MIN_PKT_LEN, MAX_INLINE, MAX_INLINE);
	inline_thold = MAX_INLINE;
	}
	}

	int mlx4_en_init(void)
	{
	mlx4_en_verify_params();

	return mlx4_register_interface(&mlx4_en_interface);
	}

	#if 0 // AKAROS_PORT
	static void __exit mlx4_en_cleanup(void)
	{
	mlx4_unregister_interface(&mlx4_en_interface);
	}

	module_init(mlx4_en_init);
	module_exit(mlx4_en_cleanup);
	#endif