[PATCH v3 3/5] drivers: net: phy: Add MDIO driver

Matthias Brugger matthias.bgg at gmail.com
Wed Jun 8 03:17:37 PDT 2016



On 06/06/16 20:16, Iyappan Subramanian wrote:
> Currently, SGMII based 1G rely on the hardware registers for link state
> and sometimes it's not reliable.  To get most accurate link state, this
> interface has to use the MDIO bus to poll the PHY.
>
> In X-Gene SoC, MDIO bus is shared across RGMII and SGMII based 1G
> interfaces, so adding this driver to manage MDIO bus.  This driver
> registers the mdio bus and registers the PHYs connected to it.
>
> Signed-off-by: Iyappan Subramanian <isubramanian at apm.com>
> Tested-by: Fushen Chen <fchen at apm.com>
> Tested-by: Toan Le <toanle at apm.com>
> Tested-by: Matthias Brugger <mbrugger at suse.com>
> ---
>   drivers/net/ethernet/apm/xgene/Kconfig |   1 +
>   drivers/net/phy/Kconfig                |   7 +
>   drivers/net/phy/Makefile               |   1 +
>   drivers/net/phy/mdio-xgene.c           | 532 +++++++++++++++++++++++++++++++++
>   drivers/net/phy/mdio-xgene.h           | 140 +++++++++
>   5 files changed, 681 insertions(+)
>   create mode 100644 drivers/net/phy/mdio-xgene.c
>   create mode 100644 drivers/net/phy/mdio-xgene.h
>
> diff --git a/drivers/net/ethernet/apm/xgene/Kconfig b/drivers/net/ethernet/apm/xgene/Kconfig
> index 19e38af..300e3b5 100644
> --- a/drivers/net/ethernet/apm/xgene/Kconfig
> +++ b/drivers/net/ethernet/apm/xgene/Kconfig
> @@ -3,6 +3,7 @@ config NET_XGENE
>   	depends on HAS_DMA
>   	depends on ARCH_XGENE || COMPILE_TEST
>   	select PHYLIB
> +	select MDIO_XGENE
>   	help
>   	  This is the Ethernet driver for the on-chip ethernet interface on the
>   	  APM X-Gene SoC.
> diff --git a/drivers/net/phy/Kconfig b/drivers/net/phy/Kconfig
> index 6dad9a9..193f418 100644
> --- a/drivers/net/phy/Kconfig
> +++ b/drivers/net/phy/Kconfig
> @@ -271,6 +271,13 @@ config MDIO_BCM_IPROC
>   	  This module provides a driver for the MDIO busses found in the
>   	  Broadcom iProc SoC's.
>
> +config MDIO_XGENE
> +       tristate "APM X-Gene SoC MDIO bus controller"
> +       help
> +         This module provides a driver for the MDIO busses found in the
> +         APM X-Gene SoC's.
> +
> +
>   endif # PHYLIB
>
>   config MICREL_KS8995MA
> diff --git a/drivers/net/phy/Makefile b/drivers/net/phy/Makefile
> index fcdbb92..9cbd2af 100644
> --- a/drivers/net/phy/Makefile
> +++ b/drivers/net/phy/Makefile
> @@ -44,3 +44,4 @@ obj-$(CONFIG_MDIO_MOXART)	+= mdio-moxart.o
>   obj-$(CONFIG_MDIO_BCM_UNIMAC)	+= mdio-bcm-unimac.o
>   obj-$(CONFIG_MICROCHIP_PHY)	+= microchip.o
>   obj-$(CONFIG_MDIO_BCM_IPROC)	+= mdio-bcm-iproc.o
> +obj-$(CONFIG_MDIO_XGENE)	+= mdio-xgene.o
> diff --git a/drivers/net/phy/mdio-xgene.c b/drivers/net/phy/mdio-xgene.c
> new file mode 100644
> index 0000000..48273e3
> --- /dev/null
> +++ b/drivers/net/phy/mdio-xgene.c
> @@ -0,0 +1,532 @@
> +/* Applied Micro X-Gene SoC MDIO Driver
> + *
> + * Copyright (c) 2016, Applied Micro Circuits Corporation
> + * Author: Iyappan Subramanian <isubramanian at apm.com>
> + *
> + * This program is free software; you can redistribute  it 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 program 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/>.
> + */
> +
> +#include <linux/acpi.h>
> +#include <linux/clk.h>
> +#include <linux/device.h>
> +#include <linux/efi.h>
> +#include <linux/if_vlan.h>
> +#include <linux/io.h>
> +#include <linux/module.h>
> +#include <linux/of_platform.h>
> +#include <linux/of_net.h>
> +#include <linux/of_mdio.h>
> +#include <linux/prefetch.h>
> +#include <linux/phy.h>
> +#include <net/ip.h>
> +#include "mdio-xgene.h"
> +
> +static bool xgene_mdio_status;
> +
> +static bool xgene_enet_rd_indirect(void __iomem *addr, void __iomem *rd,
> +				   void __iomem *cmd, void __iomem *cmd_done,
> +				   u32 rd_addr, u32 *rd_data)
> +{
> +	u32 done;
> +	u8 wait = 10;
> +
> +	iowrite32(rd_addr, addr);
> +	iowrite32(XGENE_ENET_RD_CMD, cmd);
> +
> +	/* wait for read command to complete */
> +	while (!(done = ioread32(cmd_done)) && wait--)
> +		udelay(1);
> +
> +	if (!done)
> +		return false;
> +
> +	*rd_data = ioread32(rd);
> +	iowrite32(0, cmd);
> +
> +	return true;
> +}
> +
> +static void xgene_enet_rd_mcx_mac(struct xgene_mdio_pdata *pdata,
> +				  u32 rd_addr, u32 *rd_data)
> +{
> +	void __iomem *addr, *rd, *cmd, *cmd_done;
> +
> +	addr = pdata->mac_csr_addr + MAC_ADDR_REG_OFFSET;
> +	rd = pdata->mac_csr_addr + MAC_READ_REG_OFFSET;
> +	cmd = pdata->mac_csr_addr + MAC_COMMAND_REG_OFFSET;
> +	cmd_done = pdata->mac_csr_addr + MAC_COMMAND_DONE_REG_OFFSET;
> +
> +	if (!xgene_enet_rd_indirect(addr, rd, cmd, cmd_done, rd_addr, rd_data))
> +		dev_err(pdata->dev, "MCX mac read failed, addr: 0x%04x\n",
> +			rd_addr);
> +}
> +
> +static bool xgene_enet_wr_indirect(void __iomem *addr, void __iomem *wr,
> +				   void __iomem *cmd, void __iomem *cmd_done,
> +				   u32 wr_addr, u32 wr_data)
> +{
> +	u32 done;
> +	u8 wait = 10;
> +
> +	iowrite32(wr_addr, addr);
> +	iowrite32(wr_data, wr);
> +	iowrite32(XGENE_ENET_WR_CMD, cmd);
> +
> +	/* wait for write command to complete */
> +	while (!(done = ioread32(cmd_done)) && wait--)
> +		udelay(1);
> +
> +	if (!done)
> +		return false;
> +
> +	iowrite32(0, cmd);
> +
> +	return true;
> +}
> +
> +static void xgene_enet_wr_mcx_mac(struct xgene_mdio_pdata *pdata,
> +				  u32 wr_addr, u32 wr_data)
> +{
> +	void __iomem *addr, *wr, *cmd, *cmd_done;
> +
> +	addr = pdata->mac_csr_addr + MAC_ADDR_REG_OFFSET;
> +	wr = pdata->mac_csr_addr + MAC_WRITE_REG_OFFSET;
> +	cmd = pdata->mac_csr_addr + MAC_COMMAND_REG_OFFSET;
> +	cmd_done = pdata->mac_csr_addr + MAC_COMMAND_DONE_REG_OFFSET;
> +
> +	if (!xgene_enet_wr_indirect(addr, wr, cmd, cmd_done, wr_addr, wr_data))
> +		dev_err(pdata->dev, "MCX mac write failed, addr: 0x%04x\n",
> +			wr_addr);
> +}
> +
> +static int xgene_mii_phy_read(struct xgene_mdio_pdata *pdata,
> +			      u8 phy_id, u32 reg)
> +{
> +	u32 data, done;
> +	u8 wait = 10;
> +
> +	data = SET_VAL(PHY_ADDR, phy_id) | SET_VAL(REG_ADDR, reg);
> +	xgene_enet_wr_mcx_mac(pdata, MII_MGMT_ADDRESS_ADDR, data);
> +	xgene_enet_wr_mcx_mac(pdata, MII_MGMT_COMMAND_ADDR, READ_CYCLE_MASK);
> +	do {
> +		usleep_range(5, 10);
> +		xgene_enet_rd_mcx_mac(pdata, MII_MGMT_INDICATORS_ADDR, &done);
> +	} while ((done & BUSY_MASK) && wait--);
> +
> +	if (done & BUSY_MASK) {
> +		dev_err(pdata->dev, "MII_MGMT read failed\n");
> +		return -EBUSY;
> +	}
> +
> +	xgene_enet_rd_mcx_mac(pdata, MII_MGMT_STATUS_ADDR, &data);
> +	xgene_enet_wr_mcx_mac(pdata, MII_MGMT_COMMAND_ADDR, 0);
> +
> +	return data;
> +}
> +
> +static int xgene_mii_phy_write(struct xgene_mdio_pdata *pdata, int phy_id,
> +			       u32 reg, u16 data)
> +{
> +	u32 val, done;
> +	u8 wait = 10;
> +
> +	val = SET_VAL(PHY_ADDR, phy_id) | SET_VAL(REG_ADDR, reg);
> +	xgene_enet_wr_mcx_mac(pdata, MII_MGMT_ADDRESS_ADDR, val);
> +
> +	xgene_enet_wr_mcx_mac(pdata, MII_MGMT_CONTROL_ADDR, data);
> +	do {
> +		usleep_range(5, 10);
> +		xgene_enet_rd_mcx_mac(pdata, MII_MGMT_INDICATORS_ADDR, &done);
> +	} while ((done & BUSY_MASK) && wait--);
> +
> +	if (done & BUSY_MASK) {
> +		dev_err(pdata->dev, "MII_MGMT write failed\n");
> +		return -EBUSY;
> +	}
> +
> +	return 0;
> +}
> +
> +static int xgene_mdio_rgmii_read(struct mii_bus *bus, int mii_id, int regnum)
> +{
> +	struct xgene_mdio_pdata *pdata = bus->priv;
> +	u32 val;
> +
> +	val = xgene_mii_phy_read(pdata, mii_id, regnum);
> +	dev_dbg(pdata->dev, "MDIO read: bus=%d reg=%d val=0x%x\n",
> +		mii_id, regnum, val);
> +
> +	return val;
> +}
> +
> +static int xgene_mdio_rgmii_write(struct mii_bus *bus, int mii_id, int regnum,
> +				  u16 val)
> +{
> +	struct xgene_mdio_pdata *pdata = bus->priv;
> +
> +	dev_dbg(pdata->dev, "MDIO write: bus=%d reg=%d val=0x%x\n",
> +		mii_id, regnum, val);
> +
> +	return xgene_mii_phy_write(pdata, mii_id, regnum, val);
> +}
> +
> +static u32 xgene_menet_rd_diag_csr(struct xgene_mdio_pdata *pdata,
> +				   u32 offset)
> +{
> +	return ioread32(pdata->diag_csr_addr + offset);
> +}
> +
> +static void xgene_menet_wr_diag_csr(struct xgene_mdio_pdata *pdata,
> +				    u32 offset, u32 val)
> +{
> +	iowrite32(val, pdata->diag_csr_addr + offset);
> +}
> +
> +static int xgene_enet_ecc_init(struct xgene_mdio_pdata *pdata)
> +{
> +	u32 data;
> +	u8 wait = 10;
> +
> +	xgene_menet_wr_diag_csr(pdata, MENET_CFG_MEM_RAM_SHUTDOWN_ADDR, 0x0);
> +	do {
> +		usleep_range(100, 110);
> +		data = xgene_menet_rd_diag_csr(pdata, MENET_BLOCK_MEM_RDY_ADDR);
> +	} while ((data != 0xffffffff) && wait--);
> +
> +	if (data != 0xffffffff) {
> +		dev_err(pdata->dev, "Failed to release memory from shutdown\n");
> +		return -ENODEV;
> +	}
> +
> +	return 0;
> +}
> +
> +static void xgene_gmac_reset(struct xgene_mdio_pdata *pdata)
> +{
> +	xgene_enet_wr_mcx_mac(pdata, MAC_CONFIG_1_ADDR, SOFT_RESET);
> +	xgene_enet_wr_mcx_mac(pdata, MAC_CONFIG_1_ADDR, 0);
> +}
> +
> +static int xgene_mdio_reset(struct xgene_mdio_pdata *pdata)
> +{
> +	int ret;
> +
> +	if (pdata->mdio_id == XGENE_MDIO_RGMII) {
> +		/* Hardware expects the following clock reset sequence */
> +		if (pdata->dev->of_node) {

If you change the order of this two if's, you can get rid of one else 
branch.

> +			clk_prepare_enable(pdata->clk);
> +			clk_disable_unprepare(pdata->clk);
> +			clk_prepare_enable(pdata->clk);
> +		} else {
> +#ifdef CONFIG_ACPI
> +			acpi_evaluate_object(ACPI_HANDLE(pdata->dev),
> +					     "_RST", NULL, NULL);
> +#endif
> +		}
> +	} else {
> +#ifdef CONFIG_ACPI
> +		acpi_evaluate_object(ACPI_HANDLE(pdata->dev),
> +				     "_RST", NULL, NULL);
> +#endif
> +	}
> +
> +	ret = xgene_enet_ecc_init(pdata);
> +	if (ret)
> +		return ret;
> +	xgene_gmac_reset(pdata);
> +
> +	return 0;
> +}
> +
> +static void xgene_enet_rd_mdio_csr(struct xgene_mdio_pdata  *pdata,
> +				   u32 offset, u32 *val)
> +{
> +	void __iomem *addr = pdata->mdio_csr_addr  + offset;
> +
> +	*val = ioread32(addr);
> +}
> +
> +static void xgene_enet_wr_mdio_csr(struct xgene_mdio_pdata *pdata,
> +				   u32 offset, u32 val)
> +{
> +	void __iomem *addr = pdata->mdio_csr_addr  + offset;
> +
> +	iowrite32(val, addr);
> +}
> +
> +static int xgene_xfimii_phy_write(struct xgene_mdio_pdata *pdata, int phy_id,
> +				  u32 reg, u16 data)
> +{
> +	int timeout = 100;
> +	u32 status, val;
> +
> +	val = SET_VAL(HSTPHYADX, phy_id) | SET_VAL(HSTREGADX, reg) |
> +	      SET_VAL(HSTMIIMWRDAT, data);
> +	xgene_enet_wr_mdio_csr(pdata, MIIM_FIELD_ADDR, data);
> +
> +	val = HSTLDCMD | SET_VAL(HSTMIIMCMD, MIIM_CMD_LEGACY_WRITE);
> +	xgene_enet_wr_mdio_csr(pdata, MIIM_COMMAND_ADDR, val);
> +
> +	do {
> +		usleep_range(5, 10);
> +		xgene_enet_rd_mdio_csr(pdata, MIIM_INDICATOR_ADDR, &status);
> +	} while ((status & BUSY_MASK) && timeout--);
> +
> +	xgene_enet_wr_mdio_csr(pdata, MIIM_COMMAND_ADDR, 0);
> +	return 0;
> +}
> +
> +static int xgene_xfimii_phy_read(struct xgene_mdio_pdata *pdata,
> +				 u8 phy_id, u32 reg)
> +{
> +	u32 data, status, val;
> +	int timeout = 100;
> +
> +	val = SET_VAL(HSTPHYADX, phy_id) | SET_VAL(HSTREGADX, reg);
> +	xgene_enet_wr_mdio_csr(pdata, MIIM_FIELD_ADDR, val);
> +
> +	val = HSTLDCMD | SET_VAL(HSTMIIMCMD, MIIM_CMD_LEGACY_READ);
> +	xgene_enet_wr_mdio_csr(pdata, MIIM_COMMAND_ADDR, val);
> +
> +	do {
> +		usleep_range(5, 10);
> +		xgene_enet_rd_mdio_csr(pdata, MIIM_INDICATOR_ADDR, &status);
> +	} while ((status & BUSY_MASK) && timeout--);
> +
> +	if (status & BUSY_MASK) {
> +		dev_err(pdata->dev, "XGENET_MII_MGMT write failed\n");
> +		return -EBUSY;
> +	}
> +	xgene_enet_rd_mdio_csr(pdata, MIIMRD_FIELD_ADDR, &data);
> +	xgene_enet_wr_mdio_csr(pdata, MIIM_COMMAND_ADDR, 0);
> +
> +	return data;
> +}
> +
> +static int xgene_xfi_mdio_read(struct mii_bus *bus, int mii_id, int regnum)
> +{
> +	struct xgene_mdio_pdata  *pdata = bus->priv;
> +	u32 val;
> +
> +	dev_dbg(pdata->dev, "MDIO read: bus=%d reg=%d val=0x%x\n",
> +		mii_id, regnum, val);
> +	val = xgene_xfimii_phy_read(pdata, mii_id, regnum);
> +

I think this indirection just to add a debug message is not needed.

> +	return val;
> +}
> +
> +static int xgene_xfi_mdio_write(struct mii_bus *bus, int mii_id, int regnum,
> +				u16 val)
> +{
> +	struct xgene_mdio_pdata *pdata = bus->priv;
> +
> +	dev_dbg(pdata->dev, "MDIO write: bus=%d reg=%d val=0x%x\n",
> +		mii_id, regnum, val);
> +
> +	return xgene_xfimii_phy_write(pdata, mii_id, regnum, val);

Same here.

> +}
> +
> +#ifdef CONFIG_ACPI
> +static acpi_status acpi_register_phy(acpi_handle handle, u32 lvl,
> +				     void *context, void **ret)
> +{
> +	struct mii_bus *mdio = context;
> +	struct acpi_device *adev;
> +	struct phy_device *phy_dev;
> +	const union acpi_object *obj;
> +	u32 phy_addr;
> +
> +	if (acpi_bus_get_device(handle, &adev))
> +		return AE_OK;
> +
> +	if (acpi_dev_get_property(adev, "phy-channel", ACPI_TYPE_INTEGER, &obj))
> +		return AE_OK;
> +	phy_addr = obj->integer.value;
> +
> +	phy_dev = get_phy_device(mdio, phy_addr, false);
> +	adev->driver_data = phy_dev;
> +	if (!phy_dev || IS_ERR(phy_dev))
> +		return AE_OK;
> +
> +	if (phy_device_register(phy_dev))
> +		phy_device_free(phy_dev);
> +
> +	return AE_OK;
> +}
> +#endif
> +
> +bool xgene_mdio_probe_successful(void)
> +{
> +	return xgene_mdio_status;
> +}
> +EXPORT_SYMBOL(xgene_mdio_probe_successful);
> +
> +static int xgene_mdio_probe(struct platform_device *pdev)
> +{
> +	struct device *dev = &pdev->dev;
> +	struct mii_bus *mdio_bus;
> +	const struct of_device_id *of_id;
> +	struct resource *res;
> +	struct xgene_mdio_pdata *pdata;
> +	void __iomem *csr_addr;
> +	int mdio_id = 0, ret = 0;
> +
> +	of_id = of_match_device(xgene_mdio_of_match, &pdev->dev);
> +	if (of_id) {
> +		mdio_id = (enum xgene_mdio_id)of_id->data;
> +	} else {
> +#ifdef CONFIG_ACPI
> +		const struct acpi_device_id *acpi_id;
> +
> +		acpi_id = acpi_match_device(xgene_mdio_acpi_match, &pdev->dev);
> +		if (acpi_id)
> +			mdio_id = (enum xgene_mdio_id)acpi_id->driver_data;
> +#endif
> +	}
> +
> +	if (!mdio_id)
> +		return -ENODEV;
> +
> +	pdata = devm_kzalloc(dev, sizeof(struct xgene_mdio_pdata), GFP_KERNEL);
> +	if (!pdata)
> +		return -ENOMEM;
> +	pdata->mdio_id = mdio_id;
> +	pdata->dev = dev;
> +
> +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> +	if (!res) {
> +		dev_err(dev, "Resource mac_ind_csr not defined\n");
> +		return -ENODEV;
> +	}
> +
> +	csr_addr = devm_ioremap(dev, res->start, resource_size(res));
> +	if (!csr_addr) {
> +		dev_err(dev, "Unable to retrieve mac CSR region\n");
> +		return -ENOMEM;
> +	}
> +	pdata->mac_csr_addr = csr_addr;
> +	pdata->mdio_csr_addr = csr_addr + BLOCK_XG_MDIO_CSR_OFFSET;
> +	pdata->diag_csr_addr = csr_addr + BLOCK_DIAG_CSR_OFFSET;
> +
> +	if (dev->of_node) {
> +		pdata->clk = devm_clk_get(dev, NULL);
> +		if (IS_ERR(pdata->clk)) {
> +			dev_err(dev, "Unable to retrieve clk\n");
> +			return -ENODEV;
> +		}
> +	}
> +
> +	ret = xgene_mdio_reset(pdata);
> +	if (ret)
> +		return ret;
> +
> +	mdio_bus = mdiobus_alloc();
> +	if (!mdio_bus)
> +		return -ENOMEM;
> +
> +	mdio_bus->name = "APM X-Gene MDIO bus";

I think xgene-mdio-bus is a more consistent name, regarding the naming 
scheme which is used throughout the kernel.

> +	snprintf(mdio_bus->id, MII_BUS_ID_SIZE, "%s-%d", "xgene-mii",
> +		 mdio_id);
> +
> +	if (mdio_id == XGENE_MDIO_RGMII) {
> +		mdio_bus->read = xgene_mdio_rgmii_read;
> +		mdio_bus->write = xgene_mdio_rgmii_write;
> +	} else {
> +		mdio_bus->read = xgene_xfi_mdio_read;
> +		mdio_bus->write = xgene_xfi_mdio_write;
> +	}
> +
> +	mdio_bus->priv = pdata;
> +	mdio_bus->parent = dev;
> +	platform_set_drvdata(pdev, mdio_bus);
> +
> +	if (dev->of_node) {
> +		ret = of_mdiobus_register(mdio_bus, dev->of_node);
> +	} else {
> +#ifdef CONFIG_ACPI
> +		/* Mask out all PHYs from auto probing. */
> +		mdio_bus->phy_mask = ~0;
> +		ret = mdiobus_register(mdio_bus);
> +		if (ret)
> +			goto out;
> +
> +		acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_HANDLE(dev), 1,
> +				    acpi_register_phy, NULL, mdio_bus, NULL);
> +#endif
> +	}
> +
> +	if (ret)
> +		goto out;
> +
> +	xgene_mdio_status = true;
> +
> +	return 0;
> +out:
> +	if (mdio_bus->state == MDIOBUS_REGISTERED)
> +		mdiobus_unregister(mdio_bus);
> +	mdiobus_free(mdio_bus);
> +
> +	return ret;
> +}
> +
> +static int xgene_mdio_remove(struct platform_device *pdev)
> +{
> +	struct mii_bus *mdio_bus = platform_get_drvdata(pdev);
> +
> +	mdiobus_unregister(mdio_bus);
> +	mdiobus_free(mdio_bus);
> +
> +	return 0;
> +}
> +
> +#ifdef CONFIG_OF
> +static const struct of_device_id xgene_mdio_of_match[] = {
> +	{
> +		.compatible = "apm,xgene-mdio-rgmii",
> +		.data = (void *)XGENE_MDIO_RGMII
> +	},
> +	{
> +		.compatible = "apm,xgene-mdio-xfi",
> +		.data = (void *)XGENE_MDIO_XFI},
> +	{},
> +};
> +
> +MODULE_DEVICE_TABLE(of, xgene_mdio_of_match);
> +#endif
> +
> +#ifdef CONFIG_ACPI
> +static const struct acpi_device_id xgene_mdio_acpi_match[] = {
> +	{ "APMC0D65", XGENE_MDIO_RGMII },
> +	{ "APMC0D66", XGENE_MDIO_XFI },
> +	{ }
> +};
> +
> +MODULE_DEVICE_TABLE(acpi, xgene_mdio_acpi_match);
> +#endif
> +
> +static struct platform_driver xgene_mdio_driver = {
> +	.driver = {
> +		.name = "xgene-mdio",
> +		.of_match_table = of_match_ptr(xgene_mdio_of_match),
> +		.acpi_match_table = ACPI_PTR(xgene_mdio_acpi_match),
> +	},
> +	.probe = xgene_mdio_probe,
> +	.remove = xgene_mdio_remove,
> +};
> +
> +module_platform_driver(xgene_mdio_driver);
> +
> +MODULE_DESCRIPTION("APM X-Gene SoC MDIO driver");
> +MODULE_AUTHOR("Iyappan Subramanian <isubramanian at apm.com>");
> +MODULE_LICENSE("GPL");
> diff --git a/drivers/net/phy/mdio-xgene.h b/drivers/net/phy/mdio-xgene.h
> new file mode 100644
> index 0000000..08b4323
> --- /dev/null
> +++ b/drivers/net/phy/mdio-xgene.h
> @@ -0,0 +1,140 @@
> +/* Applied Micro X-Gene SoC MDIO Driver
> + *
> + * Copyright (c) 2016, Applied Micro Circuits Corporation
> + * Author: Iyappan Subramanian <isubramanian at apm.com>
> + *
> + * This program is free software; you can redistribute  it 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 program 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/>.
> + */
> +
> +#ifndef __MDIO_XGENE_H__
> +#define __MDIO_XGENE_H__
> +
> +#define BLOCK_XG_MDIO_CSR_OFFSET	0x5000
> +#define BLOCK_DIAG_CSR_OFFSET		0xd000
> +#define XGENET_CONFIG_REG_ADDR		0x20
> +
> +#define MAC_ADDR_REG_OFFSET		0x00
> +#define MAC_COMMAND_REG_OFFSET		0x04
> +#define MAC_WRITE_REG_OFFSET		0x08
> +#define MAC_READ_REG_OFFSET		0x0c
> +#define MAC_COMMAND_DONE_REG_OFFSET	0x10
> +
> +#define CLKEN_OFFSET			0x08
> +#define SRST_OFFSET			0x00
> +
> +#define MENET_CFG_MEM_RAM_SHUTDOWN_ADDR	0x70
> +#define MENET_BLOCK_MEM_RDY_ADDR	0x74
> +
> +#define MAC_CONFIG_1_ADDR		0x00
> +#define MII_MGMT_COMMAND_ADDR		0x24
> +#define MII_MGMT_ADDRESS_ADDR		0x28
> +#define MII_MGMT_CONTROL_ADDR		0x2c
> +#define MII_MGMT_STATUS_ADDR		0x30
> +#define MII_MGMT_INDICATORS_ADDR	0x34
> +#define SOFT_RESET			BIT(31)
> +
> +#define MII_MGMT_CONFIG_ADDR            0x20
> +#define MII_MGMT_COMMAND_ADDR           0x24
> +#define MII_MGMT_ADDRESS_ADDR           0x28
> +#define MII_MGMT_CONTROL_ADDR           0x2c
> +#define MII_MGMT_STATUS_ADDR            0x30
> +#define MII_MGMT_INDICATORS_ADDR        0x34
> +
> +#define MIIM_COMMAND_ADDR               0x20
> +#define MIIM_FIELD_ADDR                 0x24
> +#define MIIM_CONFIGURATION_ADDR         0x28
> +#define MIIM_LINKFAILVECTOR_ADDR        0x2c
> +#define MIIM_INDICATOR_ADDR             0x30
> +#define MIIMRD_FIELD_ADDR               0x34
> +
> +#define MDIO_CSR_OFFSET			0x5000
> +
> +#define REG_ADDR_POS			0
> +#define REG_ADDR_LEN			5
> +#define PHY_ADDR_POS			8
> +#define PHY_ADDR_LEN			5
> +
> +#define HSTMIIMWRDAT_POS		0
> +#define HSTMIIMWRDAT_LEN		16
> +#define HSTPHYADX_POS			23
> +#define HSTPHYADX_LEN			5
> +#define HSTREGADX_POS			18
> +#define HSTREGADX_LEN			5
> +#define HSTLDCMD			BIT(3)
> +#define HSTMIIMCMD_POS			0
> +#define HSTMIIMCMD_LEN			3
> +
> +#define BUSY_MASK			BIT(0)
> +#define READ_CYCLE_MASK			BIT(0)
> +
> +enum xgene_enet_cmd {
> +	XGENE_ENET_WR_CMD = BIT(31),
> +	XGENE_ENET_RD_CMD = BIT(30)
> +};
> +
> +enum {
> +	MIIM_CMD_IDLE,
> +	MIIM_CMD_LEGACY_WRITE,
> +	MIIM_CMD_LEGACY_READ,
> +};
> +
> +enum xgene_mdio_id {
> +	XGENE_MDIO_RGMII = 1,
> +	XGENE_MDIO_XFI
> +};
> +
> +struct xgene_mdio_pdata {
> +	struct clk *clk;
> +	struct device *dev;
> +	void __iomem *mac_csr_addr;
> +	void __iomem *diag_csr_addr;
> +	void __iomem *mdio_csr_addr;
> +	int mdio_id;
> +};
> +
> +/* Set the specified value into a bit-field defined by its starting position
> + * and length within a single u64.
> + */
> +static inline u64 xgene_enet_set_field_value(int pos, int len, u64 val)
> +{
> +	return (val & ((1ULL << len) - 1)) << pos;
> +}
> +
> +#define SET_VAL(field, val) \
> +		xgene_enet_set_field_value(field ## _POS, field ## _LEN, val)
> +
> +#define SET_BIT(field) \
> +		xgene_enet_set_field_value(field ## _POS, 1, 1)

This is not used in the patch.

Regards,
Matthias

> +
> +/* Get the value from a bit-field defined by its starting position
> + * and length within the specified u64.
> + */
> +static inline u64 xgene_enet_get_field_value(int pos, int len, u64 src)
> +{
> +	return (src >> pos) & ((1ULL << len) - 1);
> +}
> +
> +#define GET_VAL(field, src) \
> +		xgene_enet_get_field_value(field ## _POS, field ## _LEN, src)
> +
> +#define GET_BIT(field, src) \
> +		xgene_enet_get_field_value(field ## _POS, 1, src)
> +
> +static const struct of_device_id xgene_mdio_of_match[];
> +#ifdef CONFIG_ACPI
> +static const struct acpi_device_id xgene_mdio_acpi_match[];
> +#endif
> +bool xgene_mdio_probe_successful(void);
> +
> +#endif  /* __MDIO_XGENE_H__ */
>



More information about the linux-arm-kernel mailing list