1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2011 - 2012 Cavium, Inc.
4 */
5
6 #include <linux/module.h>
7 #include <linux/phy.h>
8 #include <linux/of.h>
9
10 #define PHY_ID_BCM8706 0x0143bdc1
11 #define PHY_ID_BCM8727 0x0143bff0
12
13 #define BCM87XX_PMD_RX_SIGNAL_DETECT 0x000a
14 #define BCM87XX_10GBASER_PCS_STATUS 0x0020
15 #define BCM87XX_XGXS_LANE_STATUS 0x0018
16
17 #define BCM87XX_LASI_CONTROL 0x9002
18 #define BCM87XX_LASI_STATUS 0x9005
19
20 #if IS_ENABLED(CONFIG_OF_MDIO)
21 /* Set and/or override some configuration registers based on the
22 * broadcom,c45-reg-init property stored in the of_node for the phydev.
23 *
24 * broadcom,c45-reg-init = <devid reg mask value>,...;
25 *
26 * There may be one or more sets of <devid reg mask value>:
27 *
28 * devid: which sub-device to use.
29 * reg: the register.
30 * mask: if non-zero, ANDed with existing register value.
31 * value: ORed with the masked value and written to the regiser.
32 *
33 */
bcm87xx_of_reg_init(struct phy_device * phydev)34 static int bcm87xx_of_reg_init(struct phy_device *phydev)
35 {
36 const __be32 *paddr;
37 const __be32 *paddr_end;
38 int len, ret;
39
40 if (!phydev->mdio.dev.of_node)
41 return 0;
42
43 paddr = of_get_property(phydev->mdio.dev.of_node,
44 "broadcom,c45-reg-init", &len);
45 if (!paddr)
46 return 0;
47
48 paddr_end = paddr + (len /= sizeof(*paddr));
49
50 ret = 0;
51
52 while (paddr + 3 < paddr_end) {
53 u16 devid = be32_to_cpup(paddr++);
54 u16 reg = be32_to_cpup(paddr++);
55 u16 mask = be32_to_cpup(paddr++);
56 u16 val_bits = be32_to_cpup(paddr++);
57 int val = 0;
58
59 if (mask) {
60 val = phy_read_mmd(phydev, devid, reg);
61 if (val < 0) {
62 ret = val;
63 goto err;
64 }
65 val &= mask;
66 }
67 val |= val_bits;
68
69 ret = phy_write_mmd(phydev, devid, reg, val);
70 if (ret < 0)
71 goto err;
72 }
73 err:
74 return ret;
75 }
76 #else
bcm87xx_of_reg_init(struct phy_device * phydev)77 static int bcm87xx_of_reg_init(struct phy_device *phydev)
78 {
79 return 0;
80 }
81 #endif /* CONFIG_OF_MDIO */
82
bcm87xx_get_features(struct phy_device * phydev)83 static int bcm87xx_get_features(struct phy_device *phydev)
84 {
85 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseR_FEC_BIT,
86 phydev->supported);
87 return 0;
88 }
89
bcm87xx_config_init(struct phy_device * phydev)90 static int bcm87xx_config_init(struct phy_device *phydev)
91 {
92 return bcm87xx_of_reg_init(phydev);
93 }
94
bcm87xx_config_aneg(struct phy_device * phydev)95 static int bcm87xx_config_aneg(struct phy_device *phydev)
96 {
97 return -EINVAL;
98 }
99
bcm87xx_read_status(struct phy_device * phydev)100 static int bcm87xx_read_status(struct phy_device *phydev)
101 {
102 int rx_signal_detect;
103 int pcs_status;
104 int xgxs_lane_status;
105
106 rx_signal_detect = phy_read_mmd(phydev, MDIO_MMD_PMAPMD,
107 BCM87XX_PMD_RX_SIGNAL_DETECT);
108 if (rx_signal_detect < 0)
109 return rx_signal_detect;
110
111 if ((rx_signal_detect & 1) == 0)
112 goto no_link;
113
114 pcs_status = phy_read_mmd(phydev, MDIO_MMD_PCS,
115 BCM87XX_10GBASER_PCS_STATUS);
116 if (pcs_status < 0)
117 return pcs_status;
118
119 if ((pcs_status & 1) == 0)
120 goto no_link;
121
122 xgxs_lane_status = phy_read_mmd(phydev, MDIO_MMD_PHYXS,
123 BCM87XX_XGXS_LANE_STATUS);
124 if (xgxs_lane_status < 0)
125 return xgxs_lane_status;
126
127 if ((xgxs_lane_status & 0x1000) == 0)
128 goto no_link;
129
130 phydev->speed = 10000;
131 phydev->link = 1;
132 phydev->duplex = 1;
133 return 0;
134
135 no_link:
136 phydev->link = 0;
137 return 0;
138 }
139
bcm87xx_config_intr(struct phy_device * phydev)140 static int bcm87xx_config_intr(struct phy_device *phydev)
141 {
142 int reg, err;
143
144 reg = phy_read_mmd(phydev, MDIO_MMD_PCS, BCM87XX_LASI_CONTROL);
145
146 if (reg < 0)
147 return reg;
148
149 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
150 err = phy_read_mmd(phydev, MDIO_MMD_PCS, BCM87XX_LASI_STATUS);
151 if (err)
152 return err;
153
154 reg |= 1;
155 err = phy_write_mmd(phydev, MDIO_MMD_PCS,
156 BCM87XX_LASI_CONTROL, reg);
157 } else {
158 reg &= ~1;
159 err = phy_write_mmd(phydev, MDIO_MMD_PCS,
160 BCM87XX_LASI_CONTROL, reg);
161 if (err)
162 return err;
163
164 err = phy_read_mmd(phydev, MDIO_MMD_PCS, BCM87XX_LASI_STATUS);
165 }
166
167 return err;
168 }
169
bcm87xx_handle_interrupt(struct phy_device * phydev)170 static irqreturn_t bcm87xx_handle_interrupt(struct phy_device *phydev)
171 {
172 int irq_status;
173
174 irq_status = phy_read(phydev, BCM87XX_LASI_STATUS);
175 if (irq_status < 0) {
176 phy_error(phydev);
177 return IRQ_NONE;
178 }
179
180 if (irq_status == 0)
181 return IRQ_NONE;
182
183 phy_trigger_machine(phydev);
184
185 return IRQ_HANDLED;
186 }
187
bcm8706_match_phy_device(struct phy_device * phydev)188 static int bcm8706_match_phy_device(struct phy_device *phydev)
189 {
190 return phydev->c45_ids.device_ids[4] == PHY_ID_BCM8706;
191 }
192
bcm8727_match_phy_device(struct phy_device * phydev)193 static int bcm8727_match_phy_device(struct phy_device *phydev)
194 {
195 return phydev->c45_ids.device_ids[4] == PHY_ID_BCM8727;
196 }
197
198 static struct phy_driver bcm87xx_driver[] = {
199 {
200 .phy_id = PHY_ID_BCM8706,
201 .phy_id_mask = 0xffffffff,
202 .name = "Broadcom BCM8706",
203 .get_features = bcm87xx_get_features,
204 .config_init = bcm87xx_config_init,
205 .config_aneg = bcm87xx_config_aneg,
206 .read_status = bcm87xx_read_status,
207 .config_intr = bcm87xx_config_intr,
208 .handle_interrupt = bcm87xx_handle_interrupt,
209 .match_phy_device = bcm8706_match_phy_device,
210 }, {
211 .phy_id = PHY_ID_BCM8727,
212 .phy_id_mask = 0xffffffff,
213 .name = "Broadcom BCM8727",
214 .get_features = bcm87xx_get_features,
215 .config_init = bcm87xx_config_init,
216 .config_aneg = bcm87xx_config_aneg,
217 .read_status = bcm87xx_read_status,
218 .config_intr = bcm87xx_config_intr,
219 .handle_interrupt = bcm87xx_handle_interrupt,
220 .match_phy_device = bcm8727_match_phy_device,
221 } };
222
223 module_phy_driver(bcm87xx_driver);
224
225 MODULE_LICENSE("GPL v2");
226