]> git.kernelconcepts.de Git - karo-tx-linux.git/commitdiff
net: add Hisilicon Network Subsystem MDIO support
authorhuangdaode <huangdaode@hisilicon.com>
Thu, 17 Sep 2015 06:51:47 +0000 (14:51 +0800)
committerDavid S. Miller <davem@davemloft.net>
Mon, 21 Sep 2015 04:42:57 +0000 (21:42 -0700)
The MDIO support for Hisilicon Network Subsystem. It is used in Hislicon
hip04, hip05 and Hi1610 SoC to control the external PHY

Signed-off-by: huangdaode <huangdaode@hisilicon.com>
Signed-off-by: Yisen Zhuang <Yisen.Zhuang@huawei.com>
Signed-off-by: Kenneth Lee <liguozhu@huawei.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/ethernet/hisilicon/Kconfig
drivers/net/ethernet/hisilicon/Makefile
drivers/net/ethernet/hisilicon/hip04_mdio.c [deleted file]
drivers/net/ethernet/hisilicon/hns_mdio.c [new file with mode: 0644]

index dead17b5d769ca9639b879b9ef48b4e4e3679d44..9184f1d0f92b5ad827c2f10f7e77856133a13c49 100644 (file)
@@ -5,7 +5,7 @@
 config NET_VENDOR_HISILICON
        bool "Hisilicon devices"
        default y
-       depends on ARM
+       depends on ARM || ARM64
        ---help---
          If you have a network (Ethernet) card belonging to this class, say Y.
 
@@ -27,8 +27,16 @@ config HIP04_ETH
        select PHYLIB
        select MARVELL_PHY
        select MFD_SYSCON
+       select HNS_MDIO
        ---help---
          If you wish to compile a kernel for a hardware with hisilicon p04 SoC and
          want to use the internal ethernet then you should answer Y to this.
 
+config HNS_MDIO
+       tristate "Hisilicon HNS MDIO device Support"
+       select MDIO
+       ---help---
+         This selects the HNS MDIO support. It is needed by HNS_DSAF to access
+         the PHY
+
 endif # NET_VENDOR_HISILICON
index 6c14540a4dc5e18c6049aaa24e6e8184af99ddd7..04b4b2177ff48d434e368485f0d433cd71c5c105 100644 (file)
@@ -3,4 +3,5 @@
 #
 
 obj-$(CONFIG_HIX5HD2_GMAC) += hix5hd2_gmac.o
