xref: /linux/drivers/net/phy/bcm87xx.c (revision 0ea5c948cb64bab5bc7a5516774eb8536f05aa0d)
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 MODULE_DESCRIPTION("Broadcom BCM87xx PHY driver");
227