mirror of
git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
synced 2025-05-19 23:52:36 +00:00
80e87442e6
The enetc MDIO bus driver can perform both C22 and C45 transfers. Create separate functions for each and register the C45 versions using the new API calls where appropriate. This driver is shared with the Felix DSA switch, so update that at the same time. Signed-off-by: Andrew Lunn <andrew@lunn.ch> Signed-off-by: Michael Walle <michael@walle.cc> Signed-off-by: Jakub Kicinski <kuba@kernel.org>
112 lines
2.6 KiB
C
112 lines
2.6 KiB
C
// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
|
|
/* Copyright 2019 NXP */
|
|
#include <linux/fsl/enetc_mdio.h>
|
|
#include <linux/of_mdio.h>
|
|
#include "enetc_pf.h"
|
|
|
|
#define ENETC_MDIO_DEV_ID 0xee01
|
|
#define ENETC_MDIO_DEV_NAME "FSL PCIe IE Central MDIO"
|
|
#define ENETC_MDIO_BUS_NAME ENETC_MDIO_DEV_NAME " Bus"
|
|
#define ENETC_MDIO_DRV_NAME ENETC_MDIO_DEV_NAME " driver"
|
|
|
|
static int enetc_pci_mdio_probe(struct pci_dev *pdev,
|
|
const struct pci_device_id *ent)
|
|
{
|
|
struct enetc_mdio_priv *mdio_priv;
|
|
struct device *dev = &pdev->dev;
|
|
void __iomem *port_regs;
|
|
struct enetc_hw *hw;
|
|
struct mii_bus *bus;
|
|
int err;
|
|
|
|
port_regs = pci_iomap(pdev, 0, 0);
|
|
if (!port_regs) {
|
|
dev_err(dev, "iomap failed\n");
|
|
err = -ENXIO;
|
|
goto err_ioremap;
|
|
}
|
|
|
|
hw = enetc_hw_alloc(dev, port_regs);
|
|
if (IS_ERR(hw)) {
|
|
err = PTR_ERR(hw);
|
|
goto err_hw_alloc;
|
|
}
|
|
|
|
bus = devm_mdiobus_alloc_size(dev, sizeof(*mdio_priv));
|
|
if (!bus) {
|
|
err = -ENOMEM;
|
|
goto err_mdiobus_alloc;
|
|
}
|
|
|
|
bus->name = ENETC_MDIO_BUS_NAME;
|
|
bus->read = enetc_mdio_read_c22;
|
|
bus->write = enetc_mdio_write_c22;
|
|
bus->read_c45 = enetc_mdio_read_c45;
|
|
bus->write_c45 = enetc_mdio_write_c45;
|
|
bus->parent = dev;
|
|
mdio_priv = bus->priv;
|
|
mdio_priv->hw = hw;
|
|
mdio_priv->mdio_base = ENETC_EMDIO_BASE;
|
|
snprintf(bus->id, MII_BUS_ID_SIZE, "%s", dev_name(dev));
|
|
|
|
pcie_flr(pdev);
|
|
err = pci_enable_device_mem(pdev);
|
|
if (err) {
|
|
dev_err(dev, "device enable failed\n");
|
|
goto err_pci_enable;
|
|
}
|
|
|
|
err = pci_request_region(pdev, 0, KBUILD_MODNAME);
|
|
if (err) {
|
|
dev_err(dev, "pci_request_region failed\n");
|
|
goto err_pci_mem_reg;
|
|
}
|
|
|
|
err = of_mdiobus_register(bus, dev->of_node);
|
|
if (err)
|
|
goto err_mdiobus_reg;
|
|
|
|
pci_set_drvdata(pdev, bus);
|
|
|
|
return 0;
|
|
|
|
err_mdiobus_reg:
|
|
pci_release_region(pdev, 0);
|
|
err_pci_mem_reg:
|
|
pci_disable_device(pdev);
|
|
err_pci_enable:
|
|
err_mdiobus_alloc:
|
|
err_hw_alloc:
|
|
iounmap(port_regs);
|
|
err_ioremap:
|
|
return err;
|
|
}
|
|
|
|
static void enetc_pci_mdio_remove(struct pci_dev *pdev)
|
|
{
|
|
struct mii_bus *bus = pci_get_drvdata(pdev);
|
|
struct enetc_mdio_priv *mdio_priv;
|
|
|
|
mdiobus_unregister(bus);
|
|
mdio_priv = bus->priv;
|
|
iounmap(mdio_priv->hw->port);
|
|
pci_release_region(pdev, 0);
|
|
pci_disable_device(pdev);
|
|
}
|
|
|
|
static const struct pci_device_id enetc_pci_mdio_id_table[] = {
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_FREESCALE, ENETC_MDIO_DEV_ID) },
|
|
{ 0, } /* End of table. */
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, enetc_pci_mdio_id_table);
|
|
|
|
static struct pci_driver enetc_pci_mdio_driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.id_table = enetc_pci_mdio_id_table,
|
|
.probe = enetc_pci_mdio_probe,
|
|
.remove = enetc_pci_mdio_remove,
|
|
};
|
|
module_pci_driver(enetc_pci_mdio_driver);
|
|
|
|
MODULE_DESCRIPTION(ENETC_MDIO_DRV_NAME);
|
|
MODULE_LICENSE("Dual BSD/GPL");
|