2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
6 * Copyright (C) 2011 - 2012 Cavium, Inc.
9 #include <linux/module.h>
10 #include <linux/phy.h>
13 #define PHY_ID_BCM8706 0x0143bdc1
14 #define PHY_ID_BCM8727 0x0143bff0
16 #define BCM87XX_PMD_RX_SIGNAL_DETECT (MII_ADDR_C45 | 0x1000a)
17 #define BCM87XX_10GBASER_PCS_STATUS (MII_ADDR_C45 | 0x30020)
18 #define BCM87XX_XGXS_LANE_STATUS (MII_ADDR_C45 | 0x40018)
20 #define BCM87XX_LASI_CONTROL (MII_ADDR_C45 | 0x39002)
21 #define BCM87XX_LASI_STATUS (MII_ADDR_C45 | 0x39005)
23 #if IS_ENABLED(CONFIG_OF_MDIO)
24 /* Set and/or override some configuration registers based on the
25 * broadcom,c45-reg-init property stored in the of_node for the phydev.
27 * broadcom,c45-reg-init = <devid reg mask value>,...;
29 * There may be one or more sets of <devid reg mask value>:
31 * devid: which sub-device to use.
33 * mask: if non-zero, ANDed with existing register value.
34 * value: ORed with the masked value and written to the regiser.
37 static int bcm87xx_of_reg_init(struct phy_device
*phydev
)
40 const __be32
*paddr_end
;
43 if (!phydev
->mdio
.dev
.of_node
)
46 paddr
= of_get_property(phydev
->mdio
.dev
.of_node
,
47 "broadcom,c45-reg-init", &len
);
51 paddr_end
= paddr
+ (len
/= sizeof(*paddr
));
55 while (paddr
+ 3 < paddr_end
) {
56 u16 devid
= be32_to_cpup(paddr
++);
57 u16 reg
= be32_to_cpup(paddr
++);
58 u16 mask
= be32_to_cpup(paddr
++);
59 u16 val_bits
= be32_to_cpup(paddr
++);
61 u32 regnum
= MII_ADDR_C45
| (devid
<< 16) | reg
;
64 val
= phy_read(phydev
, regnum
);
73 ret
= phy_write(phydev
, regnum
, val
);
81 static int bcm87xx_of_reg_init(struct phy_device
*phydev
)
85 #endif /* CONFIG_OF_MDIO */
87 static int bcm87xx_config_init(struct phy_device
*phydev
)
89 linkmode_zero(phydev
->supported
);
90 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseR_FEC_BIT
,
92 linkmode_zero(phydev
->advertising
);
93 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseR_FEC_BIT
,
95 phydev
->state
= PHY_NOLINK
;
96 phydev
->autoneg
= AUTONEG_DISABLE
;
98 bcm87xx_of_reg_init(phydev
);
103 static int bcm87xx_config_aneg(struct phy_device
*phydev
)
108 static int bcm87xx_read_status(struct phy_device
*phydev
)
110 int rx_signal_detect
;
112 int xgxs_lane_status
;
114 rx_signal_detect
= phy_read(phydev
, BCM87XX_PMD_RX_SIGNAL_DETECT
);
115 if (rx_signal_detect
< 0)
116 return rx_signal_detect
;
118 if ((rx_signal_detect
& 1) == 0)
121 pcs_status
= phy_read(phydev
, BCM87XX_10GBASER_PCS_STATUS
);
125 if ((pcs_status
& 1) == 0)
128 xgxs_lane_status
= phy_read(phydev
, BCM87XX_XGXS_LANE_STATUS
);
129 if (xgxs_lane_status
< 0)
130 return xgxs_lane_status
;
132 if ((xgxs_lane_status
& 0x1000) == 0)
135 phydev
->speed
= 10000;
145 static int bcm87xx_config_intr(struct phy_device
*phydev
)
149 reg
= phy_read(phydev
, BCM87XX_LASI_CONTROL
);
154 if (phydev
->interrupts
== PHY_INTERRUPT_ENABLED
)
159 err
= phy_write(phydev
, BCM87XX_LASI_CONTROL
, reg
);
163 static int bcm87xx_did_interrupt(struct phy_device
*phydev
)
167 reg
= phy_read(phydev
, BCM87XX_LASI_STATUS
);
171 "Error: Read of BCM87XX_LASI_STATUS failed: %d\n",
175 return (reg
& 1) != 0;
178 static int bcm87xx_ack_interrupt(struct phy_device
*phydev
)
180 /* Reading the LASI status clears it. */
181 bcm87xx_did_interrupt(phydev
);
185 static int bcm8706_match_phy_device(struct phy_device
*phydev
)
187 return phydev
->c45_ids
.device_ids
[4] == PHY_ID_BCM8706
;
190 static int bcm8727_match_phy_device(struct phy_device
*phydev
)
192 return phydev
->c45_ids
.device_ids
[4] == PHY_ID_BCM8727
;
195 static struct phy_driver bcm87xx_driver
[] = {
197 .phy_id
= PHY_ID_BCM8706
,
198 .phy_id_mask
= 0xffffffff,
199 .name
= "Broadcom BCM8706",
200 .config_init
= bcm87xx_config_init
,
201 .config_aneg
= bcm87xx_config_aneg
,
202 .read_status
= bcm87xx_read_status
,
203 .ack_interrupt
= bcm87xx_ack_interrupt
,
204 .config_intr
= bcm87xx_config_intr
,
205 .did_interrupt
= bcm87xx_did_interrupt
,
206 .match_phy_device
= bcm8706_match_phy_device
,
208 .phy_id
= PHY_ID_BCM8727
,
209 .phy_id_mask
= 0xffffffff,
210 .name
= "Broadcom BCM8727",
211 .config_init
= bcm87xx_config_init
,
212 .config_aneg
= bcm87xx_config_aneg
,
213 .read_status
= bcm87xx_read_status
,
214 .ack_interrupt
= bcm87xx_ack_interrupt
,
215 .config_intr
= bcm87xx_config_intr
,
216 .did_interrupt
= bcm87xx_did_interrupt
,
217 .match_phy_device
= bcm8727_match_phy_device
,
220 module_phy_driver(bcm87xx_driver
);
222 MODULE_LICENSE("GPL");