drivers/net/ethernet/amd/xgbe/xgbe-pci.c - LeafOS-Devices/android_kernel_samsung_gta4xl - Gitiles

 /*
  * AMD 10Gb Ethernet driver
  *
  * This file is available to you under your choice of the following two
  * licenses:
  *
  * License 1: GPLv2
  *
  * Copyright (c) 2016 Advanced Micro Devices, Inc.
  *
  * This file is free software; you may copy, redistribute and/or modify
  * it under the terms of the GNU General Public License as published by
  * the Free Software Foundation, either version 2 of the License, or (at
  * your option) any later version.
  *
  * This file is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  * General Public License for more details.
  *
  * You should have received a copy of the GNU General Public License
  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  *
  * This file incorporates work covered by the following copyright and
  * permission notice:
  *     The Synopsys DWC ETHER XGMAC Software Driver and documentation
  *     (hereinafter "Software") is an unsupported proprietary work of Synopsys,
  *     Inc. unless otherwise expressly agreed to in writing between Synopsys
  *     and you.
  *
  *     The Software IS NOT an item of Licensed Software or Licensed Product
  *     under any End User Software License Agreement or Agreement for Licensed
  *     Product with Synopsys or any supplement thereto.  Permission is hereby
  *     granted, free of charge, to any person obtaining a copy of this software
  *     annotated with this license and the Software, to deal in the Software
  *     without restriction, including without limitation the rights to use,
  *     copy, modify, merge, publish, distribute, sublicense, and/or sell copies
  *     of the Software, and to permit persons to whom the Software is furnished
  *     to do so, subject to the following conditions:
  *
  *     The above copyright notice and this permission notice shall be included
  *     in all copies or substantial portions of the Software.
  *
  *     THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS"
  *     BASIS AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  *     TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
  *     PARTICULAR PURPOSE ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS
  *     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.
  *
  *
  * License 2: Modified BSD
  *
  * Copyright (c) 2016 Advanced Micro Devices, Inc.
  * 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 copyright
  *       notice, this list of conditions and the following disclaimer in the
  *       documentation and/or other materials provided with the distribution.
  *     * Neither the name of Advanced Micro Devices, Inc. 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 <COPYRIGHT HOLDER> 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.
  *
  * This file incorporates work covered by the following copyright and
  * permission notice:
  *     The Synopsys DWC ETHER XGMAC Software Driver and documentation
  *     (hereinafter "Software") is an unsupported proprietary work of Synopsys,
  *     Inc. unless otherwise expressly agreed to in writing between Synopsys
  *     and you.
  *
  *     The Software IS NOT an item of Licensed Software or Licensed Product
  *     under any End User Software License Agreement or Agreement for Licensed
  *     Product with Synopsys or any supplement thereto.  Permission is hereby
  *     granted, free of charge, to any person obtaining a copy of this software
  *     annotated with this license and the Software, to deal in the Software
  *     without restriction, including without limitation the rights to use,
  *     copy, modify, merge, publish, distribute, sublicense, and/or sell copies
  *     of the Software, and to permit persons to whom the Software is furnished
  *     to do so, subject to the following conditions:
  *
  *     The above copyright notice and this permission notice shall be included
  *     in all copies or substantial portions of the Software.
  *
  *     THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS"
  *     BASIS AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  *     TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
  *     PARTICULAR PURPOSE ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS
  *     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.
  */

 #include <linux/module.h>
 #include <linux/device.h>
 #include <linux/pci.h>
 #include <linux/log2.h>

 #include "xgbe.h"
 #include "xgbe-common.h"

 static int xgbe_config_msi(struct xgbe_prv_data *pdata)
 {
 	unsigned int msi_count;
 	unsigned int i, j;
 	int ret;

 	msi_count = XGBE_MSIX_BASE_COUNT;
 	msi_count += max(pdata->rx_ring_count,
 			 pdata->tx_ring_count);
 	msi_count = roundup_pow_of_two(msi_count);

 	ret = pci_enable_msi_exact(pdata->pcidev, msi_count);
 	if (ret < 0) {
 		dev_info(pdata->dev, "MSI request for %u interrupts failed\n",
 			 msi_count);

 		ret = pci_enable_msi(pdata->pcidev);
 		if (ret < 0) {
 			dev_info(pdata->dev, "MSI enablement failed\n");
 			return ret;
 		}

 		msi_count = 1;
 	}

 	pdata->irq_count = msi_count;

 	pdata->dev_irq = pdata->pcidev->irq;

 	if (msi_count > 1) {
 		pdata->ecc_irq = pdata->pcidev->irq + 1;
 		pdata->i2c_irq = pdata->pcidev->irq + 2;
 		pdata->an_irq = pdata->pcidev->irq + 3;

 		for (i = XGBE_MSIX_BASE_COUNT, j = 0;
 		     (i < msi_count) && (j < XGBE_MAX_DMA_CHANNELS);
 		     i++, j++)
 			pdata->channel_irq[j] = pdata->pcidev->irq + i;
 		pdata->channel_irq_count = j;

 		pdata->per_channel_irq = 1;
 		pdata->channel_irq_mode = XGBE_IRQ_MODE_LEVEL;
 	} else {
 		pdata->ecc_irq = pdata->pcidev->irq;
 		pdata->i2c_irq = pdata->pcidev->irq;
 		pdata->an_irq = pdata->pcidev->irq;
 	}

 	if (netif_msg_probe(pdata))
 		dev_dbg(pdata->dev, "MSI interrupts enabled\n");

 	return 0;
 }

 static int xgbe_config_msix(struct xgbe_prv_data *pdata)
 {
 	unsigned int msix_count;
 	unsigned int i, j;
 	int ret;

 	msix_count = XGBE_MSIX_BASE_COUNT;
 	msix_count += max(pdata->rx_ring_count,
 			  pdata->tx_ring_count);

 	pdata->msix_entries = devm_kcalloc(pdata->dev, msix_count,
 					   sizeof(struct msix_entry),
 					   GFP_KERNEL);
 	if (!pdata->msix_entries)
 		return -ENOMEM;

 	for (i = 0; i < msix_count; i++)
 		pdata->msix_entries[i].entry = i;

 	ret = pci_enable_msix_range(pdata->pcidev, pdata->msix_entries,
 				    XGBE_MSIX_MIN_COUNT, msix_count);
 	if (ret < 0) {
 		dev_info(pdata->dev, "MSI-X enablement failed\n");
 		devm_kfree(pdata->dev, pdata->msix_entries);
 		pdata->msix_entries = NULL;
 		return ret;
 	}

 	pdata->irq_count = ret;

 	pdata->dev_irq = pdata->msix_entries[0].vector;
 	pdata->ecc_irq = pdata->msix_entries[1].vector;
 	pdata->i2c_irq = pdata->msix_entries[2].vector;
 	pdata->an_irq = pdata->msix_entries[3].vector;

 	for (i = XGBE_MSIX_BASE_COUNT, j = 0; i < ret; i++, j++)
 		pdata->channel_irq[j] = pdata->msix_entries[i].vector;
 	pdata->channel_irq_count = j;

 	pdata->per_channel_irq = 1;
 	pdata->channel_irq_mode = XGBE_IRQ_MODE_LEVEL;

 	if (netif_msg_probe(pdata))
 		dev_dbg(pdata->dev, "MSI-X interrupts enabled\n");

 	return 0;
 }

 static int xgbe_config_irqs(struct xgbe_prv_data *pdata)
 {
 	int ret;

 	ret = xgbe_config_msix(pdata);
 	if (!ret)
 		goto out;

 	ret = xgbe_config_msi(pdata);
 	if (!ret)
 		goto out;

 	pdata->irq_count = 1;
 	pdata->irq_shared = 1;

 	pdata->dev_irq = pdata->pcidev->irq;
 	pdata->ecc_irq = pdata->pcidev->irq;
 	pdata->i2c_irq = pdata->pcidev->irq;
 	pdata->an_irq = pdata->pcidev->irq;

 out:
 	if (netif_msg_probe(pdata)) {
 		unsigned int i;

 		dev_dbg(pdata->dev, " dev irq=%d\n", pdata->dev_irq);
 		dev_dbg(pdata->dev, " ecc irq=%d\n", pdata->ecc_irq);
 		dev_dbg(pdata->dev, " i2c irq=%d\n", pdata->i2c_irq);
 		dev_dbg(pdata->dev, "  an irq=%d\n", pdata->an_irq);
 		for (i = 0; i < pdata->channel_irq_count; i++)
 			dev_dbg(pdata->dev, " dma%u irq=%d\n",
 				i, pdata->channel_irq[i]);
 	}

 	return 0;
 }

 static int xgbe_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
 {
 	struct xgbe_prv_data *pdata;
 	struct device *dev = &pdev->dev;
 	void __iomem * const *iomap_table;
 	unsigned int ma_lo, ma_hi;
 	unsigned int reg;
 	int bar_mask;
 	int ret;

 	pdata = xgbe_alloc_pdata(dev);
 	if (IS_ERR(pdata)) {
 		ret = PTR_ERR(pdata);
 		goto err_alloc;
 	}

 	pdata->pcidev = pdev;
 	pci_set_drvdata(pdev, pdata);

 	/* Get the version data */
 	pdata->vdata = (struct xgbe_version_data *)id->driver_data;

 	ret = pcim_enable_device(pdev);
 	if (ret) {
 		dev_err(dev, "pcim_enable_device failed\n");
 		goto err_pci_enable;
 	}

 	/* Obtain the mmio areas for the device */
 	bar_mask = pci_select_bars(pdev, IORESOURCE_MEM);
 	ret = pcim_iomap_regions(pdev, bar_mask, XGBE_DRV_NAME);
 	if (ret) {
 		dev_err(dev, "pcim_iomap_regions failed\n");
 		goto err_pci_enable;
 	}

 	iomap_table = pcim_iomap_table(pdev);
 	if (!iomap_table) {
 		dev_err(dev, "pcim_iomap_table failed\n");
 		ret = -ENOMEM;
 		goto err_pci_enable;
 	}

 	pdata->xgmac_regs = iomap_table[XGBE_XGMAC_BAR];
 	if (!pdata->xgmac_regs) {
 		dev_err(dev, "xgmac ioremap failed\n");
 		ret = -ENOMEM;
 		goto err_pci_enable;
 	}
 	pdata->xprop_regs = pdata->xgmac_regs + XGBE_MAC_PROP_OFFSET;
 	pdata->xi2c_regs = pdata->xgmac_regs + XGBE_I2C_CTRL_OFFSET;
 	if (netif_msg_probe(pdata)) {
 		dev_dbg(dev, "xgmac_regs = %p\n", pdata->xgmac_regs);
 		dev_dbg(dev, "xprop_regs = %p\n", pdata->xprop_regs);
 		dev_dbg(dev, "xi2c_regs  = %p\n", pdata->xi2c_regs);
 	}

 	pdata->xpcs_regs = iomap_table[XGBE_XPCS_BAR];
 	if (!pdata->xpcs_regs) {
 		dev_err(dev, "xpcs ioremap failed\n");
 		ret = -ENOMEM;
 		goto err_pci_enable;
 	}
 	if (netif_msg_probe(pdata))
 		dev_dbg(dev, "xpcs_regs  = %p\n", pdata->xpcs_regs);

 	/* Configure the PCS indirect addressing support */
 	reg = XPCS32_IOREAD(pdata, PCS_V2_WINDOW_DEF);
 	pdata->xpcs_window = XPCS_GET_BITS(reg, PCS_V2_WINDOW_DEF, OFFSET);
 	pdata->xpcs_window <<= 6;
 	pdata->xpcs_window_size = XPCS_GET_BITS(reg, PCS_V2_WINDOW_DEF, SIZE);
 	pdata->xpcs_window_size = 1 << (pdata->xpcs_window_size + 7);
 	pdata->xpcs_window_mask = pdata->xpcs_window_size - 1;
 	if (netif_msg_probe(pdata)) {
 		dev_dbg(dev, "xpcs window      = %#010x\n",
 			pdata->xpcs_window);
 		dev_dbg(dev, "xpcs window size = %#010x\n",
 			pdata->xpcs_window_size);
 		dev_dbg(dev, "xpcs window mask = %#010x\n",
 			pdata->xpcs_window_mask);
 	}

 	pci_set_master(pdev);

 	/* Enable all interrupts in the hardware */
 	XP_IOWRITE(pdata, XP_INT_EN, 0x1fffff);

 	/* Retrieve the MAC address */
 	ma_lo = XP_IOREAD(pdata, XP_MAC_ADDR_LO);
 	ma_hi = XP_IOREAD(pdata, XP_MAC_ADDR_HI);
 	pdata->mac_addr[0] = ma_lo & 0xff;
 	pdata->mac_addr[1] = (ma_lo >> 8) & 0xff;
 	pdata->mac_addr[2] = (ma_lo >> 16) & 0xff;
 	pdata->mac_addr[3] = (ma_lo >> 24) & 0xff;
 	pdata->mac_addr[4] = ma_hi & 0xff;
 	pdata->mac_addr[5] = (ma_hi >> 8) & 0xff;
 	if (!XP_GET_BITS(ma_hi, XP_MAC_ADDR_HI, VALID) ||
 	    !is_valid_ether_addr(pdata->mac_addr)) {
 		dev_err(dev, "invalid mac address\n");
 		ret = -EINVAL;
 		goto err_pci_enable;
 	}

 	/* Clock settings */
 	pdata->sysclk_rate = XGBE_V2_DMA_CLOCK_FREQ;
 	pdata->ptpclk_rate = XGBE_V2_PTP_CLOCK_FREQ;

 	/* Set the DMA coherency values */
 	pdata->coherent = 1;
 	pdata->axdomain = XGBE_DMA_OS_AXDOMAIN;
 	pdata->arcache = XGBE_DMA_OS_ARCACHE;
 	pdata->awcache = XGBE_DMA_OS_AWCACHE;

 	/* Set the maximum channels and queues */
 	reg = XP_IOREAD(pdata, XP_PROP_1);
 	pdata->tx_max_channel_count = XP_GET_BITS(reg, XP_PROP_1, MAX_TX_DMA);
 	pdata->rx_max_channel_count = XP_GET_BITS(reg, XP_PROP_1, MAX_RX_DMA);
 	pdata->tx_max_q_count = XP_GET_BITS(reg, XP_PROP_1, MAX_TX_QUEUES);
 	pdata->rx_max_q_count = XP_GET_BITS(reg, XP_PROP_1, MAX_RX_QUEUES);
 	if (netif_msg_probe(pdata)) {
 		dev_dbg(dev, "max tx/rx channel count = %u/%u\n",
 			pdata->tx_max_channel_count,
 			pdata->tx_max_channel_count);
 		dev_dbg(dev, "max tx/rx hw queue count = %u/%u\n",
 			pdata->tx_max_q_count, pdata->rx_max_q_count);
 	}

 	/* Set the hardware channel and queue counts */
 	xgbe_set_counts(pdata);

 	/* Set the maximum fifo amounts */
 	reg = XP_IOREAD(pdata, XP_PROP_2);
 	pdata->tx_max_fifo_size = XP_GET_BITS(reg, XP_PROP_2, TX_FIFO_SIZE);
 	pdata->tx_max_fifo_size *= 16384;
 	pdata->tx_max_fifo_size = min(pdata->tx_max_fifo_size,
 				      pdata->vdata->tx_max_fifo_size);
 	pdata->rx_max_fifo_size = XP_GET_BITS(reg, XP_PROP_2, RX_FIFO_SIZE);
 	pdata->rx_max_fifo_size *= 16384;
 	pdata->rx_max_fifo_size = min(pdata->rx_max_fifo_size,
 				      pdata->vdata->rx_max_fifo_size);
 	if (netif_msg_probe(pdata))
 		dev_dbg(dev, "max tx/rx max fifo size = %u/%u\n",
 			pdata->tx_max_fifo_size, pdata->rx_max_fifo_size);

 	/* Configure interrupt support */
 	ret = xgbe_config_irqs(pdata);
 	if (ret)
 		goto err_pci_enable;

 	/* Configure the netdev resource */
 	ret = xgbe_config_netdev(pdata);
 	if (ret)
 		goto err_pci_enable;

 	netdev_notice(pdata->netdev, "net device enabled\n");

 	return 0;

 err_pci_enable:
 	xgbe_free_pdata(pdata);

 err_alloc:
 	dev_notice(dev, "net device not enabled\n");

 	return ret;
 }

 static void xgbe_pci_remove(struct pci_dev *pdev)
 {
 	struct xgbe_prv_data *pdata = pci_get_drvdata(pdev);

 	xgbe_deconfig_netdev(pdata);

 	xgbe_free_pdata(pdata);
 }

 #ifdef CONFIG_PM
 static int xgbe_pci_suspend(struct pci_dev *pdev, pm_message_t state)
 {
 	struct xgbe_prv_data *pdata = pci_get_drvdata(pdev);
 	struct net_device *netdev = pdata->netdev;
 	int ret = 0;

 	if (netif_running(netdev))
 		ret = xgbe_powerdown(netdev, XGMAC_DRIVER_CONTEXT);

 	pdata->lpm_ctrl = XMDIO_READ(pdata, MDIO_MMD_PCS, MDIO_CTRL1);
 	pdata->lpm_ctrl |= MDIO_CTRL1_LPOWER;
 	XMDIO_WRITE(pdata, MDIO_MMD_PCS, MDIO_CTRL1, pdata->lpm_ctrl);

 	return ret;
 }

 static int xgbe_pci_resume(struct pci_dev *pdev)
 {
 	struct xgbe_prv_data *pdata = pci_get_drvdata(pdev);
 	struct net_device *netdev = pdata->netdev;
 	int ret = 0;

 	pdata->lpm_ctrl &= ~MDIO_CTRL1_LPOWER;
 	XMDIO_WRITE(pdata, MDIO_MMD_PCS, MDIO_CTRL1, pdata->lpm_ctrl);

 	if (netif_running(netdev)) {
 		ret = xgbe_powerup(netdev, XGMAC_DRIVER_CONTEXT);

 		/* Schedule a restart in case the link or phy state changed
 		 * while we were powered down.
 		 */
 		schedule_work(&pdata->restart_work);
 	}

 	return ret;
 }
 #endif /* CONFIG_PM */

 static const struct xgbe_version_data xgbe_v2a = {
 	.init_function_ptrs_phy_impl	= xgbe_init_function_ptrs_phy_v2,
 	.xpcs_access			= XGBE_XPCS_ACCESS_V2,
 	.mmc_64bit			= 1,
 	.tx_max_fifo_size		= 229376,
 	.rx_max_fifo_size		= 229376,
 	.tx_tstamp_workaround		= 1,
 	.ecc_support			= 1,
 	.i2c_support			= 1,
 };

 static const struct xgbe_version_data xgbe_v2b = {
 	.init_function_ptrs_phy_impl	= xgbe_init_function_ptrs_phy_v2,
 	.xpcs_access			= XGBE_XPCS_ACCESS_V2,
 	.mmc_64bit			= 1,
 	.tx_max_fifo_size		= 65536,
 	.rx_max_fifo_size		= 65536,
 	.tx_tstamp_workaround		= 1,
 	.ecc_support			= 1,
 	.i2c_support			= 1,
 };

 static const struct pci_device_id xgbe_pci_table[] = {
 	{ PCI_VDEVICE(AMD, 0x1458),
 	  .driver_data = (kernel_ulong_t)&xgbe_v2a },
 	{ PCI_VDEVICE(AMD, 0x1459),
 	  .driver_data = (kernel_ulong_t)&xgbe_v2b },
 	/* Last entry must be zero */
 	{ 0, }
 };
 MODULE_DEVICE_TABLE(pci, xgbe_pci_table);

 static struct pci_driver xgbe_driver = {
 	.name = XGBE_DRV_NAME,
 	.id_table = xgbe_pci_table,
 	.probe = xgbe_pci_probe,
 	.remove = xgbe_pci_remove,
 #ifdef CONFIG_PM
 	.suspend = xgbe_pci_suspend,
 	.resume = xgbe_pci_resume,
 #endif
 };

 int xgbe_pci_init(void)
 {
 	return pci_register_driver(&xgbe_driver);
 }

 void xgbe_pci_exit(void)
 {
 	pci_unregister_driver(&xgbe_driver);
 }
	/*
	* AMD 10Gb Ethernet driver
	*
	* This file is available to you under your choice of the following two
	* licenses:
	*
	* License 1: GPLv2
	*
	* Copyright (c) 2016 Advanced Micro Devices, Inc.
	*
	* This file is free software; you may copy, redistribute and/or modify
	* it under the terms of the GNU General Public License as published by
	* the Free Software Foundation, either version 2 of the License, or (at
	* your option) any later version.
	*
	* This file is distributed in the hope that it will be useful, but
	* WITHOUT ANY WARRANTY; without even the implied warranty of
	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	* General Public License for more details.
	*
	* You should have received a copy of the GNU General Public License
	* along with this program. If not, see <http://www.gnu.org/licenses/>.
	*
	* This file incorporates work covered by the following copyright and
	* permission notice:
	* The Synopsys DWC ETHER XGMAC Software Driver and documentation
	* (hereinafter "Software") is an unsupported proprietary work of Synopsys,
	* Inc. unless otherwise expressly agreed to in writing between Synopsys
	* and you.
	*
	* The Software IS NOT an item of Licensed Software or Licensed Product
	* under any End User Software License Agreement or Agreement for Licensed
	* Product with Synopsys or any supplement thereto. Permission is hereby
	* granted, free of charge, to any person obtaining a copy of this software
	* annotated with this license and the Software, to deal in the Software
	* without restriction, including without limitation the rights to use,
	* copy, modify, merge, publish, distribute, sublicense, and/or sell copies
	* of the Software, and to permit persons to whom the Software is furnished
	* to do so, subject to the following conditions:
	*
	* The above copyright notice and this permission notice shall be included
	* in all copies or substantial portions of the Software.
	*
	* THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS"
	* BASIS AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
	* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
	* PARTICULAR PURPOSE ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS
	* 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.
	*
	*
	* License 2: Modified BSD
	*
	* Copyright (c) 2016 Advanced Micro Devices, Inc.
	* 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 copyright
	* notice, this list of conditions and the following disclaimer in the
	* documentation and/or other materials provided with the distribution.
	* * Neither the name of Advanced Micro Devices, Inc. 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 <COPYRIGHT HOLDER> 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.
	*
	* This file incorporates work covered by the following copyright and
	* permission notice:
	* The Synopsys DWC ETHER XGMAC Software Driver and documentation
	* (hereinafter "Software") is an unsupported proprietary work of Synopsys,
	* Inc. unless otherwise expressly agreed to in writing between Synopsys
	* and you.
	*
	* The Software IS NOT an item of Licensed Software or Licensed Product
	* under any End User Software License Agreement or Agreement for Licensed
	* Product with Synopsys or any supplement thereto. Permission is hereby
	* granted, free of charge, to any person obtaining a copy of this software
	* annotated with this license and the Software, to deal in the Software
	* without restriction, including without limitation the rights to use,
	* copy, modify, merge, publish, distribute, sublicense, and/or sell copies
	* of the Software, and to permit persons to whom the Software is furnished
	* to do so, subject to the following conditions:
	*
	* The above copyright notice and this permission notice shall be included
	* in all copies or substantial portions of the Software.
	*
	* THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS"
	* BASIS AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
	* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
	* PARTICULAR PURPOSE ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS
	* 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.
	*/

	#include <linux/module.h>
	#include <linux/device.h>
	#include <linux/pci.h>
	#include <linux/log2.h>

	#include "xgbe.h"
	#include "xgbe-common.h"

	static int xgbe_config_msi(struct xgbe_prv_data *pdata)
	{
	unsigned int msi_count;
	unsigned int i, j;
	int ret;

	msi_count = XGBE_MSIX_BASE_COUNT;
	msi_count += max(pdata->rx_ring_count,
	pdata->tx_ring_count);
	msi_count = roundup_pow_of_two(msi_count);

	ret = pci_enable_msi_exact(pdata->pcidev, msi_count);
	if (ret < 0) {
	dev_info(pdata->dev, "MSI request for %u interrupts failed\n",
	msi_count);

	ret = pci_enable_msi(pdata->pcidev);
	if (ret < 0) {
	dev_info(pdata->dev, "MSI enablement failed\n");
	return ret;
	}

	msi_count = 1;
	}

	pdata->irq_count = msi_count;

	pdata->dev_irq = pdata->pcidev->irq;

	if (msi_count > 1) {
	pdata->ecc_irq = pdata->pcidev->irq + 1;
	pdata->i2c_irq = pdata->pcidev->irq + 2;
	pdata->an_irq = pdata->pcidev->irq + 3;

	for (i = XGBE_MSIX_BASE_COUNT, j = 0;
	(i < msi_count) && (j < XGBE_MAX_DMA_CHANNELS);
	i++, j++)
	pdata->channel_irq[j] = pdata->pcidev->irq + i;
	pdata->channel_irq_count = j;

	pdata->per_channel_irq = 1;
	pdata->channel_irq_mode = XGBE_IRQ_MODE_LEVEL;
	} else {
	pdata->ecc_irq = pdata->pcidev->irq;
	pdata->i2c_irq = pdata->pcidev->irq;
	pdata->an_irq = pdata->pcidev->irq;
	}

	if (netif_msg_probe(pdata))
	dev_dbg(pdata->dev, "MSI interrupts enabled\n");

	return 0;
	}

	static int xgbe_config_msix(struct xgbe_prv_data *pdata)
	{
	unsigned int msix_count;
	unsigned int i, j;
	int ret;

	msix_count = XGBE_MSIX_BASE_COUNT;
	msix_count += max(pdata->rx_ring_count,
	pdata->tx_ring_count);

	pdata->msix_entries = devm_kcalloc(pdata->dev, msix_count,
	sizeof(struct msix_entry),
	GFP_KERNEL);
	if (!pdata->msix_entries)
	return -ENOMEM;

	for (i = 0; i < msix_count; i++)
	pdata->msix_entries[i].entry = i;

	ret = pci_enable_msix_range(pdata->pcidev, pdata->msix_entries,
	XGBE_MSIX_MIN_COUNT, msix_count);
	if (ret < 0) {
	dev_info(pdata->dev, "MSI-X enablement failed\n");
	devm_kfree(pdata->dev, pdata->msix_entries);
	pdata->msix_entries = NULL;
	return ret;
	}

	pdata->irq_count = ret;

	pdata->dev_irq = pdata->msix_entries[0].vector;
	pdata->ecc_irq = pdata->msix_entries[1].vector;
	pdata->i2c_irq = pdata->msix_entries[2].vector;
	pdata->an_irq = pdata->msix_entries[3].vector;

	for (i = XGBE_MSIX_BASE_COUNT, j = 0; i < ret; i++, j++)
	pdata->channel_irq[j] = pdata->msix_entries[i].vector;
	pdata->channel_irq_count = j;

	pdata->per_channel_irq = 1;
	pdata->channel_irq_mode = XGBE_IRQ_MODE_LEVEL;

	if (netif_msg_probe(pdata))
	dev_dbg(pdata->dev, "MSI-X interrupts enabled\n");

	return 0;
	}

	static int xgbe_config_irqs(struct xgbe_prv_data *pdata)
	{
	int ret;

	ret = xgbe_config_msix(pdata);
	if (!ret)
	goto out;

	ret = xgbe_config_msi(pdata);
	if (!ret)
	goto out;

	pdata->irq_count = 1;
	pdata->irq_shared = 1;

	pdata->dev_irq = pdata->pcidev->irq;
	pdata->ecc_irq = pdata->pcidev->irq;
	pdata->i2c_irq = pdata->pcidev->irq;
	pdata->an_irq = pdata->pcidev->irq;

	out:
	if (netif_msg_probe(pdata)) {
	unsigned int i;

	dev_dbg(pdata->dev, " dev irq=%d\n", pdata->dev_irq);
	dev_dbg(pdata->dev, " ecc irq=%d\n", pdata->ecc_irq);
	dev_dbg(pdata->dev, " i2c irq=%d\n", pdata->i2c_irq);
	dev_dbg(pdata->dev, " an irq=%d\n", pdata->an_irq);
	for (i = 0; i < pdata->channel_irq_count; i++)
	dev_dbg(pdata->dev, " dma%u irq=%d\n",
	i, pdata->channel_irq[i]);
	}

	return 0;
	}

	static int xgbe_pci_probe(struct pci_dev pdev, const struct pci_device_id id)
	{
	struct xgbe_prv_data *pdata;
	struct device *dev = &pdev->dev;
	void __iomem * const *iomap_table;
	unsigned int ma_lo, ma_hi;
	unsigned int reg;
	int bar_mask;
	int ret;

	pdata = xgbe_alloc_pdata(dev);
	if (IS_ERR(pdata)) {
	ret = PTR_ERR(pdata);
	goto err_alloc;
	}

	pdata->pcidev = pdev;
	pci_set_drvdata(pdev, pdata);

	/* Get the version data */
	pdata->vdata = (struct xgbe_version_data *)id->driver_data;

	ret = pcim_enable_device(pdev);
	if (ret) {
	dev_err(dev, "pcim_enable_device failed\n");
	goto err_pci_enable;
	}

	/* Obtain the mmio areas for the device */
	bar_mask = pci_select_bars(pdev, IORESOURCE_MEM);
	ret = pcim_iomap_regions(pdev, bar_mask, XGBE_DRV_NAME);
	if (ret) {
	dev_err(dev, "pcim_iomap_regions failed\n");
	goto err_pci_enable;
	}

	iomap_table = pcim_iomap_table(pdev);
	if (!iomap_table) {
	dev_err(dev, "pcim_iomap_table failed\n");
	ret = -ENOMEM;
	goto err_pci_enable;
	}

	pdata->xgmac_regs = iomap_table[XGBE_XGMAC_BAR];
	if (!pdata->xgmac_regs) {
	dev_err(dev, "xgmac ioremap failed\n");
	ret = -ENOMEM;
	goto err_pci_enable;
	}
	pdata->xprop_regs = pdata->xgmac_regs + XGBE_MAC_PROP_OFFSET;
	pdata->xi2c_regs = pdata->xgmac_regs + XGBE_I2C_CTRL_OFFSET;
	if (netif_msg_probe(pdata)) {
	dev_dbg(dev, "xgmac_regs = %p\n", pdata->xgmac_regs);
	dev_dbg(dev, "xprop_regs = %p\n", pdata->xprop_regs);
	dev_dbg(dev, "xi2c_regs = %p\n", pdata->xi2c_regs);
	}

	pdata->xpcs_regs = iomap_table[XGBE_XPCS_BAR];
	if (!pdata->xpcs_regs) {
	dev_err(dev, "xpcs ioremap failed\n");
	ret = -ENOMEM;
	goto err_pci_enable;
	}
	if (netif_msg_probe(pdata))
	dev_dbg(dev, "xpcs_regs = %p\n", pdata->xpcs_regs);

	/* Configure the PCS indirect addressing support */
	reg = XPCS32_IOREAD(pdata, PCS_V2_WINDOW_DEF);
	pdata->xpcs_window = XPCS_GET_BITS(reg, PCS_V2_WINDOW_DEF, OFFSET);
	pdata->xpcs_window <<= 6;
	pdata->xpcs_window_size = XPCS_GET_BITS(reg, PCS_V2_WINDOW_DEF, SIZE);
	pdata->xpcs_window_size = 1 << (pdata->xpcs_window_size + 7);
	pdata->xpcs_window_mask = pdata->xpcs_window_size - 1;
	if (netif_msg_probe(pdata)) {
	dev_dbg(dev, "xpcs window = %#010x\n",
	pdata->xpcs_window);
	dev_dbg(dev, "xpcs window size = %#010x\n",
	pdata->xpcs_window_size);
	dev_dbg(dev, "xpcs window mask = %#010x\n",
	pdata->xpcs_window_mask);
	}

	pci_set_master(pdev);

	/* Enable all interrupts in the hardware */
	XP_IOWRITE(pdata, XP_INT_EN, 0x1fffff);

	/* Retrieve the MAC address */
	ma_lo = XP_IOREAD(pdata, XP_MAC_ADDR_LO);
	ma_hi = XP_IOREAD(pdata, XP_MAC_ADDR_HI);
	pdata->mac_addr[0] = ma_lo & 0xff;
	pdata->mac_addr[1] = (ma_lo >> 8) & 0xff;
	pdata->mac_addr[2] = (ma_lo >> 16) & 0xff;
	pdata->mac_addr[3] = (ma_lo >> 24) & 0xff;
	pdata->mac_addr[4] = ma_hi & 0xff;
	pdata->mac_addr[5] = (ma_hi >> 8) & 0xff;
	if (!XP_GET_BITS(ma_hi, XP_MAC_ADDR_HI, VALID) \|\|
	!is_valid_ether_addr(pdata->mac_addr)) {
	dev_err(dev, "invalid mac address\n");
	ret = -EINVAL;
	goto err_pci_enable;
	}

	/* Clock settings */
	pdata->sysclk_rate = XGBE_V2_DMA_CLOCK_FREQ;
	pdata->ptpclk_rate = XGBE_V2_PTP_CLOCK_FREQ;

	/* Set the DMA coherency values */
	pdata->coherent = 1;
	pdata->axdomain = XGBE_DMA_OS_AXDOMAIN;
	pdata->arcache = XGBE_DMA_OS_ARCACHE;
	pdata->awcache = XGBE_DMA_OS_AWCACHE;

	/* Set the maximum channels and queues */
	reg = XP_IOREAD(pdata, XP_PROP_1);
	pdata->tx_max_channel_count = XP_GET_BITS(reg, XP_PROP_1, MAX_TX_DMA);
	pdata->rx_max_channel_count = XP_GET_BITS(reg, XP_PROP_1, MAX_RX_DMA);
	pdata->tx_max_q_count = XP_GET_BITS(reg, XP_PROP_1, MAX_TX_QUEUES);
	pdata->rx_max_q_count = XP_GET_BITS(reg, XP_PROP_1, MAX_RX_QUEUES);
	if (netif_msg_probe(pdata)) {
	dev_dbg(dev, "max tx/rx channel count = %u/%u\n",
	pdata->tx_max_channel_count,
	pdata->tx_max_channel_count);
	dev_dbg(dev, "max tx/rx hw queue count = %u/%u\n",
	pdata->tx_max_q_count, pdata->rx_max_q_count);
	}

	/* Set the hardware channel and queue counts */
	xgbe_set_counts(pdata);

	/* Set the maximum fifo amounts */
	reg = XP_IOREAD(pdata, XP_PROP_2);
	pdata->tx_max_fifo_size = XP_GET_BITS(reg, XP_PROP_2, TX_FIFO_SIZE);
	pdata->tx_max_fifo_size *= 16384;
	pdata->tx_max_fifo_size = min(pdata->tx_max_fifo_size,
	pdata->vdata->tx_max_fifo_size);
	pdata->rx_max_fifo_size = XP_GET_BITS(reg, XP_PROP_2, RX_FIFO_SIZE);
	pdata->rx_max_fifo_size *= 16384;
	pdata->rx_max_fifo_size = min(pdata->rx_max_fifo_size,
	pdata->vdata->rx_max_fifo_size);
	if (netif_msg_probe(pdata))
	dev_dbg(dev, "max tx/rx max fifo size = %u/%u\n",
	pdata->tx_max_fifo_size, pdata->rx_max_fifo_size);

	/* Configure interrupt support */
	ret = xgbe_config_irqs(pdata);
	if (ret)
	goto err_pci_enable;

	/* Configure the netdev resource */
	ret = xgbe_config_netdev(pdata);
	if (ret)
	goto err_pci_enable;

	netdev_notice(pdata->netdev, "net device enabled\n");

	return 0;

	err_pci_enable:
	xgbe_free_pdata(pdata);

	err_alloc:
	dev_notice(dev, "net device not enabled\n");

	return ret;
	}

	static void xgbe_pci_remove(struct pci_dev *pdev)
	{
	struct xgbe_prv_data *pdata = pci_get_drvdata(pdev);

	xgbe_deconfig_netdev(pdata);

	xgbe_free_pdata(pdata);
	}

	#ifdef CONFIG_PM
	static int xgbe_pci_suspend(struct pci_dev *pdev, pm_message_t state)
	{
	struct xgbe_prv_data *pdata = pci_get_drvdata(pdev);
	struct net_device *netdev = pdata->netdev;
	int ret = 0;

	if (netif_running(netdev))
	ret = xgbe_powerdown(netdev, XGMAC_DRIVER_CONTEXT);

	pdata->lpm_ctrl = XMDIO_READ(pdata, MDIO_MMD_PCS, MDIO_CTRL1);
	pdata->lpm_ctrl \|= MDIO_CTRL1_LPOWER;
	XMDIO_WRITE(pdata, MDIO_MMD_PCS, MDIO_CTRL1, pdata->lpm_ctrl);

	return ret;
	}

	static int xgbe_pci_resume(struct pci_dev *pdev)
	{
	struct xgbe_prv_data *pdata = pci_get_drvdata(pdev);
	struct net_device *netdev = pdata->netdev;
	int ret = 0;

	pdata->lpm_ctrl &= ~MDIO_CTRL1_LPOWER;
	XMDIO_WRITE(pdata, MDIO_MMD_PCS, MDIO_CTRL1, pdata->lpm_ctrl);

	if (netif_running(netdev)) {
	ret = xgbe_powerup(netdev, XGMAC_DRIVER_CONTEXT);

	/* Schedule a restart in case the link or phy state changed
	* while we were powered down.
	*/
	schedule_work(&pdata->restart_work);
	}

	return ret;
	}
	#endif /* CONFIG_PM */

	static const struct xgbe_version_data xgbe_v2a = {
	.init_function_ptrs_phy_impl = xgbe_init_function_ptrs_phy_v2,
	.xpcs_access = XGBE_XPCS_ACCESS_V2,
	.mmc_64bit = 1,
	.tx_max_fifo_size = 229376,
	.rx_max_fifo_size = 229376,
	.tx_tstamp_workaround = 1,
	.ecc_support = 1,
	.i2c_support = 1,
	};

	static const struct xgbe_version_data xgbe_v2b = {
	.init_function_ptrs_phy_impl = xgbe_init_function_ptrs_phy_v2,
	.xpcs_access = XGBE_XPCS_ACCESS_V2,
	.mmc_64bit = 1,
	.tx_max_fifo_size = 65536,
	.rx_max_fifo_size = 65536,
	.tx_tstamp_workaround = 1,
	.ecc_support = 1,
	.i2c_support = 1,
	};

	static const struct pci_device_id xgbe_pci_table[] = {
	{ PCI_VDEVICE(AMD, 0x1458),
	.driver_data = (kernel_ulong_t)&xgbe_v2a },
	{ PCI_VDEVICE(AMD, 0x1459),
	.driver_data = (kernel_ulong_t)&xgbe_v2b },
	/* Last entry must be zero */
	{ 0, }
	};
	MODULE_DEVICE_TABLE(pci, xgbe_pci_table);

	static struct pci_driver xgbe_driver = {
	.name = XGBE_DRV_NAME,
	.id_table = xgbe_pci_table,
	.probe = xgbe_pci_probe,
	.remove = xgbe_pci_remove,
	#ifdef CONFIG_PM
	.suspend = xgbe_pci_suspend,
	.resume = xgbe_pci_resume,
	#endif
	};

	int xgbe_pci_init(void)
	{
	return pci_register_driver(&xgbe_driver);
	}

	void xgbe_pci_exit(void)
	{
	pci_unregister_driver(&xgbe_driver);
	}