-obj-$(CONFIG_HIP04_ETH) += hip04_mdio.o hip04_eth.o
+obj-$(CONFIG_HIP04_ETH) += hip04_eth.o
+obj-$(CONFIG_HNS_MDIO) += hns_mdio.o
diff --git a/drivers/net/ethernet/hisilicon/hip04_mdio.c b/drivers/net/ethernet/hisilicon/hip04_mdio.c
deleted file mode 100644 (file)
index fca0a5b..0000000
+++ /dev/null
@@ -1,185 +0,0 @@
-/* Copyright (c) 2014 Linaro Ltd.
- * Copyright (c) 2014 Hisilicon Limited.
- *
- * 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.
- */
-
-#include <linux/module.h>
-#include <linux/platform_device.h>
-#include <linux/io.h>
-#include <linux/of_mdio.h>
-#include <linux/delay.h>
-
-#define MDIO_CMD_REG           0x0
-#define MDIO_ADDR_REG          0x4
-#define MDIO_WDATA_REG         0x8
-#define MDIO_RDATA_REG         0xc
-#define MDIO_STA_REG           0x10
-
-#define MDIO_START             BIT(14)
-#define MDIO_R_VALID           BIT(1)
-#define MDIO_READ              (BIT(12) | BIT(11) | MDIO_START)
-#define MDIO_WRITE             (BIT(12) | BIT(10) | MDIO_START)
-
-struct hip04_mdio_priv {
-       void __iomem *base;
-};
-
-#define WAIT_TIMEOUT 10
-static int hip04_mdio_wait_ready(struct mii_bus *bus)
-{
-       struct hip04_mdio_priv *priv = bus->priv;
-       int i;
-
-       for (i = 0; readl_relaxed(priv->base + MDIO_CMD_REG) & MDIO_START; i++) {
-               if (i == WAIT_TIMEOUT)
-                       return -ETIMEDOUT;
-               msleep(20);
-       }
-
-       return 0;
-}
-
-static int hip04_mdio_read(struct mii_bus *bus, int mii_id, int regnum)
-{
-       struct hip04_mdio_priv *priv = bus->priv;
-       u32 val;
-       int ret;
-
-       ret = hip04_mdio_wait_ready(bus);
-       if (ret < 0)
-               goto out;
-
-       val = regnum | (mii_id << 5) | MDIO_READ;
-       writel_relaxed(val, priv->base + MDIO_CMD_REG);
-
-       ret = hip04_mdio_wait_ready(bus);
-       if (ret < 0)
-               goto out;
-
-       val = readl_relaxed(priv->base + MDIO_STA_REG);
-       if (val & MDIO_R_VALID) {
-               dev_err(bus->parent, "SMI bus read not valid\n");
-               ret = -ENODEV;
-               goto out;
-       }
-
-       val = readl_relaxed(priv->base + MDIO_RDATA_REG);
-       ret = val & 0xFFFF;
-out:
-       return ret;
-}
-
-static int hip04_mdio_write(struct mii_bus *bus, int mii_id,
-                           int regnum, u16 value)
-{
-       struct hip04_mdio_priv *priv = bus->priv;
-       u32 val;
-       int ret;
-
-       ret = hip04_mdio_wait_ready(bus);
-       if (ret < 0)
-               goto out;
-
-       writel_relaxed(value, priv->base + MDIO_WDATA_REG);
-       val = regnum | (mii_id << 5) | MDIO_WRITE;
-       writel_relaxed(val, priv->base + MDIO_CMD_REG);
-out:
-       return ret;
-}
-
-static int hip04_mdio_reset(struct mii_bus *bus)
-{
-       int temp, i;
-
-       for (i = 0; i < PHY_MAX_ADDR; i++) {
-               hip04_mdio_write(bus, i, 22, 0);
-               temp = hip04_mdio_read(bus, i, MII_BMCR);
-               if (temp < 0)
-                       continue;
-
-               temp |= BMCR_RESET;
-               if (hip04_mdio_write(bus, i, MII_BMCR, temp) < 0)
-                       continue;
-       }
-
-       mdelay(500);
-       return 0;
-}
-
-static int hip04_mdio_probe(struct platform_device *pdev)
-{
-       struct resource *r;
-       struct mii_bus *bus;
-       struct hip04_mdio_priv *priv;
-       int ret;
-
-       bus = mdiobus_alloc_size(sizeof(struct hip04_mdio_priv));
-       if (!bus) {
-               dev_err(&pdev->dev, "Cannot allocate MDIO bus\n");
-               return -ENOMEM;
-       }
-
-       bus->name = "hip04_mdio_bus";
-       bus->read = hip04_mdio_read;
-       bus->write = hip04_mdio_write;
-       bus->reset = hip04_mdio_reset;
-       snprintf(bus->id, MII_BUS_ID_SIZE, "%s-mii", dev_name(&pdev->dev));
-       bus->parent = &pdev->dev;
-       priv = bus->priv;
-
-       r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
-       priv->base = devm_ioremap_resource(&pdev->dev, r);
-       if (IS_ERR(priv->base)) {
-               ret = PTR_ERR(priv->base);
-               goto out_mdio;
-       }
-
-       ret = of_mdiobus_register(bus, pdev->dev.of_node);
-       if (ret < 0) {
-               dev_err(&pdev->dev, "Cannot register MDIO bus (%d)\n", ret);
-               goto out_mdio;
-       }
-
-       platform_set_drvdata(pdev, bus);
-
-       return 0;
-
-out_mdio:
-       mdiobus_free(bus);
-       return ret;
-}
-
-static int hip04_mdio_remove(struct platform_device *pdev)
-{
-       struct mii_bus *bus = platform_get_drvdata(pdev);
-
-       mdiobus_unregister(bus);
-       mdiobus_free(bus);
-
-       return 0;
-}
-
-static const struct of_device_id hip04_mdio_match[] = {
-       { .compatible = "hisilicon,hip04-mdio" },
-       { }
-};
-MODULE_DEVICE_TABLE(of, hip04_mdio_match);
-
-static struct platform_driver hip04_mdio_driver = {
-       .probe = hip04_mdio_probe,
-       .remove = hip04_mdio_remove,
-       .driver = {
-               .name = "hip04-mdio",
-               .of_match_table = hip04_mdio_match,
-       },
-};
-
-module_platform_driver(hip04_mdio_driver);
-
-MODULE_DESCRIPTION("HISILICON P04 MDIO interface driver");
-MODULE_LICENSE("GPL v2");
-MODULE_ALIAS("platform:hip04-mdio");
diff --git a/drivers/net/ethernet/hisilicon/hns_mdio.c b/drivers/net/ethernet/hisilicon/hns_mdio.c
new file mode 100644 (file)
index 0000000..e4ec52a
--- /dev/null
@@ -0,0 +1,520 @@
+/*
+ * Copyright (c) 2014-2015 Hisilicon Limited.
+ *
+ * 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.
+ */
+
+#include <linux/errno.h>
+#include <linux/etherdevice.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/netdevice.h>
+#include <linux/of_address.h>
+#include <linux/of.h>
+#include <linux/of_mdio.h>
+#include <linux/of_platform.h>
+#include <linux/phy.h>
+#include <linux/platform_device.h>
+#include <linux/spinlock_types.h>
+
+#define MDIO_DRV_NAME "Hi-HNS_MDIO"
+#define MDIO_BUS_NAME "Hisilicon MII Bus"
+#define MDIO_DRV_VERSION "1.3.0"
+#define MDIO_COPYRIGHT "Copyright(c) 2015 Huawei Corporation."
+#define MDIO_DRV_STRING MDIO_BUS_NAME
+#define MDIO_DEFAULT_DEVICE_DESCR MDIO_BUS_NAME
+
+#define MDIO_CTL_DEV_ADDR(x)   (x & 0x1f)
+#define MDIO_CTL_PORT_ADDR(x)  ((x & 0x1f) << 5)
+
+#define MDIO_TIMEOUT                   1000000
+
+struct hns_mdio_device {
+       void *vbase;            /* mdio reg base address */
+       void *sys_vbase;
+};
+
+/* mdio reg */
+#define MDIO_COMMAND_REG               0x0
+#define MDIO_ADDR_REG                  0x4
+#define MDIO_WDATA_REG                 0x8
+#define MDIO_RDATA_REG                 0xc
+#define MDIO_STA_REG                   0x10
+
+/* cfg phy bit map */
+#define MDIO_CMD_DEVAD_M       0x1f
+#define MDIO_CMD_DEVAD_S       0
+#define MDIO_CMD_PRTAD_M       0x1f
+#define MDIO_CMD_PRTAD_S       5
+#define MDIO_CMD_OP_M          0x3
+#define MDIO_CMD_OP_S          10
+#define MDIO_CMD_ST_M          0x3
+#define MDIO_CMD_ST_S          12
+#define MDIO_CMD_START_B       14
+
+#define MDIO_ADDR_DATA_M       0xffff
+#define MDIO_ADDR_DATA_S       0
+
+#define MDIO_WDATA_DATA_M      0xffff
+#define MDIO_WDATA_DATA_S      0
+
+#define MDIO_RDATA_DATA_M      0xffff
+#define MDIO_RDATA_DATA_S      0
+
+#define MDIO_STATE_STA_B       0
+
+enum mdio_st_clause {
+       MDIO_ST_CLAUSE_45 = 0,
+       MDIO_ST_CLAUSE_22
+};
+
+enum mdio_c22_op_seq {
+       MDIO_C22_WRITE = 1,
+       MDIO_C22_READ = 2
+};
+
+enum mdio_c45_op_seq {
+       MDIO_C45_WRITE_ADDR = 0,
+       MDIO_C45_WRITE_DATA,
+       MDIO_C45_READ_INCREMENT,
+       MDIO_C45_READ
+};
+
+/* peri subctrl reg */
+#define MDIO_SC_CLK_EN         0x338
+#define MDIO_SC_CLK_DIS                0x33C
+#define MDIO_SC_RESET_REQ      0xA38
+#define MDIO_SC_RESET_DREQ     0xA3C
+#define MDIO_SC_CTRL           0x2010
+#define MDIO_SC_CLK_ST         0x531C
+#define MDIO_SC_RESET_ST       0x5A1C
+
+static void mdio_write_reg(void *base, u32 reg, u32 value)
+{
+       u8 __iomem *reg_addr = (u8 __iomem *)base;
+
+       writel_relaxed(value, reg_addr + reg);
+}
+
+#define MDIO_WRITE_REG(a, reg, value) \
+       mdio_write_reg((a)->vbase, (reg), (value))
+
+static u32 mdio_read_reg(void *base, u32 reg)
+{
+       u8 __iomem *reg_addr = (u8 __iomem *)base;
+
+       return readl_relaxed(reg_addr + reg);
+}
+
+#define mdio_set_field(origin, mask, shift, val) \
+       do { \
+               (origin) &= (~((mask) << (shift))); \
+               (origin) |= (((val) & (mask)) << (shift)); \
+       } while (0)
+
+#define mdio_get_field(origin, mask, shift) (((origin) >> (shift)) & (mask))
+
+static void mdio_set_reg_field(void *base, u32 reg, u32 mask, u32 shift,
+                              u32 val)
+{
+       u32 origin = mdio_read_reg(base, reg);
+
+       mdio_set_field(origin, mask, shift, val);
+       mdio_write_reg(base, reg, origin);
+}
+
+#define MDIO_SET_REG_FIELD(dev, reg, mask, shift, val) \
+       mdio_set_reg_field((dev)->vbase, (reg), (mask), (shift), (val))
+
+static u32 mdio_get_reg_field(void *base, u32 reg, u32 mask, u32 shift)
+{
+       u32 origin;
+
+       origin = mdio_read_reg(base, reg);
+       return mdio_get_field(origin, mask, shift);
+}
+
+#define MDIO_GET_REG_FIELD(dev, reg, mask, shift) \
+               mdio_get_reg_field((dev)->vbase, (reg), (mask), (shift))
+
+#define MDIO_GET_REG_BIT(dev, reg, bit) \
+               mdio_get_reg_field((dev)->vbase, (reg), 0x1ull, (bit))
+
+#define MDIO_CHECK_SET_ST      1
+#define MDIO_CHECK_CLR_ST      0
+
+static int mdio_sc_cfg_reg_write(struct hns_mdio_device *mdio_dev,
+                                u32 cfg_reg, u32 set_val,
+                                u32 st_reg, u32 st_msk, u8 check_st)
+{
+       u32 time_cnt;
+       u32 reg_value;
+
+       mdio_write_reg((void *)mdio_dev->sys_vbase, cfg_reg, set_val);
+
+       for (time_cnt = MDIO_TIMEOUT; time_cnt; time_cnt--) {
+               reg_value = mdio_read_reg((void *)mdio_dev->sys_vbase, st_reg);
+               reg_value &= st_msk;
+               if ((!!check_st) == (!!reg_value))
+                       break;
+       }
+
+       if ((!!check_st) != (!!reg_value))
+               return -EBUSY;
+
+       return 0;
+}
+
+static int hns_mdio_wait_ready(struct mii_bus *bus)
+{
+       struct hns_mdio_device *mdio_dev = bus->priv;
+       int i;
+       u32 cmd_reg_value = 1;
+
+       /* waitting for MDIO_COMMAND_REG 's mdio_start==0 */
+       /* after that can do read or write*/
+       for (i = 0; cmd_reg_value; i++) {
+               cmd_reg_value = MDIO_GET_REG_BIT(mdio_dev,
+                                                MDIO_COMMAND_REG,
+                                                MDIO_CMD_START_B);
+               if (i == MDIO_TIMEOUT)
+                       return -ETIMEDOUT;
+       }
+
+       return 0;
+}
+
+static void hns_mdio_cmd_write(struct hns_mdio_device *mdio_dev,
+                              u8 is_c45, u8 op, u8 phy_id, u16 cmd)
+{
+       u32 cmd_reg_value;
+       u8 st = is_c45 ? MDIO_ST_CLAUSE_45 : MDIO_ST_CLAUSE_22;
+
+       cmd_reg_value = st << MDIO_CMD_ST_S;
+       cmd_reg_value |= op << MDIO_CMD_OP_S;
+       cmd_reg_value |=
+               (phy_id & MDIO_CMD_PRTAD_M) << MDIO_CMD_PRTAD_S;
+       cmd_reg_value |= (cmd & MDIO_CMD_DEVAD_M) << MDIO_CMD_DEVAD_S;
+       cmd_reg_value |= 1 << MDIO_CMD_START_B;
+
+       MDIO_WRITE_REG(mdio_dev, MDIO_COMMAND_REG, cmd_reg_value);
+}
+
+/**
+ * hns_mdio_write - access phy register
+ * @bus: mdio bus
+ * @phy_id: phy id
+ * @regnum: register num
+ * @value: register value
+ *
+ * Return 0 on success, negative on failure
+ */
+static int hns_mdio_write(struct mii_bus *bus,
+                         int phy_id, int regnum, u16 data)
+{
+       int ret;
+       struct hns_mdio_device *mdio_dev = (struct hns_mdio_device *)bus->priv;
+       u8 devad = ((regnum >> 16) & 0x1f);
+       u8 is_c45 = !!(regnum & MII_ADDR_C45);
+       u16 reg = (u16)(regnum & 0xffff);
+       u8 op;
+       u16 cmd_reg_cfg;
+
+       dev_dbg(&bus->dev, "mdio write %s,base is %p\n",
+               bus->id, mdio_dev->vbase);
+       dev_dbg(&bus->dev, "phy id=%d, is_c45=%d, devad=%d, reg=%#x, write data=%d\n",
+               phy_id, is_c45, devad, reg, data);
+
+       /* wait for ready */
+       ret = hns_mdio_wait_ready(bus);
+       if (ret) {
+               dev_err(&bus->dev, "MDIO bus is busy\n");
+               return ret;
+       }
+
+       if (!is_c45) {
+               cmd_reg_cfg = reg;
+               op = MDIO_C22_WRITE;
+       } else {
+               /* config the cmd-reg to write addr*/
+               MDIO_SET_REG_FIELD(mdio_dev, MDIO_ADDR_REG, MDIO_ADDR_DATA_M,
+                                  MDIO_ADDR_DATA_S, reg);
+
+               hns_mdio_cmd_write(mdio_dev, is_c45,
+                                  MDIO_C45_WRITE_ADDR, phy_id, devad);
+
+               /* check for read or write opt is finished */
+               ret = hns_mdio_wait_ready(bus);
+               if (ret) {
+                       dev_err(&bus->dev, "MDIO bus is busy\n");
+                       return ret;
+               }
+
+               /* config the data needed writing */
+               cmd_reg_cfg = devad;
+               op = MDIO_C45_WRITE_ADDR;
+       }
+
+       MDIO_SET_REG_FIELD(mdio_dev, MDIO_WDATA_REG, MDIO_WDATA_DATA_M,
+                          MDIO_WDATA_DATA_S, data);
+
+       hns_mdio_cmd_write(mdio_dev, is_c45, op, phy_id, cmd_reg_cfg);
+
+       return 0;
+}
+
+/**
+ * hns_mdio_read - access phy register
+ * @bus: mdio bus
+ * @phy_id: phy id
+ * @regnum: register num
+ * @value: register value
+ *
+ * Return phy register value
+ */
+static int hns_mdio_read(struct mii_bus *bus, int phy_id, int regnum)
+{
+       int ret;
+       u16 reg_val = 0;
+       u8 devad = ((regnum >> 16) & 0x1f);
+       u8 is_c45 = !!(regnum & MII_ADDR_C45);
+       u16 reg = (u16)(regnum & 0xffff);
+       struct hns_mdio_device *mdio_dev = (struct hns_mdio_device *)bus->priv;
+
+       dev_dbg(&bus->dev, "mdio read %s,base is %p\n",
+               bus->id, mdio_dev->vbase);
+       dev_dbg(&bus->dev, "phy id=%d, is_c45=%d, devad=%d, reg=%#x!\n",
+               phy_id, is_c45, devad, reg);
+
+       /* Step 1: wait for ready */
+       ret = hns_mdio_wait_ready(bus);
+       if (ret) {
+               dev_err(&bus->dev, "MDIO bus is busy\n");
+               return ret;
+       }
+
+       if (!is_c45) {
+               hns_mdio_cmd_write(mdio_dev, is_c45,
+                                  MDIO_C22_READ, phy_id, reg);
+       } else {
+               MDIO_SET_REG_FIELD(mdio_dev, MDIO_ADDR_REG, MDIO_ADDR_DATA_M,
+                                  MDIO_ADDR_DATA_S, reg);
+
+               /* Step 2; config the cmd-reg to write addr*/
+               hns_mdio_cmd_write(mdio_dev, is_c45,
+                                  MDIO_C45_WRITE_ADDR, phy_id, devad);
+
+               /* Step 3: check for read or write opt is finished */
+               ret = hns_mdio_wait_ready(bus);
+               if (ret) {
+                       dev_err(&bus->dev, "MDIO bus is busy\n");
+                       return ret;
+               }
+
+               hns_mdio_cmd_write(mdio_dev, is_c45,
+                                  MDIO_C45_WRITE_ADDR, phy_id, devad);
+       }
+
+       /* Step 5: waitting for MDIO_COMMAND_REG 's mdio_start==0,*/
+       /* check for read or write opt is finished */
+       ret = hns_mdio_wait_ready(bus);
+       if (ret) {
+               dev_err(&bus->dev, "MDIO bus is busy\n");
+               return ret;
+       }
+
+       reg_val = MDIO_GET_REG_BIT(mdio_dev, MDIO_STA_REG, MDIO_STATE_STA_B);
+       if (reg_val) {
+               dev_err(&bus->dev, " ERROR! MDIO Read failed!\n");
+               return -EBUSY;
+       }
+
+       /* Step 6; get out data*/
+       reg_val = (u16)MDIO_GET_REG_FIELD(mdio_dev, MDIO_RDATA_REG,
+                                         MDIO_RDATA_DATA_M, MDIO_RDATA_DATA_S);
+
+       return reg_val;
+}
+
+/**
+ * hns_mdio_reset - reset mdio bus
+ * @bus: mdio bus
+ *
+ * Return 0 on success, negative on failure
+ */
+static int hns_mdio_reset(struct mii_bus *bus)
+{
+       struct hns_mdio_device *mdio_dev = (struct hns_mdio_device *)bus->priv;
+       int ret;
+
+       if (!mdio_dev->sys_vbase) {
+               dev_err(&bus->dev, "mdio sys ctl reg has not maped\n");
+               return -ENODEV;
+       }
+
+       /*1. reset req, and read reset st check*/
+       ret = mdio_sc_cfg_reg_write(mdio_dev, MDIO_SC_RESET_REQ, 0x1,
+                                   MDIO_SC_RESET_ST, 0x1,
+                                   MDIO_CHECK_SET_ST);
+       if (ret) {
+               dev_err(&bus->dev, "MDIO reset fail\n");
+               return ret;
+       }
+
+       /*2. dis clk, and read clk st check*/
+       ret = mdio_sc_cfg_reg_write(mdio_dev, MDIO_SC_CLK_DIS,
+                                   0x1, MDIO_SC_CLK_ST, 0x1,
+                                   MDIO_CHECK_CLR_ST);
+       if (ret) {
+               dev_err(&bus->dev, "MDIO dis clk fail\n");
+               return ret;
+       }
+
+       /*3. reset dreq, and read reset st check*/
+       ret = mdio_sc_cfg_reg_write(mdio_dev, MDIO_SC_RESET_DREQ, 0x1,
+                                   MDIO_SC_RESET_ST, 0x1,
+                                   MDIO_CHECK_CLR_ST);
+       if (ret) {
+               dev_err(&bus->dev, "MDIO dis clk fail\n");
+               return ret;
+       }
+
+       /*4. en clk, and read clk st check*/
+       ret = mdio_sc_cfg_reg_write(mdio_dev, MDIO_SC_CLK_EN,
+                                   0x1, MDIO_SC_CLK_ST, 0x1,
+                                   MDIO_CHECK_SET_ST);
+       if (ret)
+               dev_err(&bus->dev, "MDIO en clk fail\n");
+
+       return ret;
+}
+
+/**
+ * hns_mdio_bus_name - get mdio bus name
+ * @name: mdio bus name
+ * @np: mdio device node pointer
+ */
+static void hns_mdio_bus_name(char *name, struct device_node *np)
+{
+       const u32 *addr;
+       u64 taddr = OF_BAD_ADDR;
+
+       addr = of_get_address(np, 0, NULL, NULL);
+       if (addr)
+               taddr = of_translate_address(np, addr);
+
+       snprintf(name, MII_BUS_ID_SIZE, "%s@%llx", np->name,
+                (unsigned long long)taddr);
+}
+
+/**
+ * hns_mdio_probe - probe mdio device
+ * @pdev: mdio platform device
+ *
+ * Return 0 on success, negative on failure
+ */
+static int hns_mdio_probe(struct platform_device *pdev)
+{
+       struct device_node *np;
+       struct hns_mdio_device *mdio_dev;
+       struct mii_bus *new_bus;
+       struct resource *res;
+       int ret;
+
+       if (!pdev) {
+               dev_err(NULL, "pdev is NULL!\r\n");
+               return -ENODEV;
+       }
+       np = pdev->dev.of_node;
+       mdio_dev = devm_kzalloc(&pdev->dev, sizeof(*mdio_dev), GFP_KERNEL);
+       if (!mdio_dev)
+               return -ENOMEM;
+
+       new_bus = devm_mdiobus_alloc(&pdev->dev);
+       if (!new_bus) {
+               dev_err(&pdev->dev, "mdiobus_alloc fail!\n");
+               return -ENOMEM;
+       }
+
+       new_bus->name = MDIO_BUS_NAME;
+       new_bus->read = hns_mdio_read;
+       new_bus->write = hns_mdio_write;
+       new_bus->reset = hns_mdio_reset;
+       new_bus->priv = mdio_dev;
+       hns_mdio_bus_name(new_bus->id, np);
+
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       mdio_dev->vbase = devm_ioremap_resource(&pdev->dev, res);
+       if (IS_ERR(mdio_dev->vbase)) {
+               ret = PTR_ERR(mdio_dev->vbase);
+               return ret;
+       }
+
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+       mdio_dev->sys_vbase = devm_ioremap_resource(&pdev->dev, res);
+       if (IS_ERR(mdio_dev->sys_vbase)) {
+               ret = PTR_ERR(mdio_dev->sys_vbase);
+               return ret;
+       }
+
+       new_bus->irq = devm_kcalloc(&pdev->dev, PHY_MAX_ADDR,
+                                   sizeof(int), GFP_KERNEL);
+       if (!new_bus->irq)
+               return -ENOMEM;
+
+       new_bus->parent = &pdev->dev;
+       platform_set_drvdata(pdev, new_bus);
+
+       ret = of_mdiobus_register(new_bus, np);
+       if (ret) {
+               dev_err(&pdev->dev, "Cannot register as MDIO bus!\n");
+               platform_set_drvdata(pdev, NULL);
+               return ret;
+       }
+
+       return 0;
+}
+
+/**
+ * hns_mdio_remove - remove mdio device
+ * @pdev: mdio platform device
+ *
+ * Return 0 on success, negative on failure
+ */
+static int hns_mdio_remove(struct platform_device *pdev)
+{
+       struct mii_bus *bus;
+
+       bus = platform_get_drvdata(pdev);
+
+       mdiobus_unregister(bus);
+       platform_set_drvdata(pdev, NULL);
+       return 0;
+}
+
+static const struct of_device_id hns_mdio_match[] = {
+       {.compatible = "hisilicon,mdio"},
+       {.compatible = "hisilicon,hns-mdio"},
+       {}
+};
+
+static struct platform_driver hns_mdio_driver = {
+       .probe = hns_mdio_probe,
+       .remove = hns_mdio_remove,
+       .driver = {
+                  .name = MDIO_DRV_NAME,
+                  .of_match_table = hns_mdio_match,
+                  },
+};
+
+module_platform_driver(hns_mdio_driver);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Huawei Tech. Co., Ltd.");
+MODULE_DESCRIPTION("Hisilicon HNS MDIO driver");
+MODULE_ALIAS("platform:" MDIO_DRV_NAME);