]>
Commit | Line | Data |
---|---|---|
e9976d7c DD |
1 | /* |
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 | |
4 | * for more details. | |
5 | * | |
6 | * Copyright (C) 2011 - 2012 Cavium, Inc. | |
7 | */ | |
8 | ||
9 | #include <linux/module.h> | |
10 | #include <linux/phy.h> | |
11 | #include <linux/of.h> | |
12 | ||
13 | #define PHY_ID_BCM8706 0x0143bdc1 | |
14 | #define PHY_ID_BCM8727 0x0143bff0 | |
15 | ||
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) | |
19 | ||
20 | #define BCM87XX_LASI_CONTROL (MII_ADDR_C45 | 0x39002) | |
21 | #define BCM87XX_LASI_STATUS (MII_ADDR_C45 | 0x39005) | |
22 | ||
23 | #if IS_ENABLED(CONFIG_OF_MDIO) | |
24 | /* Set and/or override some configuration registers based on the | |
806a0fbe | 25 | * broadcom,c45-reg-init property stored in the of_node for the phydev. |
e9976d7c DD |
26 | * |
27 | * broadcom,c45-reg-init = <devid reg mask value>,...; | |
28 | * | |
29 | * There may be one or more sets of <devid reg mask value>: | |
30 | * | |
31 | * devid: which sub-device to use. | |
32 | * reg: the register. | |
33 | * mask: if non-zero, ANDed with existing register value. | |
34 | * value: ORed with the masked value and written to the regiser. | |
35 | * | |
36 | */ | |
37 | static int bcm87xx_of_reg_init(struct phy_device *phydev) | |
38 | { | |
39 | const __be32 *paddr; | |
40 | const __be32 *paddr_end; | |
41 | int len, ret; | |
42 | ||
e5a03bfd | 43 | if (!phydev->mdio.dev.of_node) |
e9976d7c DD |
44 | return 0; |
45 | ||
e5a03bfd | 46 | paddr = of_get_property(phydev->mdio.dev.of_node, |
e9976d7c DD |
47 | "broadcom,c45-reg-init", &len); |
48 | if (!paddr) | |
49 | return 0; | |
50 | ||
51 | paddr_end = paddr + (len /= sizeof(*paddr)); | |
52 | ||
53 | ret = 0; | |
54 | ||
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++); | |
60 | int val; | |
61 | u32 regnum = MII_ADDR_C45 | (devid << 16) | reg; | |
62 | val = 0; | |
63 | if (mask) { | |
64 | val = phy_read(phydev, regnum); | |
65 | if (val < 0) { | |
66 | ret = val; | |
67 | goto err; | |
68 | } | |
69 | val &= mask; | |
70 | } | |
71 | val |= val_bits; | |
72 | ||
73 | ret = phy_write(phydev, regnum, val); | |
74 | if (ret < 0) | |
75 | goto err; | |
76 | } | |
77 | err: | |
78 | return ret; | |
79 | } | |
80 | #else | |
81 | static int bcm87xx_of_reg_init(struct phy_device *phydev) | |
82 | { | |
83 | return 0; | |
84 | } | |
85 | #endif /* CONFIG_OF_MDIO */ | |
86 | ||
87 | static int bcm87xx_config_init(struct phy_device *phydev) | |
88 | { | |
89 | phydev->supported = SUPPORTED_10000baseR_FEC; | |
90 | phydev->advertising = ADVERTISED_10000baseR_FEC; | |
91 | phydev->state = PHY_NOLINK; | |
567990cf | 92 | phydev->autoneg = AUTONEG_DISABLE; |
e9976d7c DD |
93 | |
94 | bcm87xx_of_reg_init(phydev); | |
95 | ||
96 | return 0; | |
97 | } | |
98 | ||
99 | static int bcm87xx_config_aneg(struct phy_device *phydev) | |
100 | { | |
101 | return -EINVAL; | |
102 | } | |
103 | ||
104 | static int bcm87xx_read_status(struct phy_device *phydev) | |
105 | { | |
106 | int rx_signal_detect; | |
107 | int pcs_status; | |
108 | int xgxs_lane_status; | |
109 | ||
110 | rx_signal_detect = phy_read(phydev, BCM87XX_PMD_RX_SIGNAL_DETECT); | |
111 | if (rx_signal_detect < 0) | |
112 | return rx_signal_detect; | |
113 | ||
114 | if ((rx_signal_detect & 1) == 0) | |
115 | goto no_link; | |
116 | ||
117 | pcs_status = phy_read(phydev, BCM87XX_10GBASER_PCS_STATUS); | |
118 | if (pcs_status < 0) | |
119 | return pcs_status; | |
120 | ||
121 | if ((pcs_status & 1) == 0) | |
122 | goto no_link; | |
123 | ||
124 | xgxs_lane_status = phy_read(phydev, BCM87XX_XGXS_LANE_STATUS); | |
125 | if (xgxs_lane_status < 0) | |
126 | return xgxs_lane_status; | |
127 | ||
128 | if ((xgxs_lane_status & 0x1000) == 0) | |
129 | goto no_link; | |
130 | ||
131 | phydev->speed = 10000; | |
132 | phydev->link = 1; | |
133 | phydev->duplex = 1; | |
134 | return 0; | |
135 | ||
136 | no_link: | |
137 | phydev->link = 0; | |
138 | return 0; | |
139 | } | |
140 | ||
141 | static int bcm87xx_config_intr(struct phy_device *phydev) | |
142 | { | |
143 | int reg, err; | |
144 | ||
145 | reg = phy_read(phydev, BCM87XX_LASI_CONTROL); | |
146 | ||
147 | if (reg < 0) | |
148 | return reg; | |
149 | ||
150 | if (phydev->interrupts == PHY_INTERRUPT_ENABLED) | |
151 | reg |= 1; | |
152 | else | |
153 | reg &= ~1; | |
154 | ||
155 | err = phy_write(phydev, BCM87XX_LASI_CONTROL, reg); | |
156 | return err; | |
157 | } | |
158 | ||
159 | static int bcm87xx_did_interrupt(struct phy_device *phydev) | |
160 | { | |
161 | int reg; | |
162 | ||
163 | reg = phy_read(phydev, BCM87XX_LASI_STATUS); | |
164 | ||
165 | if (reg < 0) { | |
72ba48be AL |
166 | phydev_err(phydev, |
167 | "Error: Read of BCM87XX_LASI_STATUS failed: %d\n", | |
168 | reg); | |
e9976d7c DD |
169 | return 0; |
170 | } | |
171 | return (reg & 1) != 0; | |
172 | } | |
173 | ||
174 | static int bcm87xx_ack_interrupt(struct phy_device *phydev) | |
175 | { | |
176 | /* Reading the LASI status clears it. */ | |
177 | bcm87xx_did_interrupt(phydev); | |
178 | return 0; | |
179 | } | |
180 | ||
181 | static int bcm8706_match_phy_device(struct phy_device *phydev) | |
182 | { | |
183 | return phydev->c45_ids.device_ids[4] == PHY_ID_BCM8706; | |
184 | } | |
185 | ||
186 | static int bcm8727_match_phy_device(struct phy_device *phydev) | |
187 | { | |
188 | return phydev->c45_ids.device_ids[4] == PHY_ID_BCM8727; | |
189 | } | |
190 | ||
d5bf9071 CH |
191 | static struct phy_driver bcm87xx_driver[] = { |
192 | { | |
e9976d7c DD |
193 | .phy_id = PHY_ID_BCM8706, |
194 | .phy_id_mask = 0xffffffff, | |
195 | .name = "Broadcom BCM8706", | |
196 | .flags = PHY_HAS_INTERRUPT, | |
197 | .config_init = bcm87xx_config_init, | |
198 | .config_aneg = bcm87xx_config_aneg, | |
199 | .read_status = bcm87xx_read_status, | |
200 | .ack_interrupt = bcm87xx_ack_interrupt, | |
201 | .config_intr = bcm87xx_config_intr, | |
202 | .did_interrupt = bcm87xx_did_interrupt, | |
203 | .match_phy_device = bcm8706_match_phy_device, | |
d5bf9071 | 204 | }, { |
e9976d7c DD |
205 | .phy_id = PHY_ID_BCM8727, |
206 | .phy_id_mask = 0xffffffff, | |
207 | .name = "Broadcom BCM8727", | |
208 | .flags = PHY_HAS_INTERRUPT, | |
209 | .config_init = bcm87xx_config_init, | |
210 | .config_aneg = bcm87xx_config_aneg, | |
211 | .read_status = bcm87xx_read_status, | |
212 | .ack_interrupt = bcm87xx_ack_interrupt, | |
213 | .config_intr = bcm87xx_config_intr, | |
214 | .did_interrupt = bcm87xx_did_interrupt, | |
215 | .match_phy_device = bcm8727_match_phy_device, | |
d5bf9071 | 216 | } }; |
e9976d7c | 217 | |
50fd7150 | 218 | module_phy_driver(bcm87xx_driver); |
9913b8c8 PH |
219 | |
220 | MODULE_LICENSE("GPL"); |