mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
110 lines
2.5 KiB
110 lines
2.5 KiB
// 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; |
|
bus->write = enetc_mdio_write; |
|
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_mem_regions(pdev); |
|
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_mem_regions(pdev); |
|
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");
|
|
|