1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Applied Micro X-Gene SoC Ethernet v2 Driver
4 *
5 * Copyright (c) 2017, Applied Micro Circuits Corporation
6 * Author(s): Iyappan Subramanian <isubramanian@apm.com>
7 * Keyur Chudgar <kchudgar@apm.com>
8 */
9
10 #include "main.h"
11
xge_mdio_write(struct mii_bus * bus,int phy_id,int reg,u16 data)12 static int xge_mdio_write(struct mii_bus *bus, int phy_id, int reg, u16 data)
13 {
14 struct xge_pdata *pdata = bus->priv;
15 u32 done, val = 0;
16 u8 wait = 10;
17
18 SET_REG_BITS(&val, PHY_ADDR, phy_id);
19 SET_REG_BITS(&val, REG_ADDR, reg);
20 xge_wr_csr(pdata, MII_MGMT_ADDRESS, val);
21
22 xge_wr_csr(pdata, MII_MGMT_CONTROL, data);
23 do {
24 usleep_range(5, 10);
25 done = xge_rd_csr(pdata, MII_MGMT_INDICATORS);
26 } while ((done & MII_MGMT_BUSY) && wait--);
27
28 if (done & MII_MGMT_BUSY) {
29 dev_err(&bus->dev, "MII_MGMT write failed\n");
30 return -ETIMEDOUT;
31 }
32
33 return 0;
34 }
35
xge_mdio_read(struct mii_bus * bus,int phy_id,int reg)36 static int xge_mdio_read(struct mii_bus *bus, int phy_id, int reg)
37 {
38 struct xge_pdata *pdata = bus->priv;
39 u32 data, done, val = 0;
40 u8 wait = 10;
41
42 SET_REG_BITS(&val, PHY_ADDR, phy_id);
43 SET_REG_BITS(&val, REG_ADDR, reg);
44 xge_wr_csr(pdata, MII_MGMT_ADDRESS, val);
45
46 xge_wr_csr(pdata, MII_MGMT_COMMAND, MII_READ_CYCLE);
47 do {
48 usleep_range(5, 10);
49 done = xge_rd_csr(pdata, MII_MGMT_INDICATORS);
50 } while ((done & MII_MGMT_BUSY) && wait--);
51
52 if (done & MII_MGMT_BUSY) {
53 dev_err(&bus->dev, "MII_MGMT read failed\n");
54 return -ETIMEDOUT;
55 }
56
57 data = xge_rd_csr(pdata, MII_MGMT_STATUS);
58 xge_wr_csr(pdata, MII_MGMT_COMMAND, 0);
59
60 return data;
61 }
62
xge_adjust_link(struct net_device * ndev)63 static void xge_adjust_link(struct net_device *ndev)
64 {
65 struct xge_pdata *pdata = netdev_priv(ndev);
66 struct phy_device *phydev = ndev->phydev;
67
68 if (phydev->link) {
69 if (pdata->phy_speed != phydev->speed) {
70 pdata->phy_speed = phydev->speed;
71 xge_mac_set_speed(pdata);
72 xge_mac_enable(pdata);
73 phy_print_status(phydev);
74 }
75 } else {
76 if (pdata->phy_speed != SPEED_UNKNOWN) {
77 pdata->phy_speed = SPEED_UNKNOWN;
78 xge_mac_disable(pdata);
79 phy_print_status(phydev);
80 }
81 }
82 }
83
xge_mdio_remove(struct net_device * ndev)84 void xge_mdio_remove(struct net_device *ndev)
85 {
86 struct xge_pdata *pdata = netdev_priv(ndev);
87 struct mii_bus *mdio_bus = pdata->mdio_bus;
88
89 if (ndev->phydev)
90 phy_disconnect(ndev->phydev);
91
92 if (mdio_bus->state == MDIOBUS_REGISTERED)
93 mdiobus_unregister(mdio_bus);
94
95 mdiobus_free(mdio_bus);
96 }
97
xge_mdio_config(struct net_device * ndev)98 int xge_mdio_config(struct net_device *ndev)
99 {
100 struct xge_pdata *pdata = netdev_priv(ndev);
101 struct device *dev = &pdata->pdev->dev;
102 struct mii_bus *mdio_bus;
103 struct phy_device *phydev;
104 int ret;
105
106 mdio_bus = mdiobus_alloc();
107 if (!mdio_bus)
108 return -ENOMEM;
109
110 mdio_bus->name = "APM X-Gene Ethernet (v2) MDIO Bus";
111 mdio_bus->read = xge_mdio_read;
112 mdio_bus->write = xge_mdio_write;
113 mdio_bus->priv = pdata;
114 mdio_bus->parent = dev;
115 snprintf(mdio_bus->id, MII_BUS_ID_SIZE, "%s-mii", dev_name(dev));
116 pdata->mdio_bus = mdio_bus;
117
118 mdio_bus->phy_mask = 0x1;
119 ret = mdiobus_register(mdio_bus);
120 if (ret)
121 goto err;
122
123 phydev = phy_find_first(mdio_bus);
124 if (!phydev) {
125 dev_err(dev, "no PHY found\n");
126 ret = -ENODEV;
127 goto err;
128 }
129 phydev = phy_connect(ndev, phydev_name(phydev),
130 &xge_adjust_link,
131 pdata->resources.phy_mode);
132
133 if (IS_ERR(phydev)) {
134 netdev_err(ndev, "Could not attach to PHY\n");
135 ret = PTR_ERR(phydev);
136 goto err;
137 }
138
139 phy_remove_link_mode(phydev, ETHTOOL_LINK_MODE_10baseT_Half_BIT);
140 phy_remove_link_mode(phydev, ETHTOOL_LINK_MODE_10baseT_Full_BIT);
141 phy_remove_link_mode(phydev, ETHTOOL_LINK_MODE_100baseT_Half_BIT);
142 phy_remove_link_mode(phydev, ETHTOOL_LINK_MODE_100baseT_Full_BIT);
143 phy_remove_link_mode(phydev, ETHTOOL_LINK_MODE_1000baseT_Half_BIT);
144
145 pdata->phy_speed = SPEED_UNKNOWN;
146
147 return 0;
148 err:
149 xge_mdio_remove(ndev);
150
151 return ret;
152 }
153