1 // SPDX-License-Identifier: GPL-2.0
2 /* Realtek SMI subdriver for the Realtek RTL8365MB-VC ethernet switch.
3 *
4 * Copyright (C) 2021 Alvin Šipraga <alsi@bang-olufsen.dk>
5 * Copyright (C) 2021 Michael Rasmussen <mir@bang-olufsen.dk>
6 *
7 * The RTL8365MB-VC is a 4+1 port 10/100/1000M switch controller. It includes 4
8 * integrated PHYs for the user facing ports, and an extension interface which
9 * can be connected to the CPU - or another PHY - via either MII, RMII, or
10 * RGMII. The switch is configured via the Realtek Simple Management Interface
11 * (SMI), which uses the MDIO/MDC lines.
12 *
13 * Below is a simplified block diagram of the chip and its relevant interfaces.
14 *
15 * .-----------------------------------.
16 * | |
17 * UTP <---------------> Giga PHY <-> PCS <-> P0 GMAC |
18 * UTP <---------------> Giga PHY <-> PCS <-> P1 GMAC |
19 * UTP <---------------> Giga PHY <-> PCS <-> P2 GMAC |
20 * UTP <---------------> Giga PHY <-> PCS <-> P3 GMAC |
21 * | |
22 * CPU/PHY <-MII/RMII/RGMII---> Extension <---> Extension |
23 * | interface 1 GMAC 1 |
24 * | |
25 * SMI driver/ <-MDC/SCL---> Management ~~~~~~~~~~~~~~ |
26 * EEPROM <-MDIO/SDA--> interface ~REALTEK ~~~~~ |
27 * | ~RTL8365MB ~~~ |
28 * | ~GXXXC TAIWAN~ |
29 * GPIO <--------------> Reset ~~~~~~~~~~~~~~ |
30 * | |
31 * Interrupt <----------> Link UP/DOWN events |
32 * controller | |
33 * '-----------------------------------'
34 *
35 * The driver uses DSA to integrate the 4 user and 1 extension ports into the
36 * kernel. Netdevices are created for the user ports, as are PHY devices for
37 * their integrated PHYs. The device tree firmware should also specify the link
38 * partner of the extension port - either via a fixed-link or other phy-handle.
39 * See the device tree bindings for more detailed information. Note that the
40 * driver has only been tested with a fixed-link, but in principle it should not
41 * matter.
42 *
43 * NOTE: Currently, only the RGMII interface is implemented in this driver.
44 *
45 * The interrupt line is asserted on link UP/DOWN events. The driver creates a
46 * custom irqchip to handle this interrupt and demultiplex the events by reading
47 * the status registers via SMI. Interrupts are then propagated to the relevant
48 * PHY device.
49 *
50 * The EEPROM contains initial register values which the chip will read over I2C
51 * upon hardware reset. It is also possible to omit the EEPROM. In both cases,
52 * the driver will manually reprogram some registers using jam tables to reach
53 * an initial state defined by the vendor driver.
54 *
55 * This Linux driver is written based on an OS-agnostic vendor driver from
56 * Realtek. The reference GPL-licensed sources can be found in the OpenWrt
57 * source tree under the name rtl8367c. The vendor driver claims to support a
58 * number of similar switch controllers from Realtek, but the only hardware we
59 * have is the RTL8365MB-VC. Moreover, there does not seem to be any chip under
60 * the name RTL8367C. Although one wishes that the 'C' stood for some kind of
61 * common hardware revision, there exist examples of chips with the suffix -VC
62 * which are explicitly not supported by the rtl8367c driver and which instead
63 * require the rtl8367d vendor driver. With all this uncertainty, the driver has
64 * been modestly named rtl8365mb. Future implementors may wish to rename things
65 * accordingly.
66 *
67 * In the same family of chips, some carry up to 8 user ports and up to 2
68 * extension ports. Where possible this driver tries to make things generic, but
69 * more work must be done to support these configurations. According to
70 * documentation from Realtek, the family should include the following chips:
71 *
72 * - RTL8363NB
73 * - RTL8363NB-VB
74 * - RTL8363SC
75 * - RTL8363SC-VB
76 * - RTL8364NB
77 * - RTL8364NB-VB
78 * - RTL8365MB-VC
79 * - RTL8366SC
80 * - RTL8367RB-VB
81 * - RTL8367SB
82 * - RTL8367S
83 * - RTL8370MB
84 * - RTL8310SR
85 *
86 * Some of the register logic for these additional chips has been skipped over
87 * while implementing this driver. It is therefore not possible to assume that
88 * things will work out-of-the-box for other chips, and a careful review of the
89 * vendor driver may be needed to expand support. The RTL8365MB-VC seems to be
90 * one of the simpler chips.
91 */
92
93 #include <linux/bitfield.h>
94 #include <linux/bitops.h>
95 #include <linux/interrupt.h>
96 #include <linux/irqdomain.h>
97 #include <linux/mutex.h>
98 #include <linux/of_irq.h>
99 #include <linux/regmap.h>
100 #include <linux/if_bridge.h>
101 #include <linux/if_vlan.h>
102
103 #include "realtek.h"
104 #include "realtek-smi.h"
105 #include "realtek-mdio.h"
106 #include "rtl83xx.h"
107
108 /* Family-specific data and limits */
109 #define RTL8365MB_PHYADDRMAX 7
110 #define RTL8365MB_NUM_PHYREGS 32
111 #define RTL8365MB_PHYREGMAX (RTL8365MB_NUM_PHYREGS - 1)
112 #define RTL8365MB_MAX_NUM_PORTS 11
113 #define RTL8365MB_MAX_NUM_EXTINTS 3
114 #define RTL8365MB_LEARN_LIMIT_MAX 2112
115
116 /* Chip identification registers */
117 #define RTL8365MB_CHIP_ID_REG 0x1300
118
119 #define RTL8365MB_CHIP_VER_REG 0x1301
120
121 #define RTL8365MB_MAGIC_REG 0x13C2
122 #define RTL8365MB_MAGIC_VALUE 0x0249
123
124 /* Chip reset register */
125 #define RTL8365MB_CHIP_RESET_REG 0x1322
126 #define RTL8365MB_CHIP_RESET_SW_MASK 0x0002
127 #define RTL8365MB_CHIP_RESET_HW_MASK 0x0001
128
129 /* Interrupt polarity register */
130 #define RTL8365MB_INTR_POLARITY_REG 0x1100
131 #define RTL8365MB_INTR_POLARITY_MASK 0x0001
132 #define RTL8365MB_INTR_POLARITY_HIGH 0
133 #define RTL8365MB_INTR_POLARITY_LOW 1
134
135 /* Interrupt control/status register - enable/check specific interrupt types */
136 #define RTL8365MB_INTR_CTRL_REG 0x1101
137 #define RTL8365MB_INTR_STATUS_REG 0x1102
138 #define RTL8365MB_INTR_SLIENT_START_2_MASK 0x1000
139 #define RTL8365MB_INTR_SLIENT_START_MASK 0x0800
140 #define RTL8365MB_INTR_ACL_ACTION_MASK 0x0200
141 #define RTL8365MB_INTR_CABLE_DIAG_FIN_MASK 0x0100
142 #define RTL8365MB_INTR_INTERRUPT_8051_MASK 0x0080
143 #define RTL8365MB_INTR_LOOP_DETECTION_MASK 0x0040
144 #define RTL8365MB_INTR_GREEN_TIMER_MASK 0x0020
145 #define RTL8365MB_INTR_SPECIAL_CONGEST_MASK 0x0010
146 #define RTL8365MB_INTR_SPEED_CHANGE_MASK 0x0008
147 #define RTL8365MB_INTR_LEARN_OVER_MASK 0x0004
148 #define RTL8365MB_INTR_METER_EXCEEDED_MASK 0x0002
149 #define RTL8365MB_INTR_LINK_CHANGE_MASK 0x0001
150 #define RTL8365MB_INTR_ALL_MASK \
151 (RTL8365MB_INTR_SLIENT_START_2_MASK | \
152 RTL8365MB_INTR_SLIENT_START_MASK | \
153 RTL8365MB_INTR_ACL_ACTION_MASK | \
154 RTL8365MB_INTR_CABLE_DIAG_FIN_MASK | \
155 RTL8365MB_INTR_INTERRUPT_8051_MASK | \
156 RTL8365MB_INTR_LOOP_DETECTION_MASK | \
157 RTL8365MB_INTR_GREEN_TIMER_MASK | \
158 RTL8365MB_INTR_SPECIAL_CONGEST_MASK | \
159 RTL8365MB_INTR_SPEED_CHANGE_MASK | \
160 RTL8365MB_INTR_LEARN_OVER_MASK | \
161 RTL8365MB_INTR_METER_EXCEEDED_MASK | \
162 RTL8365MB_INTR_LINK_CHANGE_MASK)
163
164 /* Per-port interrupt type status registers */
165 #define RTL8365MB_PORT_LINKDOWN_IND_REG 0x1106
166 #define RTL8365MB_PORT_LINKDOWN_IND_MASK 0x07FF
167
168 #define RTL8365MB_PORT_LINKUP_IND_REG 0x1107
169 #define RTL8365MB_PORT_LINKUP_IND_MASK 0x07FF
170
171 /* PHY indirect access registers */
172 #define RTL8365MB_INDIRECT_ACCESS_CTRL_REG 0x1F00
173 #define RTL8365MB_INDIRECT_ACCESS_CTRL_RW_MASK 0x0002
174 #define RTL8365MB_INDIRECT_ACCESS_CTRL_RW_READ 0
175 #define RTL8365MB_INDIRECT_ACCESS_CTRL_RW_WRITE 1
176 #define RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_MASK 0x0001
177 #define RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_VALUE 1
178 #define RTL8365MB_INDIRECT_ACCESS_STATUS_REG 0x1F01
179 #define RTL8365MB_INDIRECT_ACCESS_ADDRESS_REG 0x1F02
180 #define RTL8365MB_INDIRECT_ACCESS_ADDRESS_OCPADR_5_1_MASK GENMASK(4, 0)
181 #define RTL8365MB_INDIRECT_ACCESS_ADDRESS_PHYNUM_MASK GENMASK(7, 5)
182 #define RTL8365MB_INDIRECT_ACCESS_ADDRESS_OCPADR_9_6_MASK GENMASK(11, 8)
183 #define RTL8365MB_PHY_BASE 0x2000
184 #define RTL8365MB_INDIRECT_ACCESS_WRITE_DATA_REG 0x1F03
185 #define RTL8365MB_INDIRECT_ACCESS_READ_DATA_REG 0x1F04
186
187 /* PHY OCP address prefix register */
188 #define RTL8365MB_GPHY_OCP_MSB_0_REG 0x1D15
189 #define RTL8365MB_GPHY_OCP_MSB_0_CFG_CPU_OCPADR_MASK 0x0FC0
190 #define RTL8365MB_PHY_OCP_ADDR_PREFIX_MASK 0xFC00
191
192 /* The PHY OCP addresses of PHY registers 0~31 start here */
193 #define RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE 0xA400
194
195 /* External interface port mode values - used in DIGITAL_INTERFACE_SELECT */
196 #define RTL8365MB_EXT_PORT_MODE_DISABLE 0
197 #define RTL8365MB_EXT_PORT_MODE_RGMII 1
198 #define RTL8365MB_EXT_PORT_MODE_MII_MAC 2
199 #define RTL8365MB_EXT_PORT_MODE_MII_PHY 3
200 #define RTL8365MB_EXT_PORT_MODE_TMII_MAC 4
201 #define RTL8365MB_EXT_PORT_MODE_TMII_PHY 5
202 #define RTL8365MB_EXT_PORT_MODE_GMII 6
203 #define RTL8365MB_EXT_PORT_MODE_RMII_MAC 7
204 #define RTL8365MB_EXT_PORT_MODE_RMII_PHY 8
205 #define RTL8365MB_EXT_PORT_MODE_SGMII 9
206 #define RTL8365MB_EXT_PORT_MODE_HSGMII 10
207 #define RTL8365MB_EXT_PORT_MODE_1000X_100FX 11
208 #define RTL8365MB_EXT_PORT_MODE_1000X 12
209 #define RTL8365MB_EXT_PORT_MODE_100FX 13
210
211 /* External interface mode configuration registers 0~1 */
212 #define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG0 0x1305 /* EXT0,EXT1 */
213 #define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG1 0x13C3 /* EXT2 */
214 #define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG(_extint) \
215 ((_extint) <= 1 ? RTL8365MB_DIGITAL_INTERFACE_SELECT_REG0 : \
216 (_extint) == 2 ? RTL8365MB_DIGITAL_INTERFACE_SELECT_REG1 : \
217 0x0)
218 #define RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_MASK(_extint) \
219 (0xF << (((_extint) % 2)))
220 #define RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_OFFSET(_extint) \
221 (((_extint) % 2) * 4)
222
223 /* External interface RGMII TX/RX delay configuration registers 0~2 */
224 #define RTL8365MB_EXT_RGMXF_REG0 0x1306 /* EXT0 */
225 #define RTL8365MB_EXT_RGMXF_REG1 0x1307 /* EXT1 */
226 #define RTL8365MB_EXT_RGMXF_REG2 0x13C5 /* EXT2 */
227 #define RTL8365MB_EXT_RGMXF_REG(_extint) \
228 ((_extint) == 0 ? RTL8365MB_EXT_RGMXF_REG0 : \
229 (_extint) == 1 ? RTL8365MB_EXT_RGMXF_REG1 : \
230 (_extint) == 2 ? RTL8365MB_EXT_RGMXF_REG2 : \
231 0x0)
232 #define RTL8365MB_EXT_RGMXF_RXDELAY_MASK 0x0007
233 #define RTL8365MB_EXT_RGMXF_TXDELAY_MASK 0x0008
234
235 /* External interface port speed values - used in DIGITAL_INTERFACE_FORCE */
236 #define RTL8365MB_PORT_SPEED_10M 0
237 #define RTL8365MB_PORT_SPEED_100M 1
238 #define RTL8365MB_PORT_SPEED_1000M 2
239
240 /* External interface force configuration registers 0~2 */
241 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG0 0x1310 /* EXT0 */
242 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG1 0x1311 /* EXT1 */
243 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG2 0x13C4 /* EXT2 */
244 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG(_extint) \
245 ((_extint) == 0 ? RTL8365MB_DIGITAL_INTERFACE_FORCE_REG0 : \
246 (_extint) == 1 ? RTL8365MB_DIGITAL_INTERFACE_FORCE_REG1 : \
247 (_extint) == 2 ? RTL8365MB_DIGITAL_INTERFACE_FORCE_REG2 : \
248 0x0)
249 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_EN_MASK 0x1000
250 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_NWAY_MASK 0x0080
251 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_TXPAUSE_MASK 0x0040
252 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_RXPAUSE_MASK 0x0020
253 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_LINK_MASK 0x0010
254 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_DUPLEX_MASK 0x0004
255 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_SPEED_MASK 0x0003
256
257 /* CPU port mask register - controls which ports are treated as CPU ports */
258 #define RTL8365MB_CPU_PORT_MASK_REG 0x1219
259 #define RTL8365MB_CPU_PORT_MASK_MASK 0x07FF
260
261 /* CPU control register */
262 #define RTL8365MB_CPU_CTRL_REG 0x121A
263 #define RTL8365MB_CPU_CTRL_TRAP_PORT_EXT_MASK 0x0400
264 #define RTL8365MB_CPU_CTRL_TAG_FORMAT_MASK 0x0200
265 #define RTL8365MB_CPU_CTRL_RXBYTECOUNT_MASK 0x0080
266 #define RTL8365MB_CPU_CTRL_TAG_POSITION_MASK 0x0040
267 #define RTL8365MB_CPU_CTRL_TRAP_PORT_MASK 0x0038
268 #define RTL8365MB_CPU_CTRL_INSERTMODE_MASK 0x0006
269 #define RTL8365MB_CPU_CTRL_EN_MASK 0x0001
270
271 /* Maximum packet length register */
272 #define RTL8365MB_CFG0_MAX_LEN_REG 0x088C
273 #define RTL8365MB_CFG0_MAX_LEN_MASK 0x3FFF
274 #define RTL8365MB_CFG0_MAX_LEN_MAX 0x3FFF
275
276 /* Port learning limit registers */
277 #define RTL8365MB_LUT_PORT_LEARN_LIMIT_BASE 0x0A20
278 #define RTL8365MB_LUT_PORT_LEARN_LIMIT_REG(_physport) \
279 (RTL8365MB_LUT_PORT_LEARN_LIMIT_BASE + (_physport))
280
281 /* Port isolation (forwarding mask) registers */
282 #define RTL8365MB_PORT_ISOLATION_REG_BASE 0x08A2
283 #define RTL8365MB_PORT_ISOLATION_REG(_physport) \
284 (RTL8365MB_PORT_ISOLATION_REG_BASE + (_physport))
285 #define RTL8365MB_PORT_ISOLATION_MASK 0x07FF
286
287 /* MSTP port state registers - indexed by tree instance */
288 #define RTL8365MB_MSTI_CTRL_BASE 0x0A00
289 #define RTL8365MB_MSTI_CTRL_REG(_msti, _physport) \
290 (RTL8365MB_MSTI_CTRL_BASE + ((_msti) << 1) + ((_physport) >> 3))
291 #define RTL8365MB_MSTI_CTRL_PORT_STATE_OFFSET(_physport) ((_physport) << 1)
292 #define RTL8365MB_MSTI_CTRL_PORT_STATE_MASK(_physport) \
293 (0x3 << RTL8365MB_MSTI_CTRL_PORT_STATE_OFFSET((_physport)))
294
295 /* MIB counter value registers */
296 #define RTL8365MB_MIB_COUNTER_BASE 0x1000
297 #define RTL8365MB_MIB_COUNTER_REG(_x) (RTL8365MB_MIB_COUNTER_BASE + (_x))
298
299 /* MIB counter address register */
300 #define RTL8365MB_MIB_ADDRESS_REG 0x1004
301 #define RTL8365MB_MIB_ADDRESS_PORT_OFFSET 0x007C
302 #define RTL8365MB_MIB_ADDRESS(_p, _x) \
303 (((RTL8365MB_MIB_ADDRESS_PORT_OFFSET) * (_p) + (_x)) >> 2)
304
305 #define RTL8365MB_MIB_CTRL0_REG 0x1005
306 #define RTL8365MB_MIB_CTRL0_RESET_MASK 0x0002
307 #define RTL8365MB_MIB_CTRL0_BUSY_MASK 0x0001
308
309 /* The DSA callback .get_stats64 runs in atomic context, so we are not allowed
310 * to block. On the other hand, accessing MIB counters absolutely requires us to
311 * block. The solution is thus to schedule work which polls the MIB counters
312 * asynchronously and updates some private data, which the callback can then
313 * fetch atomically. Three seconds should be a good enough polling interval.
314 */
315 #define RTL8365MB_STATS_INTERVAL_JIFFIES (3 * HZ)
316
317 enum rtl8365mb_mib_counter_index {
318 RTL8365MB_MIB_ifInOctets,
319 RTL8365MB_MIB_dot3StatsFCSErrors,
320 RTL8365MB_MIB_dot3StatsSymbolErrors,
321 RTL8365MB_MIB_dot3InPauseFrames,
322 RTL8365MB_MIB_dot3ControlInUnknownOpcodes,
323 RTL8365MB_MIB_etherStatsFragments,
324 RTL8365MB_MIB_etherStatsJabbers,
325 RTL8365MB_MIB_ifInUcastPkts,
326 RTL8365MB_MIB_etherStatsDropEvents,
327 RTL8365MB_MIB_ifInMulticastPkts,
328 RTL8365MB_MIB_ifInBroadcastPkts,
329 RTL8365MB_MIB_inMldChecksumError,
330 RTL8365MB_MIB_inIgmpChecksumError,
331 RTL8365MB_MIB_inMldSpecificQuery,
332 RTL8365MB_MIB_inMldGeneralQuery,
333 RTL8365MB_MIB_inIgmpSpecificQuery,
334 RTL8365MB_MIB_inIgmpGeneralQuery,
335 RTL8365MB_MIB_inMldLeaves,
336 RTL8365MB_MIB_inIgmpLeaves,
337 RTL8365MB_MIB_etherStatsOctets,
338 RTL8365MB_MIB_etherStatsUnderSizePkts,
339 RTL8365MB_MIB_etherOversizeStats,
340 RTL8365MB_MIB_etherStatsPkts64Octets,
341 RTL8365MB_MIB_etherStatsPkts65to127Octets,
342 RTL8365MB_MIB_etherStatsPkts128to255Octets,
343 RTL8365MB_MIB_etherStatsPkts256to511Octets,
344 RTL8365MB_MIB_etherStatsPkts512to1023Octets,
345 RTL8365MB_MIB_etherStatsPkts1024to1518Octets,
346 RTL8365MB_MIB_ifOutOctets,
347 RTL8365MB_MIB_dot3StatsSingleCollisionFrames,
348 RTL8365MB_MIB_dot3StatsMultipleCollisionFrames,
349 RTL8365MB_MIB_dot3StatsDeferredTransmissions,
350 RTL8365MB_MIB_dot3StatsLateCollisions,
351 RTL8365MB_MIB_etherStatsCollisions,
352 RTL8365MB_MIB_dot3StatsExcessiveCollisions,
353 RTL8365MB_MIB_dot3OutPauseFrames,
354 RTL8365MB_MIB_ifOutDiscards,
355 RTL8365MB_MIB_dot1dTpPortInDiscards,
356 RTL8365MB_MIB_ifOutUcastPkts,
357 RTL8365MB_MIB_ifOutMulticastPkts,
358 RTL8365MB_MIB_ifOutBroadcastPkts,
359 RTL8365MB_MIB_outOampduPkts,
360 RTL8365MB_MIB_inOampduPkts,
361 RTL8365MB_MIB_inIgmpJoinsSuccess,
362 RTL8365MB_MIB_inIgmpJoinsFail,
363 RTL8365MB_MIB_inMldJoinsSuccess,
364 RTL8365MB_MIB_inMldJoinsFail,
365 RTL8365MB_MIB_inReportSuppressionDrop,
366 RTL8365MB_MIB_inLeaveSuppressionDrop,
367 RTL8365MB_MIB_outIgmpReports,
368 RTL8365MB_MIB_outIgmpLeaves,
369 RTL8365MB_MIB_outIgmpGeneralQuery,
370 RTL8365MB_MIB_outIgmpSpecificQuery,
371 RTL8365MB_MIB_outMldReports,
372 RTL8365MB_MIB_outMldLeaves,
373 RTL8365MB_MIB_outMldGeneralQuery,
374 RTL8365MB_MIB_outMldSpecificQuery,
375 RTL8365MB_MIB_inKnownMulticastPkts,
376 RTL8365MB_MIB_END,
377 };
378
379 struct rtl8365mb_mib_counter {
380 u32 offset;
381 u32 length;
382 const char *name;
383 };
384
385 #define RTL8365MB_MAKE_MIB_COUNTER(_offset, _length, _name) \
386 [RTL8365MB_MIB_ ## _name] = { _offset, _length, #_name }
387
388 static struct rtl8365mb_mib_counter rtl8365mb_mib_counters[] = {
389 RTL8365MB_MAKE_MIB_COUNTER(0, 4, ifInOctets),
390 RTL8365MB_MAKE_MIB_COUNTER(4, 2, dot3StatsFCSErrors),
391 RTL8365MB_MAKE_MIB_COUNTER(6, 2, dot3StatsSymbolErrors),
392 RTL8365MB_MAKE_MIB_COUNTER(8, 2, dot3InPauseFrames),
393 RTL8365MB_MAKE_MIB_COUNTER(10, 2, dot3ControlInUnknownOpcodes),
394 RTL8365MB_MAKE_MIB_COUNTER(12, 2, etherStatsFragments),
395 RTL8365MB_MAKE_MIB_COUNTER(14, 2, etherStatsJabbers),
396 RTL8365MB_MAKE_MIB_COUNTER(16, 2, ifInUcastPkts),
397 RTL8365MB_MAKE_MIB_COUNTER(18, 2, etherStatsDropEvents),
398 RTL8365MB_MAKE_MIB_COUNTER(20, 2, ifInMulticastPkts),
399 RTL8365MB_MAKE_MIB_COUNTER(22, 2, ifInBroadcastPkts),
400 RTL8365MB_MAKE_MIB_COUNTER(24, 2, inMldChecksumError),
401 RTL8365MB_MAKE_MIB_COUNTER(26, 2, inIgmpChecksumError),
402 RTL8365MB_MAKE_MIB_COUNTER(28, 2, inMldSpecificQuery),
403 RTL8365MB_MAKE_MIB_COUNTER(30, 2, inMldGeneralQuery),
404 RTL8365MB_MAKE_MIB_COUNTER(32, 2, inIgmpSpecificQuery),
405 RTL8365MB_MAKE_MIB_COUNTER(34, 2, inIgmpGeneralQuery),
406 RTL8365MB_MAKE_MIB_COUNTER(36, 2, inMldLeaves),
407 RTL8365MB_MAKE_MIB_COUNTER(38, 2, inIgmpLeaves),
408 RTL8365MB_MAKE_MIB_COUNTER(40, 4, etherStatsOctets),
409 RTL8365MB_MAKE_MIB_COUNTER(44, 2, etherStatsUnderSizePkts),
410 RTL8365MB_MAKE_MIB_COUNTER(46, 2, etherOversizeStats),
411 RTL8365MB_MAKE_MIB_COUNTER(48, 2, etherStatsPkts64Octets),
412 RTL8365MB_MAKE_MIB_COUNTER(50, 2, etherStatsPkts65to127Octets),
413 RTL8365MB_MAKE_MIB_COUNTER(52, 2, etherStatsPkts128to255Octets),
414 RTL8365MB_MAKE_MIB_COUNTER(54, 2, etherStatsPkts256to511Octets),
415 RTL8365MB_MAKE_MIB_COUNTER(56, 2, etherStatsPkts512to1023Octets),
416 RTL8365MB_MAKE_MIB_COUNTER(58, 2, etherStatsPkts1024to1518Octets),
417 RTL8365MB_MAKE_MIB_COUNTER(60, 4, ifOutOctets),
418 RTL8365MB_MAKE_MIB_COUNTER(64, 2, dot3StatsSingleCollisionFrames),
419 RTL8365MB_MAKE_MIB_COUNTER(66, 2, dot3StatsMultipleCollisionFrames),
420 RTL8365MB_MAKE_MIB_COUNTER(68, 2, dot3StatsDeferredTransmissions),
421 RTL8365MB_MAKE_MIB_COUNTER(70, 2, dot3StatsLateCollisions),
422 RTL8365MB_MAKE_MIB_COUNTER(72, 2, etherStatsCollisions),
423 RTL8365MB_MAKE_MIB_COUNTER(74, 2, dot3StatsExcessiveCollisions),
424 RTL8365MB_MAKE_MIB_COUNTER(76, 2, dot3OutPauseFrames),
425 RTL8365MB_MAKE_MIB_COUNTER(78, 2, ifOutDiscards),
426 RTL8365MB_MAKE_MIB_COUNTER(80, 2, dot1dTpPortInDiscards),
427 RTL8365MB_MAKE_MIB_COUNTER(82, 2, ifOutUcastPkts),
428 RTL8365MB_MAKE_MIB_COUNTER(84, 2, ifOutMulticastPkts),
429 RTL8365MB_MAKE_MIB_COUNTER(86, 2, ifOutBroadcastPkts),
430 RTL8365MB_MAKE_MIB_COUNTER(88, 2, outOampduPkts),
431 RTL8365MB_MAKE_MIB_COUNTER(90, 2, inOampduPkts),
432 RTL8365MB_MAKE_MIB_COUNTER(92, 4, inIgmpJoinsSuccess),
433 RTL8365MB_MAKE_MIB_COUNTER(96, 2, inIgmpJoinsFail),
434 RTL8365MB_MAKE_MIB_COUNTER(98, 2, inMldJoinsSuccess),
435 RTL8365MB_MAKE_MIB_COUNTER(100, 2, inMldJoinsFail),
436 RTL8365MB_MAKE_MIB_COUNTER(102, 2, inReportSuppressionDrop),
437 RTL8365MB_MAKE_MIB_COUNTER(104, 2, inLeaveSuppressionDrop),
438 RTL8365MB_MAKE_MIB_COUNTER(106, 2, outIgmpReports),
439 RTL8365MB_MAKE_MIB_COUNTER(108, 2, outIgmpLeaves),
440 RTL8365MB_MAKE_MIB_COUNTER(110, 2, outIgmpGeneralQuery),
441 RTL8365MB_MAKE_MIB_COUNTER(112, 2, outIgmpSpecificQuery),
442 RTL8365MB_MAKE_MIB_COUNTER(114, 2, outMldReports),
443 RTL8365MB_MAKE_MIB_COUNTER(116, 2, outMldLeaves),
444 RTL8365MB_MAKE_MIB_COUNTER(118, 2, outMldGeneralQuery),
445 RTL8365MB_MAKE_MIB_COUNTER(120, 2, outMldSpecificQuery),
446 RTL8365MB_MAKE_MIB_COUNTER(122, 2, inKnownMulticastPkts),
447 };
448
449 static_assert(ARRAY_SIZE(rtl8365mb_mib_counters) == RTL8365MB_MIB_END);
450
451 struct rtl8365mb_jam_tbl_entry {
452 u16 reg;
453 u16 val;
454 };
455
456 /* Lifted from the vendor driver sources */
457 static const struct rtl8365mb_jam_tbl_entry rtl8365mb_init_jam_8365mb_vc[] = {
458 { 0x13EB, 0x15BB }, { 0x1303, 0x06D6 }, { 0x1304, 0x0700 },
459 { 0x13E2, 0x003F }, { 0x13F9, 0x0090 }, { 0x121E, 0x03CA },
460 { 0x1233, 0x0352 }, { 0x1237, 0x00A0 }, { 0x123A, 0x0030 },
461 { 0x1239, 0x0084 }, { 0x0301, 0x1000 }, { 0x1349, 0x001F },
462 { 0x18E0, 0x4004 }, { 0x122B, 0x241C }, { 0x1305, 0xC000 },
463 { 0x13F0, 0x0000 },
464 };
465
466 static const struct rtl8365mb_jam_tbl_entry rtl8365mb_init_jam_common[] = {
467 { 0x1200, 0x7FCB }, { 0x0884, 0x0003 }, { 0x06EB, 0x0001 },
468 { 0x03Fa, 0x0007 }, { 0x08C8, 0x00C0 }, { 0x0A30, 0x020E },
469 { 0x0800, 0x0000 }, { 0x0802, 0x0000 }, { 0x09DA, 0x0013 },
470 { 0x1D32, 0x0002 },
471 };
472
473 enum rtl8365mb_phy_interface_mode {
474 RTL8365MB_PHY_INTERFACE_MODE_INVAL = 0,
475 RTL8365MB_PHY_INTERFACE_MODE_INTERNAL = BIT(0),
476 RTL8365MB_PHY_INTERFACE_MODE_MII = BIT(1),
477 RTL8365MB_PHY_INTERFACE_MODE_TMII = BIT(2),
478 RTL8365MB_PHY_INTERFACE_MODE_RMII = BIT(3),
479 RTL8365MB_PHY_INTERFACE_MODE_RGMII = BIT(4),
480 RTL8365MB_PHY_INTERFACE_MODE_SGMII = BIT(5),
481 RTL8365MB_PHY_INTERFACE_MODE_HSGMII = BIT(6),
482 };
483
484 /**
485 * struct rtl8365mb_extint - external interface info
486 * @port: the port with an external interface
487 * @id: the external interface ID, which is either 0, 1, or 2
488 * @supported_interfaces: a bitmask of supported PHY interface modes
489 *
490 * Represents a mapping: port -> { id, supported_interfaces }. To be embedded
491 * in &struct rtl8365mb_chip_info for every port with an external interface.
492 */
493 struct rtl8365mb_extint {
494 int port;
495 int id;
496 unsigned int supported_interfaces;
497 };
498
499 /**
500 * struct rtl8365mb_chip_info - static chip-specific info
501 * @name: human-readable chip name
502 * @chip_id: chip identifier
503 * @chip_ver: chip silicon revision
504 * @extints: available external interfaces
505 * @jam_table: chip-specific initialization jam table
506 * @jam_size: size of the chip's jam table
507 *
508 * These data are specific to a given chip in the family of switches supported
509 * by this driver. When adding support for another chip in the family, a new
510 * chip info should be added to the rtl8365mb_chip_infos array.
511 */
512 struct rtl8365mb_chip_info {
513 const char *name;
514 u32 chip_id;
515 u32 chip_ver;
516 const struct rtl8365mb_extint extints[RTL8365MB_MAX_NUM_EXTINTS];
517 const struct rtl8365mb_jam_tbl_entry *jam_table;
518 size_t jam_size;
519 };
520
521 /* Chip info for each supported switch in the family */
522 #define PHY_INTF(_mode) (RTL8365MB_PHY_INTERFACE_MODE_ ## _mode)
523 static const struct rtl8365mb_chip_info rtl8365mb_chip_infos[] = {
524 {
525 .name = "RTL8365MB-VC",
526 .chip_id = 0x6367,
527 .chip_ver = 0x0040,
528 .extints = {
529 { 6, 1, PHY_INTF(MII) | PHY_INTF(TMII) |
530 PHY_INTF(RMII) | PHY_INTF(RGMII) },
531 },
532 .jam_table = rtl8365mb_init_jam_8365mb_vc,
533 .jam_size = ARRAY_SIZE(rtl8365mb_init_jam_8365mb_vc),
534 },
535 {
536 .name = "RTL8367S",
537 .chip_id = 0x6367,
538 .chip_ver = 0x00A0,
539 .extints = {
540 { 6, 1, PHY_INTF(SGMII) | PHY_INTF(HSGMII) },
541 { 7, 2, PHY_INTF(MII) | PHY_INTF(TMII) |
542 PHY_INTF(RMII) | PHY_INTF(RGMII) },
543 },
544 .jam_table = rtl8365mb_init_jam_8365mb_vc,
545 .jam_size = ARRAY_SIZE(rtl8365mb_init_jam_8365mb_vc),
546 },
547 {
548 .name = "RTL8367RB-VB",
549 .chip_id = 0x6367,
550 .chip_ver = 0x0020,
551 .extints = {
552 { 6, 1, PHY_INTF(MII) | PHY_INTF(TMII) |
553 PHY_INTF(RMII) | PHY_INTF(RGMII) },
554 { 7, 2, PHY_INTF(MII) | PHY_INTF(TMII) |
555 PHY_INTF(RMII) | PHY_INTF(RGMII) },
556 },
557 .jam_table = rtl8365mb_init_jam_8365mb_vc,
558 .jam_size = ARRAY_SIZE(rtl8365mb_init_jam_8365mb_vc),
559 },
560 };
561
562 enum rtl8365mb_stp_state {
563 RTL8365MB_STP_STATE_DISABLED = 0,
564 RTL8365MB_STP_STATE_BLOCKING = 1,
565 RTL8365MB_STP_STATE_LEARNING = 2,
566 RTL8365MB_STP_STATE_FORWARDING = 3,
567 };
568
569 enum rtl8365mb_cpu_insert {
570 RTL8365MB_CPU_INSERT_TO_ALL = 0,
571 RTL8365MB_CPU_INSERT_TO_TRAPPING = 1,
572 RTL8365MB_CPU_INSERT_TO_NONE = 2,
573 };
574
575 enum rtl8365mb_cpu_position {
576 RTL8365MB_CPU_POS_AFTER_SA = 0,
577 RTL8365MB_CPU_POS_BEFORE_CRC = 1,
578 };
579
580 enum rtl8365mb_cpu_format {
581 RTL8365MB_CPU_FORMAT_8BYTES = 0,
582 RTL8365MB_CPU_FORMAT_4BYTES = 1,
583 };
584
585 enum rtl8365mb_cpu_rxlen {
586 RTL8365MB_CPU_RXLEN_72BYTES = 0,
587 RTL8365MB_CPU_RXLEN_64BYTES = 1,
588 };
589
590 /**
591 * struct rtl8365mb_cpu - CPU port configuration
592 * @enable: enable/disable hardware insertion of CPU tag in switch->CPU frames
593 * @mask: port mask of ports that parse should parse CPU tags
594 * @trap_port: forward trapped frames to this port
595 * @insert: CPU tag insertion mode in switch->CPU frames
596 * @position: position of CPU tag in frame
597 * @rx_length: minimum CPU RX length
598 * @format: CPU tag format
599 *
600 * Represents the CPU tagging and CPU port configuration of the switch. These
601 * settings are configurable at runtime.
602 */
603 struct rtl8365mb_cpu {
604 bool enable;
605 u32 mask;
606 u32 trap_port;
607 enum rtl8365mb_cpu_insert insert;
608 enum rtl8365mb_cpu_position position;
609 enum rtl8365mb_cpu_rxlen rx_length;
610 enum rtl8365mb_cpu_format format;
611 };
612
613 /**
614 * struct rtl8365mb_port - private per-port data
615 * @priv: pointer to parent realtek_priv data
616 * @index: DSA port index, same as dsa_port::index
617 * @stats: link statistics populated by rtl8365mb_stats_poll, ready for atomic
618 * access via rtl8365mb_get_stats64
619 * @stats_lock: protect the stats structure during read/update
620 * @mib_work: delayed work for polling MIB counters
621 */
622 struct rtl8365mb_port {
623 struct realtek_priv *priv;
624 unsigned int index;
625 struct rtnl_link_stats64 stats;
626 spinlock_t stats_lock;
627 struct delayed_work mib_work;
628 };
629
630 /**
631 * struct rtl8365mb - driver private data
632 * @priv: pointer to parent realtek_priv data
633 * @irq: registered IRQ or zero
634 * @chip_info: chip-specific info about the attached switch
635 * @cpu: CPU tagging and CPU port configuration for this chip
636 * @mib_lock: prevent concurrent reads of MIB counters
637 * @ports: per-port data
638 *
639 * Private data for this driver.
640 */
641 struct rtl8365mb {
642 struct realtek_priv *priv;
643 int irq;
644 const struct rtl8365mb_chip_info *chip_info;
645 struct rtl8365mb_cpu cpu;
646 struct mutex mib_lock;
647 struct rtl8365mb_port ports[RTL8365MB_MAX_NUM_PORTS];
648 };
649
rtl8365mb_phy_poll_busy(struct realtek_priv * priv)650 static int rtl8365mb_phy_poll_busy(struct realtek_priv *priv)
651 {
652 u32 val;
653
654 return regmap_read_poll_timeout(priv->map_nolock,
655 RTL8365MB_INDIRECT_ACCESS_STATUS_REG,
656 val, !val, 10, 100);
657 }
658
rtl8365mb_phy_ocp_prepare(struct realtek_priv * priv,int phy,u32 ocp_addr)659 static int rtl8365mb_phy_ocp_prepare(struct realtek_priv *priv, int phy,
660 u32 ocp_addr)
661 {
662 u32 val;
663 int ret;
664
665 /* Set OCP prefix */
666 val = FIELD_GET(RTL8365MB_PHY_OCP_ADDR_PREFIX_MASK, ocp_addr);
667 ret = regmap_update_bits(
668 priv->map_nolock, RTL8365MB_GPHY_OCP_MSB_0_REG,
669 RTL8365MB_GPHY_OCP_MSB_0_CFG_CPU_OCPADR_MASK,
670 FIELD_PREP(RTL8365MB_GPHY_OCP_MSB_0_CFG_CPU_OCPADR_MASK, val));
671 if (ret)
672 return ret;
673
674 /* Set PHY register address */
675 val = RTL8365MB_PHY_BASE;
676 val |= FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_ADDRESS_PHYNUM_MASK, phy);
677 val |= FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_ADDRESS_OCPADR_5_1_MASK,
678 ocp_addr >> 1);
679 val |= FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_ADDRESS_OCPADR_9_6_MASK,
680 ocp_addr >> 6);
681 ret = regmap_write(priv->map_nolock,
682 RTL8365MB_INDIRECT_ACCESS_ADDRESS_REG, val);
683 if (ret)
684 return ret;
685
686 return 0;
687 }
688
rtl8365mb_phy_ocp_read(struct realtek_priv * priv,int phy,u32 ocp_addr,u16 * data)689 static int rtl8365mb_phy_ocp_read(struct realtek_priv *priv, int phy,
690 u32 ocp_addr, u16 *data)
691 {
692 u32 val;
693 int ret;
694
695 rtl83xx_lock(priv);
696
697 ret = rtl8365mb_phy_poll_busy(priv);
698 if (ret)
699 goto out;
700
701 ret = rtl8365mb_phy_ocp_prepare(priv, phy, ocp_addr);
702 if (ret)
703 goto out;
704
705 /* Execute read operation */
706 val = FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_MASK,
707 RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_VALUE) |
708 FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_RW_MASK,
709 RTL8365MB_INDIRECT_ACCESS_CTRL_RW_READ);
710 ret = regmap_write(priv->map_nolock, RTL8365MB_INDIRECT_ACCESS_CTRL_REG,
711 val);
712 if (ret)
713 goto out;
714
715 ret = rtl8365mb_phy_poll_busy(priv);
716 if (ret)
717 goto out;
718
719 /* Get PHY register data */
720 ret = regmap_read(priv->map_nolock,
721 RTL8365MB_INDIRECT_ACCESS_READ_DATA_REG, &val);
722 if (ret)
723 goto out;
724
725 *data = val & 0xFFFF;
726
727 out:
728 rtl83xx_unlock(priv);
729
730 return ret;
731 }
732
rtl8365mb_phy_ocp_write(struct realtek_priv * priv,int phy,u32 ocp_addr,u16 data)733 static int rtl8365mb_phy_ocp_write(struct realtek_priv *priv, int phy,
734 u32 ocp_addr, u16 data)
735 {
736 u32 val;
737 int ret;
738
739 rtl83xx_lock(priv);
740
741 ret = rtl8365mb_phy_poll_busy(priv);
742 if (ret)
743 goto out;
744
745 ret = rtl8365mb_phy_ocp_prepare(priv, phy, ocp_addr);
746 if (ret)
747 goto out;
748
749 /* Set PHY register data */
750 ret = regmap_write(priv->map_nolock,
751 RTL8365MB_INDIRECT_ACCESS_WRITE_DATA_REG, data);
752 if (ret)
753 goto out;
754
755 /* Execute write operation */
756 val = FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_MASK,
757 RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_VALUE) |
758 FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_RW_MASK,
759 RTL8365MB_INDIRECT_ACCESS_CTRL_RW_WRITE);
760 ret = regmap_write(priv->map_nolock, RTL8365MB_INDIRECT_ACCESS_CTRL_REG,
761 val);
762 if (ret)
763 goto out;
764
765 ret = rtl8365mb_phy_poll_busy(priv);
766 if (ret)
767 goto out;
768
769 out:
770 rtl83xx_unlock(priv);
771
772 return 0;
773 }
774
rtl8365mb_phy_read(struct realtek_priv * priv,int phy,int regnum)775 static int rtl8365mb_phy_read(struct realtek_priv *priv, int phy, int regnum)
776 {
777 u32 ocp_addr;
778 u16 val;
779 int ret;
780
781 if (phy > RTL8365MB_PHYADDRMAX)
782 return -EINVAL;
783
784 if (regnum > RTL8365MB_PHYREGMAX)
785 return -EINVAL;
786
787 ocp_addr = RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE + regnum * 2;
788
789 ret = rtl8365mb_phy_ocp_read(priv, phy, ocp_addr, &val);
790 if (ret) {
791 dev_err(priv->dev,
792 "failed to read PHY%d reg %02x @ %04x, ret %d\n", phy,
793 regnum, ocp_addr, ret);
794 return ret;
795 }
796
797 dev_dbg(priv->dev, "read PHY%d register 0x%02x @ %04x, val <- %04x\n",
798 phy, regnum, ocp_addr, val);
799
800 return val;
801 }
802
rtl8365mb_phy_write(struct realtek_priv * priv,int phy,int regnum,u16 val)803 static int rtl8365mb_phy_write(struct realtek_priv *priv, int phy, int regnum,
804 u16 val)
805 {
806 u32 ocp_addr;
807 int ret;
808
809 if (phy > RTL8365MB_PHYADDRMAX)
810 return -EINVAL;
811
812 if (regnum > RTL8365MB_PHYREGMAX)
813 return -EINVAL;
814
815 ocp_addr = RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE + regnum * 2;
816
817 ret = rtl8365mb_phy_ocp_write(priv, phy, ocp_addr, val);
818 if (ret) {
819 dev_err(priv->dev,
820 "failed to write PHY%d reg %02x @ %04x, ret %d\n", phy,
821 regnum, ocp_addr, ret);
822 return ret;
823 }
824
825 dev_dbg(priv->dev, "write PHY%d register 0x%02x @ %04x, val -> %04x\n",
826 phy, regnum, ocp_addr, val);
827
828 return 0;
829 }
830
831 static const struct rtl8365mb_extint *
rtl8365mb_get_port_extint(struct realtek_priv * priv,int port)832 rtl8365mb_get_port_extint(struct realtek_priv *priv, int port)
833 {
834 struct rtl8365mb *mb = priv->chip_data;
835 int i;
836
837 for (i = 0; i < RTL8365MB_MAX_NUM_EXTINTS; i++) {
838 const struct rtl8365mb_extint *extint =
839 &mb->chip_info->extints[i];
840
841 if (!extint->supported_interfaces)
842 continue;
843
844 if (extint->port == port)
845 return extint;
846 }
847
848 return NULL;
849 }
850
851 static enum dsa_tag_protocol
rtl8365mb_get_tag_protocol(struct dsa_switch * ds,int port,enum dsa_tag_protocol mp)852 rtl8365mb_get_tag_protocol(struct dsa_switch *ds, int port,
853 enum dsa_tag_protocol mp)
854 {
855 struct realtek_priv *priv = ds->priv;
856 struct rtl8365mb_cpu *cpu;
857 struct rtl8365mb *mb;
858
859 mb = priv->chip_data;
860 cpu = &mb->cpu;
861
862 if (cpu->position == RTL8365MB_CPU_POS_BEFORE_CRC)
863 return DSA_TAG_PROTO_RTL8_4T;
864
865 return DSA_TAG_PROTO_RTL8_4;
866 }
867
rtl8365mb_ext_config_rgmii(struct realtek_priv * priv,int port,phy_interface_t interface)868 static int rtl8365mb_ext_config_rgmii(struct realtek_priv *priv, int port,
869 phy_interface_t interface)
870 {
871 const struct rtl8365mb_extint *extint =
872 rtl8365mb_get_port_extint(priv, port);
873 struct dsa_switch *ds = &priv->ds;
874 struct device_node *dn;
875 struct dsa_port *dp;
876 int tx_delay = 0;
877 int rx_delay = 0;
878 u32 val;
879 int ret;
880
881 if (!extint)
882 return -ENODEV;
883
884 dp = dsa_to_port(ds, port);
885 dn = dp->dn;
886
887 /* Set the RGMII TX/RX delay
888 *
889 * The Realtek vendor driver indicates the following possible
890 * configuration settings:
891 *
892 * TX delay:
893 * 0 = no delay, 1 = 2 ns delay
894 * RX delay:
895 * 0 = no delay, 7 = maximum delay
896 * Each step is approximately 0.3 ns, so the maximum delay is about
897 * 2.1 ns.
898 *
899 * The vendor driver also states that this must be configured *before*
900 * forcing the external interface into a particular mode, which is done
901 * in the rtl8365mb_phylink_mac_link_{up,down} functions.
902 *
903 * Only configure an RGMII TX (resp. RX) delay if the
904 * tx-internal-delay-ps (resp. rx-internal-delay-ps) OF property is
905 * specified. We ignore the detail of the RGMII interface mode
906 * (RGMII_{RXID, TXID, etc.}), as this is considered to be a PHY-only
907 * property.
908 */
909 if (!of_property_read_u32(dn, "tx-internal-delay-ps", &val)) {
910 val = val / 1000; /* convert to ns */
911
912 if (val == 0 || val == 2)
913 tx_delay = val / 2;
914 else
915 dev_warn(priv->dev,
916 "RGMII TX delay must be 0 or 2 ns\n");
917 }
918
919 if (!of_property_read_u32(dn, "rx-internal-delay-ps", &val)) {
920 val = DIV_ROUND_CLOSEST(val, 300); /* convert to 0.3 ns step */
921
922 if (val <= 7)
923 rx_delay = val;
924 else
925 dev_warn(priv->dev,
926 "RGMII RX delay must be 0 to 2.1 ns\n");
927 }
928
929 ret = regmap_update_bits(
930 priv->map, RTL8365MB_EXT_RGMXF_REG(extint->id),
931 RTL8365MB_EXT_RGMXF_TXDELAY_MASK |
932 RTL8365MB_EXT_RGMXF_RXDELAY_MASK,
933 FIELD_PREP(RTL8365MB_EXT_RGMXF_TXDELAY_MASK, tx_delay) |
934 FIELD_PREP(RTL8365MB_EXT_RGMXF_RXDELAY_MASK, rx_delay));
935 if (ret)
936 return ret;
937
938 ret = regmap_update_bits(
939 priv->map, RTL8365MB_DIGITAL_INTERFACE_SELECT_REG(extint->id),
940 RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_MASK(extint->id),
941 RTL8365MB_EXT_PORT_MODE_RGMII
942 << RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_OFFSET(
943 extint->id));
944 if (ret)
945 return ret;
946
947 return 0;
948 }
949
rtl8365mb_ext_config_forcemode(struct realtek_priv * priv,int port,bool link,int speed,int duplex,bool tx_pause,bool rx_pause)950 static int rtl8365mb_ext_config_forcemode(struct realtek_priv *priv, int port,
951 bool link, int speed, int duplex,
952 bool tx_pause, bool rx_pause)
953 {
954 const struct rtl8365mb_extint *extint =
955 rtl8365mb_get_port_extint(priv, port);
956 u32 r_tx_pause;
957 u32 r_rx_pause;
958 u32 r_duplex;
959 u32 r_speed;
960 u32 r_link;
961 int val;
962 int ret;
963
964 if (!extint)
965 return -ENODEV;
966
967 if (link) {
968 /* Force the link up with the desired configuration */
969 r_link = 1;
970 r_rx_pause = rx_pause ? 1 : 0;
971 r_tx_pause = tx_pause ? 1 : 0;
972
973 if (speed == SPEED_1000) {
974 r_speed = RTL8365MB_PORT_SPEED_1000M;
975 } else if (speed == SPEED_100) {
976 r_speed = RTL8365MB_PORT_SPEED_100M;
977 } else if (speed == SPEED_10) {
978 r_speed = RTL8365MB_PORT_SPEED_10M;
979 } else {
980 dev_err(priv->dev, "unsupported port speed %s\n",
981 phy_speed_to_str(speed));
982 return -EINVAL;
983 }
984
985 if (duplex == DUPLEX_FULL) {
986 r_duplex = 1;
987 } else if (duplex == DUPLEX_HALF) {
988 r_duplex = 0;
989 } else {
990 dev_err(priv->dev, "unsupported duplex %s\n",
991 phy_duplex_to_str(duplex));
992 return -EINVAL;
993 }
994 } else {
995 /* Force the link down and reset any programmed configuration */
996 r_link = 0;
997 r_tx_pause = 0;
998 r_rx_pause = 0;
999 r_speed = 0;
1000 r_duplex = 0;
1001 }
1002
1003 val = FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_EN_MASK, 1) |
1004 FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_TXPAUSE_MASK,
1005 r_tx_pause) |
1006 FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_RXPAUSE_MASK,
1007 r_rx_pause) |
1008 FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_LINK_MASK, r_link) |
1009 FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_DUPLEX_MASK,
1010 r_duplex) |
1011 FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_SPEED_MASK, r_speed);
1012 ret = regmap_write(priv->map,
1013 RTL8365MB_DIGITAL_INTERFACE_FORCE_REG(extint->id),
1014 val);
1015 if (ret)
1016 return ret;
1017
1018 return 0;
1019 }
1020
rtl8365mb_phylink_get_caps(struct dsa_switch * ds,int port,struct phylink_config * config)1021 static void rtl8365mb_phylink_get_caps(struct dsa_switch *ds, int port,
1022 struct phylink_config *config)
1023 {
1024 const struct rtl8365mb_extint *extint =
1025 rtl8365mb_get_port_extint(ds->priv, port);
1026
1027 config->mac_capabilities = MAC_SYM_PAUSE | MAC_ASYM_PAUSE |
1028 MAC_10 | MAC_100 | MAC_1000FD;
1029
1030 if (!extint) {
1031 __set_bit(PHY_INTERFACE_MODE_INTERNAL,
1032 config->supported_interfaces);
1033
1034 /* GMII is the default interface mode for phylib, so
1035 * we have to support it for ports with integrated PHY.
1036 */
1037 __set_bit(PHY_INTERFACE_MODE_GMII,
1038 config->supported_interfaces);
1039 return;
1040 }
1041
1042 /* Populate according to the modes supported by _this driver_,
1043 * not necessarily the modes supported by the hardware, some of
1044 * which remain unimplemented.
1045 */
1046
1047 if (extint->supported_interfaces & RTL8365MB_PHY_INTERFACE_MODE_RGMII)
1048 phy_interface_set_rgmii(config->supported_interfaces);
1049 }
1050
rtl8365mb_phylink_mac_config(struct phylink_config * config,unsigned int mode,const struct phylink_link_state * state)1051 static void rtl8365mb_phylink_mac_config(struct phylink_config *config,
1052 unsigned int mode,
1053 const struct phylink_link_state *state)
1054 {
1055 struct dsa_port *dp = dsa_phylink_to_port(config);
1056 struct realtek_priv *priv = dp->ds->priv;
1057 u8 port = dp->index;
1058 int ret;
1059
1060 if (mode != MLO_AN_PHY && mode != MLO_AN_FIXED) {
1061 dev_err(priv->dev,
1062 "port %d supports only conventional PHY or fixed-link\n",
1063 port);
1064 return;
1065 }
1066
1067 if (phy_interface_mode_is_rgmii(state->interface)) {
1068 ret = rtl8365mb_ext_config_rgmii(priv, port, state->interface);
1069 if (ret)
1070 dev_err(priv->dev,
1071 "failed to configure RGMII mode on port %d: %d\n",
1072 port, ret);
1073 return;
1074 }
1075
1076 /* TODO: Implement MII and RMII modes, which the RTL8365MB-VC also
1077 * supports
1078 */
1079 }
1080
rtl8365mb_phylink_mac_link_down(struct phylink_config * config,unsigned int mode,phy_interface_t interface)1081 static void rtl8365mb_phylink_mac_link_down(struct phylink_config *config,
1082 unsigned int mode,
1083 phy_interface_t interface)
1084 {
1085 struct dsa_port *dp = dsa_phylink_to_port(config);
1086 struct realtek_priv *priv = dp->ds->priv;
1087 struct rtl8365mb_port *p;
1088 struct rtl8365mb *mb;
1089 u8 port = dp->index;
1090 int ret;
1091
1092 mb = priv->chip_data;
1093 p = &mb->ports[port];
1094 cancel_delayed_work_sync(&p->mib_work);
1095
1096 if (phy_interface_mode_is_rgmii(interface)) {
1097 ret = rtl8365mb_ext_config_forcemode(priv, port, false, 0, 0,
1098 false, false);
1099 if (ret)
1100 dev_err(priv->dev,
1101 "failed to reset forced mode on port %d: %d\n",
1102 port, ret);
1103
1104 return;
1105 }
1106 }
1107
rtl8365mb_phylink_mac_link_up(struct phylink_config * config,struct phy_device * phydev,unsigned int mode,phy_interface_t interface,int speed,int duplex,bool tx_pause,bool rx_pause)1108 static void rtl8365mb_phylink_mac_link_up(struct phylink_config *config,
1109 struct phy_device *phydev,
1110 unsigned int mode,
1111 phy_interface_t interface,
1112 int speed, int duplex, bool tx_pause,
1113 bool rx_pause)
1114 {
1115 struct dsa_port *dp = dsa_phylink_to_port(config);
1116 struct realtek_priv *priv = dp->ds->priv;
1117 struct rtl8365mb_port *p;
1118 struct rtl8365mb *mb;
1119 u8 port = dp->index;
1120 int ret;
1121
1122 mb = priv->chip_data;
1123 p = &mb->ports[port];
1124 schedule_delayed_work(&p->mib_work, 0);
1125
1126 if (phy_interface_mode_is_rgmii(interface)) {
1127 ret = rtl8365mb_ext_config_forcemode(priv, port, true, speed,
1128 duplex, tx_pause,
1129 rx_pause);
1130 if (ret)
1131 dev_err(priv->dev,
1132 "failed to force mode on port %d: %d\n", port,
1133 ret);
1134
1135 return;
1136 }
1137 }
1138
rtl8365mb_port_change_mtu(struct dsa_switch * ds,int port,int new_mtu)1139 static int rtl8365mb_port_change_mtu(struct dsa_switch *ds, int port,
1140 int new_mtu)
1141 {
1142 struct realtek_priv *priv = ds->priv;
1143 int frame_size;
1144
1145 /* When a new MTU is set, DSA always sets the CPU port's MTU to the
1146 * largest MTU of the user ports. Because the switch only has a global
1147 * RX length register, only allowing CPU port here is enough.
1148 */
1149 if (!dsa_is_cpu_port(ds, port))
1150 return 0;
1151
1152 frame_size = new_mtu + VLAN_ETH_HLEN + ETH_FCS_LEN;
1153
1154 dev_dbg(priv->dev, "changing mtu to %d (frame size: %d)\n",
1155 new_mtu, frame_size);
1156
1157 return regmap_update_bits(priv->map, RTL8365MB_CFG0_MAX_LEN_REG,
1158 RTL8365MB_CFG0_MAX_LEN_MASK,
1159 FIELD_PREP(RTL8365MB_CFG0_MAX_LEN_MASK,
1160 frame_size));
1161 }
1162
rtl8365mb_port_max_mtu(struct dsa_switch * ds,int port)1163 static int rtl8365mb_port_max_mtu(struct dsa_switch *ds, int port)
1164 {
1165 return RTL8365MB_CFG0_MAX_LEN_MAX - VLAN_ETH_HLEN - ETH_FCS_LEN;
1166 }
1167
rtl8365mb_port_stp_state_set(struct dsa_switch * ds,int port,u8 state)1168 static void rtl8365mb_port_stp_state_set(struct dsa_switch *ds, int port,
1169 u8 state)
1170 {
1171 struct realtek_priv *priv = ds->priv;
1172 enum rtl8365mb_stp_state val;
1173 int msti = 0;
1174
1175 switch (state) {
1176 case BR_STATE_DISABLED:
1177 val = RTL8365MB_STP_STATE_DISABLED;
1178 break;
1179 case BR_STATE_BLOCKING:
1180 case BR_STATE_LISTENING:
1181 val = RTL8365MB_STP_STATE_BLOCKING;
1182 break;
1183 case BR_STATE_LEARNING:
1184 val = RTL8365MB_STP_STATE_LEARNING;
1185 break;
1186 case BR_STATE_FORWARDING:
1187 val = RTL8365MB_STP_STATE_FORWARDING;
1188 break;
1189 default:
1190 dev_err(priv->dev, "invalid STP state: %u\n", state);
1191 return;
1192 }
1193
1194 regmap_update_bits(priv->map, RTL8365MB_MSTI_CTRL_REG(msti, port),
1195 RTL8365MB_MSTI_CTRL_PORT_STATE_MASK(port),
1196 val << RTL8365MB_MSTI_CTRL_PORT_STATE_OFFSET(port));
1197 }
1198
rtl8365mb_port_set_learning(struct realtek_priv * priv,int port,bool enable)1199 static int rtl8365mb_port_set_learning(struct realtek_priv *priv, int port,
1200 bool enable)
1201 {
1202 /* Enable/disable learning by limiting the number of L2 addresses the
1203 * port can learn. Realtek documentation states that a limit of zero
1204 * disables learning. When enabling learning, set it to the chip's
1205 * maximum.
1206 */
1207 return regmap_write(priv->map, RTL8365MB_LUT_PORT_LEARN_LIMIT_REG(port),
1208 enable ? RTL8365MB_LEARN_LIMIT_MAX : 0);
1209 }
1210
rtl8365mb_port_set_isolation(struct realtek_priv * priv,int port,u32 mask)1211 static int rtl8365mb_port_set_isolation(struct realtek_priv *priv, int port,
1212 u32 mask)
1213 {
1214 return regmap_write(priv->map, RTL8365MB_PORT_ISOLATION_REG(port), mask);
1215 }
1216
rtl8365mb_mib_counter_read(struct realtek_priv * priv,int port,u32 offset,u32 length,u64 * mibvalue)1217 static int rtl8365mb_mib_counter_read(struct realtek_priv *priv, int port,
1218 u32 offset, u32 length, u64 *mibvalue)
1219 {
1220 u64 tmpvalue = 0;
1221 u32 val;
1222 int ret;
1223 int i;
1224
1225 /* The MIB address is an SRAM address. We request a particular address
1226 * and then poll the control register before reading the value from some
1227 * counter registers.
1228 */
1229 ret = regmap_write(priv->map, RTL8365MB_MIB_ADDRESS_REG,
1230 RTL8365MB_MIB_ADDRESS(port, offset));
1231 if (ret)
1232 return ret;
1233
1234 /* Poll for completion */
1235 ret = regmap_read_poll_timeout(priv->map, RTL8365MB_MIB_CTRL0_REG, val,
1236 !(val & RTL8365MB_MIB_CTRL0_BUSY_MASK),
1237 10, 100);
1238 if (ret)
1239 return ret;
1240
1241 /* Presumably this indicates a MIB counter read failure */
1242 if (val & RTL8365MB_MIB_CTRL0_RESET_MASK)
1243 return -EIO;
1244
1245 /* There are four MIB counter registers each holding a 16 bit word of a
1246 * MIB counter. Depending on the offset, we should read from the upper
1247 * two or lower two registers. In case the MIB counter is 4 words, we
1248 * read from all four registers.
1249 */
1250 if (length == 4)
1251 offset = 3;
1252 else
1253 offset = (offset + 1) % 4;
1254
1255 /* Read the MIB counter 16 bits at a time */
1256 for (i = 0; i < length; i++) {
1257 ret = regmap_read(priv->map,
1258 RTL8365MB_MIB_COUNTER_REG(offset - i), &val);
1259 if (ret)
1260 return ret;
1261
1262 tmpvalue = ((tmpvalue) << 16) | (val & 0xFFFF);
1263 }
1264
1265 /* Only commit the result if no error occurred */
1266 *mibvalue = tmpvalue;
1267
1268 return 0;
1269 }
1270
rtl8365mb_get_ethtool_stats(struct dsa_switch * ds,int port,u64 * data)1271 static void rtl8365mb_get_ethtool_stats(struct dsa_switch *ds, int port, u64 *data)
1272 {
1273 struct realtek_priv *priv = ds->priv;
1274 struct rtl8365mb *mb;
1275 int ret;
1276 int i;
1277
1278 mb = priv->chip_data;
1279
1280 mutex_lock(&mb->mib_lock);
1281 for (i = 0; i < RTL8365MB_MIB_END; i++) {
1282 struct rtl8365mb_mib_counter *mib = &rtl8365mb_mib_counters[i];
1283
1284 ret = rtl8365mb_mib_counter_read(priv, port, mib->offset,
1285 mib->length, &data[i]);
1286 if (ret) {
1287 dev_err(priv->dev,
1288 "failed to read port %d counters: %d\n", port,
1289 ret);
1290 break;
1291 }
1292 }
1293 mutex_unlock(&mb->mib_lock);
1294 }
1295
rtl8365mb_get_strings(struct dsa_switch * ds,int port,u32 stringset,u8 * data)1296 static void rtl8365mb_get_strings(struct dsa_switch *ds, int port, u32 stringset, u8 *data)
1297 {
1298 int i;
1299
1300 if (stringset != ETH_SS_STATS)
1301 return;
1302
1303 for (i = 0; i < RTL8365MB_MIB_END; i++) {
1304 struct rtl8365mb_mib_counter *mib = &rtl8365mb_mib_counters[i];
1305 ethtool_puts(&data, mib->name);
1306 }
1307 }
1308
rtl8365mb_get_sset_count(struct dsa_switch * ds,int port,int sset)1309 static int rtl8365mb_get_sset_count(struct dsa_switch *ds, int port, int sset)
1310 {
1311 if (sset != ETH_SS_STATS)
1312 return -EOPNOTSUPP;
1313
1314 return RTL8365MB_MIB_END;
1315 }
1316
rtl8365mb_get_phy_stats(struct dsa_switch * ds,int port,struct ethtool_eth_phy_stats * phy_stats)1317 static void rtl8365mb_get_phy_stats(struct dsa_switch *ds, int port,
1318 struct ethtool_eth_phy_stats *phy_stats)
1319 {
1320 struct realtek_priv *priv = ds->priv;
1321 struct rtl8365mb_mib_counter *mib;
1322 struct rtl8365mb *mb;
1323
1324 mb = priv->chip_data;
1325 mib = &rtl8365mb_mib_counters[RTL8365MB_MIB_dot3StatsSymbolErrors];
1326
1327 mutex_lock(&mb->mib_lock);
1328 rtl8365mb_mib_counter_read(priv, port, mib->offset, mib->length,
1329 &phy_stats->SymbolErrorDuringCarrier);
1330 mutex_unlock(&mb->mib_lock);
1331 }
1332
rtl8365mb_get_mac_stats(struct dsa_switch * ds,int port,struct ethtool_eth_mac_stats * mac_stats)1333 static void rtl8365mb_get_mac_stats(struct dsa_switch *ds, int port,
1334 struct ethtool_eth_mac_stats *mac_stats)
1335 {
1336 u64 cnt[RTL8365MB_MIB_END] = {
1337 [RTL8365MB_MIB_ifOutOctets] = 1,
1338 [RTL8365MB_MIB_ifOutUcastPkts] = 1,
1339 [RTL8365MB_MIB_ifOutMulticastPkts] = 1,
1340 [RTL8365MB_MIB_ifOutBroadcastPkts] = 1,
1341 [RTL8365MB_MIB_dot3OutPauseFrames] = 1,
1342 [RTL8365MB_MIB_ifOutDiscards] = 1,
1343 [RTL8365MB_MIB_ifInOctets] = 1,
1344 [RTL8365MB_MIB_ifInUcastPkts] = 1,
1345 [RTL8365MB_MIB_ifInMulticastPkts] = 1,
1346 [RTL8365MB_MIB_ifInBroadcastPkts] = 1,
1347 [RTL8365MB_MIB_dot3InPauseFrames] = 1,
1348 [RTL8365MB_MIB_dot3StatsSingleCollisionFrames] = 1,
1349 [RTL8365MB_MIB_dot3StatsMultipleCollisionFrames] = 1,
1350 [RTL8365MB_MIB_dot3StatsFCSErrors] = 1,
1351 [RTL8365MB_MIB_dot3StatsDeferredTransmissions] = 1,
1352 [RTL8365MB_MIB_dot3StatsLateCollisions] = 1,
1353 [RTL8365MB_MIB_dot3StatsExcessiveCollisions] = 1,
1354
1355 };
1356 struct realtek_priv *priv = ds->priv;
1357 struct rtl8365mb *mb;
1358 int ret;
1359 int i;
1360
1361 mb = priv->chip_data;
1362
1363 mutex_lock(&mb->mib_lock);
1364 for (i = 0; i < RTL8365MB_MIB_END; i++) {
1365 struct rtl8365mb_mib_counter *mib = &rtl8365mb_mib_counters[i];
1366
1367 /* Only fetch required MIB counters (marked = 1 above) */
1368 if (!cnt[i])
1369 continue;
1370
1371 ret = rtl8365mb_mib_counter_read(priv, port, mib->offset,
1372 mib->length, &cnt[i]);
1373 if (ret)
1374 break;
1375 }
1376 mutex_unlock(&mb->mib_lock);
1377
1378 /* The RTL8365MB-VC exposes MIB objects, which we have to translate into
1379 * IEEE 802.3 Managed Objects. This is not always completely faithful,
1380 * but we try out best. See RFC 3635 for a detailed treatment of the
1381 * subject.
1382 */
1383
1384 mac_stats->FramesTransmittedOK = cnt[RTL8365MB_MIB_ifOutUcastPkts] +
1385 cnt[RTL8365MB_MIB_ifOutMulticastPkts] +
1386 cnt[RTL8365MB_MIB_ifOutBroadcastPkts] +
1387 cnt[RTL8365MB_MIB_dot3OutPauseFrames] -
1388 cnt[RTL8365MB_MIB_ifOutDiscards];
1389 mac_stats->SingleCollisionFrames =
1390 cnt[RTL8365MB_MIB_dot3StatsSingleCollisionFrames];
1391 mac_stats->MultipleCollisionFrames =
1392 cnt[RTL8365MB_MIB_dot3StatsMultipleCollisionFrames];
1393 mac_stats->FramesReceivedOK = cnt[RTL8365MB_MIB_ifInUcastPkts] +
1394 cnt[RTL8365MB_MIB_ifInMulticastPkts] +
1395 cnt[RTL8365MB_MIB_ifInBroadcastPkts] +
1396 cnt[RTL8365MB_MIB_dot3InPauseFrames];
1397 mac_stats->FrameCheckSequenceErrors =
1398 cnt[RTL8365MB_MIB_dot3StatsFCSErrors];
1399 mac_stats->OctetsTransmittedOK = cnt[RTL8365MB_MIB_ifOutOctets] -
1400 18 * mac_stats->FramesTransmittedOK;
1401 mac_stats->FramesWithDeferredXmissions =
1402 cnt[RTL8365MB_MIB_dot3StatsDeferredTransmissions];
1403 mac_stats->LateCollisions = cnt[RTL8365MB_MIB_dot3StatsLateCollisions];
1404 mac_stats->FramesAbortedDueToXSColls =
1405 cnt[RTL8365MB_MIB_dot3StatsExcessiveCollisions];
1406 mac_stats->OctetsReceivedOK = cnt[RTL8365MB_MIB_ifInOctets] -
1407 18 * mac_stats->FramesReceivedOK;
1408 mac_stats->MulticastFramesXmittedOK =
1409 cnt[RTL8365MB_MIB_ifOutMulticastPkts];
1410 mac_stats->BroadcastFramesXmittedOK =
1411 cnt[RTL8365MB_MIB_ifOutBroadcastPkts];
1412 mac_stats->MulticastFramesReceivedOK =
1413 cnt[RTL8365MB_MIB_ifInMulticastPkts];
1414 mac_stats->BroadcastFramesReceivedOK =
1415 cnt[RTL8365MB_MIB_ifInBroadcastPkts];
1416 }
1417
rtl8365mb_get_ctrl_stats(struct dsa_switch * ds,int port,struct ethtool_eth_ctrl_stats * ctrl_stats)1418 static void rtl8365mb_get_ctrl_stats(struct dsa_switch *ds, int port,
1419 struct ethtool_eth_ctrl_stats *ctrl_stats)
1420 {
1421 struct realtek_priv *priv = ds->priv;
1422 struct rtl8365mb_mib_counter *mib;
1423 struct rtl8365mb *mb;
1424
1425 mb = priv->chip_data;
1426 mib = &rtl8365mb_mib_counters[RTL8365MB_MIB_dot3ControlInUnknownOpcodes];
1427
1428 mutex_lock(&mb->mib_lock);
1429 rtl8365mb_mib_counter_read(priv, port, mib->offset, mib->length,
1430 &ctrl_stats->UnsupportedOpcodesReceived);
1431 mutex_unlock(&mb->mib_lock);
1432 }
1433
rtl8365mb_stats_update(struct realtek_priv * priv,int port)1434 static void rtl8365mb_stats_update(struct realtek_priv *priv, int port)
1435 {
1436 u64 cnt[RTL8365MB_MIB_END] = {
1437 [RTL8365MB_MIB_ifOutOctets] = 1,
1438 [RTL8365MB_MIB_ifOutUcastPkts] = 1,
1439 [RTL8365MB_MIB_ifOutMulticastPkts] = 1,
1440 [RTL8365MB_MIB_ifOutBroadcastPkts] = 1,
1441 [RTL8365MB_MIB_ifOutDiscards] = 1,
1442 [RTL8365MB_MIB_ifInOctets] = 1,
1443 [RTL8365MB_MIB_ifInUcastPkts] = 1,
1444 [RTL8365MB_MIB_ifInMulticastPkts] = 1,
1445 [RTL8365MB_MIB_ifInBroadcastPkts] = 1,
1446 [RTL8365MB_MIB_etherStatsDropEvents] = 1,
1447 [RTL8365MB_MIB_etherStatsCollisions] = 1,
1448 [RTL8365MB_MIB_etherStatsFragments] = 1,
1449 [RTL8365MB_MIB_etherStatsJabbers] = 1,
1450 [RTL8365MB_MIB_dot3StatsFCSErrors] = 1,
1451 [RTL8365MB_MIB_dot3StatsLateCollisions] = 1,
1452 };
1453 struct rtl8365mb *mb = priv->chip_data;
1454 struct rtnl_link_stats64 *stats;
1455 int ret;
1456 int i;
1457
1458 stats = &mb->ports[port].stats;
1459
1460 mutex_lock(&mb->mib_lock);
1461 for (i = 0; i < RTL8365MB_MIB_END; i++) {
1462 struct rtl8365mb_mib_counter *c = &rtl8365mb_mib_counters[i];
1463
1464 /* Only fetch required MIB counters (marked = 1 above) */
1465 if (!cnt[i])
1466 continue;
1467
1468 ret = rtl8365mb_mib_counter_read(priv, port, c->offset,
1469 c->length, &cnt[i]);
1470 if (ret)
1471 break;
1472 }
1473 mutex_unlock(&mb->mib_lock);
1474
1475 /* Don't update statistics if there was an error reading the counters */
1476 if (ret)
1477 return;
1478
1479 spin_lock(&mb->ports[port].stats_lock);
1480
1481 stats->rx_packets = cnt[RTL8365MB_MIB_ifInUcastPkts] +
1482 cnt[RTL8365MB_MIB_ifInMulticastPkts] +
1483 cnt[RTL8365MB_MIB_ifInBroadcastPkts] -
1484 cnt[RTL8365MB_MIB_ifOutDiscards];
1485
1486 stats->tx_packets = cnt[RTL8365MB_MIB_ifOutUcastPkts] +
1487 cnt[RTL8365MB_MIB_ifOutMulticastPkts] +
1488 cnt[RTL8365MB_MIB_ifOutBroadcastPkts];
1489
1490 /* if{In,Out}Octets includes FCS - remove it */
1491 stats->rx_bytes = cnt[RTL8365MB_MIB_ifInOctets] - 4 * stats->rx_packets;
1492 stats->tx_bytes =
1493 cnt[RTL8365MB_MIB_ifOutOctets] - 4 * stats->tx_packets;
1494
1495 stats->rx_dropped = cnt[RTL8365MB_MIB_etherStatsDropEvents];
1496 stats->tx_dropped = cnt[RTL8365MB_MIB_ifOutDiscards];
1497
1498 stats->multicast = cnt[RTL8365MB_MIB_ifInMulticastPkts];
1499 stats->collisions = cnt[RTL8365MB_MIB_etherStatsCollisions];
1500
1501 stats->rx_length_errors = cnt[RTL8365MB_MIB_etherStatsFragments] +
1502 cnt[RTL8365MB_MIB_etherStatsJabbers];
1503 stats->rx_crc_errors = cnt[RTL8365MB_MIB_dot3StatsFCSErrors];
1504 stats->rx_errors = stats->rx_length_errors + stats->rx_crc_errors;
1505
1506 stats->tx_aborted_errors = cnt[RTL8365MB_MIB_ifOutDiscards];
1507 stats->tx_window_errors = cnt[RTL8365MB_MIB_dot3StatsLateCollisions];
1508 stats->tx_errors = stats->tx_aborted_errors + stats->tx_window_errors;
1509
1510 spin_unlock(&mb->ports[port].stats_lock);
1511 }
1512
rtl8365mb_stats_poll(struct work_struct * work)1513 static void rtl8365mb_stats_poll(struct work_struct *work)
1514 {
1515 struct rtl8365mb_port *p = container_of(to_delayed_work(work),
1516 struct rtl8365mb_port,
1517 mib_work);
1518 struct realtek_priv *priv = p->priv;
1519
1520 rtl8365mb_stats_update(priv, p->index);
1521
1522 schedule_delayed_work(&p->mib_work, RTL8365MB_STATS_INTERVAL_JIFFIES);
1523 }
1524
rtl8365mb_get_stats64(struct dsa_switch * ds,int port,struct rtnl_link_stats64 * s)1525 static void rtl8365mb_get_stats64(struct dsa_switch *ds, int port,
1526 struct rtnl_link_stats64 *s)
1527 {
1528 struct realtek_priv *priv = ds->priv;
1529 struct rtl8365mb_port *p;
1530 struct rtl8365mb *mb;
1531
1532 mb = priv->chip_data;
1533 p = &mb->ports[port];
1534
1535 spin_lock(&p->stats_lock);
1536 memcpy(s, &p->stats, sizeof(*s));
1537 spin_unlock(&p->stats_lock);
1538 }
1539
rtl8365mb_stats_setup(struct realtek_priv * priv)1540 static void rtl8365mb_stats_setup(struct realtek_priv *priv)
1541 {
1542 struct rtl8365mb *mb = priv->chip_data;
1543 struct dsa_switch *ds = &priv->ds;
1544 int i;
1545
1546 /* Per-chip global mutex to protect MIB counter access, since doing
1547 * so requires accessing a series of registers in a particular order.
1548 */
1549 mutex_init(&mb->mib_lock);
1550
1551 for (i = 0; i < priv->num_ports; i++) {
1552 struct rtl8365mb_port *p = &mb->ports[i];
1553
1554 if (dsa_is_unused_port(ds, i))
1555 continue;
1556
1557 /* Per-port spinlock to protect the stats64 data */
1558 spin_lock_init(&p->stats_lock);
1559
1560 /* This work polls the MIB counters and keeps the stats64 data
1561 * up-to-date.
1562 */
1563 INIT_DELAYED_WORK(&p->mib_work, rtl8365mb_stats_poll);
1564 }
1565 }
1566
rtl8365mb_stats_teardown(struct realtek_priv * priv)1567 static void rtl8365mb_stats_teardown(struct realtek_priv *priv)
1568 {
1569 struct rtl8365mb *mb = priv->chip_data;
1570 struct dsa_switch *ds = &priv->ds;
1571 int i;
1572
1573 for (i = 0; i < priv->num_ports; i++) {
1574 struct rtl8365mb_port *p = &mb->ports[i];
1575
1576 if (dsa_is_unused_port(ds, i))
1577 continue;
1578
1579 cancel_delayed_work_sync(&p->mib_work);
1580 }
1581 }
1582
rtl8365mb_get_and_clear_status_reg(struct realtek_priv * priv,u32 reg,u32 * val)1583 static int rtl8365mb_get_and_clear_status_reg(struct realtek_priv *priv, u32 reg,
1584 u32 *val)
1585 {
1586 int ret;
1587
1588 ret = regmap_read(priv->map, reg, val);
1589 if (ret)
1590 return ret;
1591
1592 return regmap_write(priv->map, reg, *val);
1593 }
1594
rtl8365mb_irq(int irq,void * data)1595 static irqreturn_t rtl8365mb_irq(int irq, void *data)
1596 {
1597 struct realtek_priv *priv = data;
1598 unsigned long line_changes = 0;
1599 u32 stat;
1600 int line;
1601 int ret;
1602
1603 ret = rtl8365mb_get_and_clear_status_reg(priv, RTL8365MB_INTR_STATUS_REG,
1604 &stat);
1605 if (ret)
1606 goto out_error;
1607
1608 if (stat & RTL8365MB_INTR_LINK_CHANGE_MASK) {
1609 u32 linkdown_ind;
1610 u32 linkup_ind;
1611 u32 val;
1612
1613 ret = rtl8365mb_get_and_clear_status_reg(
1614 priv, RTL8365MB_PORT_LINKUP_IND_REG, &val);
1615 if (ret)
1616 goto out_error;
1617
1618 linkup_ind = FIELD_GET(RTL8365MB_PORT_LINKUP_IND_MASK, val);
1619
1620 ret = rtl8365mb_get_and_clear_status_reg(
1621 priv, RTL8365MB_PORT_LINKDOWN_IND_REG, &val);
1622 if (ret)
1623 goto out_error;
1624
1625 linkdown_ind = FIELD_GET(RTL8365MB_PORT_LINKDOWN_IND_MASK, val);
1626
1627 line_changes = linkup_ind | linkdown_ind;
1628 }
1629
1630 if (!line_changes)
1631 goto out_none;
1632
1633 for_each_set_bit(line, &line_changes, priv->num_ports) {
1634 int child_irq = irq_find_mapping(priv->irqdomain, line);
1635
1636 handle_nested_irq(child_irq);
1637 }
1638
1639 return IRQ_HANDLED;
1640
1641 out_error:
1642 dev_err(priv->dev, "failed to read interrupt status: %d\n", ret);
1643
1644 out_none:
1645 return IRQ_NONE;
1646 }
1647
1648 static struct irq_chip rtl8365mb_irq_chip = {
1649 .name = "rtl8365mb",
1650 /* The hardware doesn't support masking IRQs on a per-port basis */
1651 };
1652
rtl8365mb_irq_map(struct irq_domain * domain,unsigned int irq,irq_hw_number_t hwirq)1653 static int rtl8365mb_irq_map(struct irq_domain *domain, unsigned int irq,
1654 irq_hw_number_t hwirq)
1655 {
1656 irq_set_chip_data(irq, domain->host_data);
1657 irq_set_chip_and_handler(irq, &rtl8365mb_irq_chip, handle_simple_irq);
1658 irq_set_nested_thread(irq, 1);
1659 irq_set_noprobe(irq);
1660
1661 return 0;
1662 }
1663
rtl8365mb_irq_unmap(struct irq_domain * d,unsigned int irq)1664 static void rtl8365mb_irq_unmap(struct irq_domain *d, unsigned int irq)
1665 {
1666 irq_set_nested_thread(irq, 0);
1667 irq_set_chip_and_handler(irq, NULL, NULL);
1668 irq_set_chip_data(irq, NULL);
1669 }
1670
1671 static const struct irq_domain_ops rtl8365mb_irqdomain_ops = {
1672 .map = rtl8365mb_irq_map,
1673 .unmap = rtl8365mb_irq_unmap,
1674 .xlate = irq_domain_xlate_onecell,
1675 };
1676
rtl8365mb_set_irq_enable(struct realtek_priv * priv,bool enable)1677 static int rtl8365mb_set_irq_enable(struct realtek_priv *priv, bool enable)
1678 {
1679 return regmap_update_bits(priv->map, RTL8365MB_INTR_CTRL_REG,
1680 RTL8365MB_INTR_LINK_CHANGE_MASK,
1681 FIELD_PREP(RTL8365MB_INTR_LINK_CHANGE_MASK,
1682 enable ? 1 : 0));
1683 }
1684
rtl8365mb_irq_enable(struct realtek_priv * priv)1685 static int rtl8365mb_irq_enable(struct realtek_priv *priv)
1686 {
1687 return rtl8365mb_set_irq_enable(priv, true);
1688 }
1689
rtl8365mb_irq_disable(struct realtek_priv * priv)1690 static int rtl8365mb_irq_disable(struct realtek_priv *priv)
1691 {
1692 return rtl8365mb_set_irq_enable(priv, false);
1693 }
1694
rtl8365mb_irq_setup(struct realtek_priv * priv)1695 static int rtl8365mb_irq_setup(struct realtek_priv *priv)
1696 {
1697 struct rtl8365mb *mb = priv->chip_data;
1698 struct device_node *intc;
1699 u32 irq_trig;
1700 int virq;
1701 int irq;
1702 u32 val;
1703 int ret;
1704 int i;
1705
1706 intc = of_get_child_by_name(priv->dev->of_node, "interrupt-controller");
1707 if (!intc) {
1708 dev_err(priv->dev, "missing child interrupt-controller node\n");
1709 return -EINVAL;
1710 }
1711
1712 /* rtl8365mb IRQs cascade off this one */
1713 irq = of_irq_get(intc, 0);
1714 if (irq <= 0) {
1715 if (irq != -EPROBE_DEFER)
1716 dev_err(priv->dev, "failed to get parent irq: %d\n",
1717 irq);
1718 ret = irq ? irq : -EINVAL;
1719 goto out_put_node;
1720 }
1721
1722 priv->irqdomain = irq_domain_add_linear(intc, priv->num_ports,
1723 &rtl8365mb_irqdomain_ops, priv);
1724 if (!priv->irqdomain) {
1725 dev_err(priv->dev, "failed to add irq domain\n");
1726 ret = -ENOMEM;
1727 goto out_put_node;
1728 }
1729
1730 for (i = 0; i < priv->num_ports; i++) {
1731 virq = irq_create_mapping(priv->irqdomain, i);
1732 if (!virq) {
1733 dev_err(priv->dev,
1734 "failed to create irq domain mapping\n");
1735 ret = -EINVAL;
1736 goto out_remove_irqdomain;
1737 }
1738
1739 irq_set_parent(virq, irq);
1740 }
1741
1742 /* Configure chip interrupt signal polarity */
1743 irq_trig = irq_get_trigger_type(irq);
1744 switch (irq_trig) {
1745 case IRQF_TRIGGER_RISING:
1746 case IRQF_TRIGGER_HIGH:
1747 val = RTL8365MB_INTR_POLARITY_HIGH;
1748 break;
1749 case IRQF_TRIGGER_FALLING:
1750 case IRQF_TRIGGER_LOW:
1751 val = RTL8365MB_INTR_POLARITY_LOW;
1752 break;
1753 default:
1754 dev_err(priv->dev, "unsupported irq trigger type %u\n",
1755 irq_trig);
1756 ret = -EINVAL;
1757 goto out_remove_irqdomain;
1758 }
1759
1760 ret = regmap_update_bits(priv->map, RTL8365MB_INTR_POLARITY_REG,
1761 RTL8365MB_INTR_POLARITY_MASK,
1762 FIELD_PREP(RTL8365MB_INTR_POLARITY_MASK, val));
1763 if (ret)
1764 goto out_remove_irqdomain;
1765
1766 /* Disable the interrupt in case the chip has it enabled on reset */
1767 ret = rtl8365mb_irq_disable(priv);
1768 if (ret)
1769 goto out_remove_irqdomain;
1770
1771 /* Clear the interrupt status register */
1772 ret = regmap_write(priv->map, RTL8365MB_INTR_STATUS_REG,
1773 RTL8365MB_INTR_ALL_MASK);
1774 if (ret)
1775 goto out_remove_irqdomain;
1776
1777 ret = request_threaded_irq(irq, NULL, rtl8365mb_irq, IRQF_ONESHOT,
1778 "rtl8365mb", priv);
1779 if (ret) {
1780 dev_err(priv->dev, "failed to request irq: %d\n", ret);
1781 goto out_remove_irqdomain;
1782 }
1783
1784 /* Store the irq so that we know to free it during teardown */
1785 mb->irq = irq;
1786
1787 ret = rtl8365mb_irq_enable(priv);
1788 if (ret)
1789 goto out_free_irq;
1790
1791 of_node_put(intc);
1792
1793 return 0;
1794
1795 out_free_irq:
1796 free_irq(mb->irq, priv);
1797 mb->irq = 0;
1798
1799 out_remove_irqdomain:
1800 for (i = 0; i < priv->num_ports; i++) {
1801 virq = irq_find_mapping(priv->irqdomain, i);
1802 irq_dispose_mapping(virq);
1803 }
1804
1805 irq_domain_remove(priv->irqdomain);
1806 priv->irqdomain = NULL;
1807
1808 out_put_node:
1809 of_node_put(intc);
1810
1811 return ret;
1812 }
1813
rtl8365mb_irq_teardown(struct realtek_priv * priv)1814 static void rtl8365mb_irq_teardown(struct realtek_priv *priv)
1815 {
1816 struct rtl8365mb *mb = priv->chip_data;
1817 int virq;
1818 int i;
1819
1820 if (mb->irq) {
1821 free_irq(mb->irq, priv);
1822 mb->irq = 0;
1823 }
1824
1825 if (priv->irqdomain) {
1826 for (i = 0; i < priv->num_ports; i++) {
1827 virq = irq_find_mapping(priv->irqdomain, i);
1828 irq_dispose_mapping(virq);
1829 }
1830
1831 irq_domain_remove(priv->irqdomain);
1832 priv->irqdomain = NULL;
1833 }
1834 }
1835
rtl8365mb_cpu_config(struct realtek_priv * priv)1836 static int rtl8365mb_cpu_config(struct realtek_priv *priv)
1837 {
1838 struct rtl8365mb *mb = priv->chip_data;
1839 struct rtl8365mb_cpu *cpu = &mb->cpu;
1840 u32 val;
1841 int ret;
1842
1843 ret = regmap_update_bits(priv->map, RTL8365MB_CPU_PORT_MASK_REG,
1844 RTL8365MB_CPU_PORT_MASK_MASK,
1845 FIELD_PREP(RTL8365MB_CPU_PORT_MASK_MASK,
1846 cpu->mask));
1847 if (ret)
1848 return ret;
1849
1850 val = FIELD_PREP(RTL8365MB_CPU_CTRL_EN_MASK, cpu->enable ? 1 : 0) |
1851 FIELD_PREP(RTL8365MB_CPU_CTRL_INSERTMODE_MASK, cpu->insert) |
1852 FIELD_PREP(RTL8365MB_CPU_CTRL_TAG_POSITION_MASK, cpu->position) |
1853 FIELD_PREP(RTL8365MB_CPU_CTRL_RXBYTECOUNT_MASK, cpu->rx_length) |
1854 FIELD_PREP(RTL8365MB_CPU_CTRL_TAG_FORMAT_MASK, cpu->format) |
1855 FIELD_PREP(RTL8365MB_CPU_CTRL_TRAP_PORT_MASK, cpu->trap_port & 0x7) |
1856 FIELD_PREP(RTL8365MB_CPU_CTRL_TRAP_PORT_EXT_MASK,
1857 cpu->trap_port >> 3 & 0x1);
1858 ret = regmap_write(priv->map, RTL8365MB_CPU_CTRL_REG, val);
1859 if (ret)
1860 return ret;
1861
1862 return 0;
1863 }
1864
rtl8365mb_change_tag_protocol(struct dsa_switch * ds,enum dsa_tag_protocol proto)1865 static int rtl8365mb_change_tag_protocol(struct dsa_switch *ds,
1866 enum dsa_tag_protocol proto)
1867 {
1868 struct realtek_priv *priv = ds->priv;
1869 struct rtl8365mb_cpu *cpu;
1870 struct rtl8365mb *mb;
1871
1872 mb = priv->chip_data;
1873 cpu = &mb->cpu;
1874
1875 switch (proto) {
1876 case DSA_TAG_PROTO_RTL8_4:
1877 cpu->format = RTL8365MB_CPU_FORMAT_8BYTES;
1878 cpu->position = RTL8365MB_CPU_POS_AFTER_SA;
1879 break;
1880 case DSA_TAG_PROTO_RTL8_4T:
1881 cpu->format = RTL8365MB_CPU_FORMAT_8BYTES;
1882 cpu->position = RTL8365MB_CPU_POS_BEFORE_CRC;
1883 break;
1884 /* The switch also supports a 4-byte format, similar to rtl4a but with
1885 * the same 0x04 8-bit version and probably 8-bit port source/dest.
1886 * There is no public doc about it. Not supported yet and it will probably
1887 * never be.
1888 */
1889 default:
1890 return -EPROTONOSUPPORT;
1891 }
1892
1893 return rtl8365mb_cpu_config(priv);
1894 }
1895
rtl8365mb_switch_init(struct realtek_priv * priv)1896 static int rtl8365mb_switch_init(struct realtek_priv *priv)
1897 {
1898 struct rtl8365mb *mb = priv->chip_data;
1899 const struct rtl8365mb_chip_info *ci;
1900 int ret;
1901 int i;
1902
1903 ci = mb->chip_info;
1904
1905 /* Do any chip-specific init jam before getting to the common stuff */
1906 if (ci->jam_table) {
1907 for (i = 0; i < ci->jam_size; i++) {
1908 ret = regmap_write(priv->map, ci->jam_table[i].reg,
1909 ci->jam_table[i].val);
1910 if (ret)
1911 return ret;
1912 }
1913 }
1914
1915 /* Common init jam */
1916 for (i = 0; i < ARRAY_SIZE(rtl8365mb_init_jam_common); i++) {
1917 ret = regmap_write(priv->map, rtl8365mb_init_jam_common[i].reg,
1918 rtl8365mb_init_jam_common[i].val);
1919 if (ret)
1920 return ret;
1921 }
1922
1923 return 0;
1924 }
1925
rtl8365mb_reset_chip(struct realtek_priv * priv)1926 static int rtl8365mb_reset_chip(struct realtek_priv *priv)
1927 {
1928 u32 val;
1929
1930 priv->write_reg_noack(priv, RTL8365MB_CHIP_RESET_REG,
1931 FIELD_PREP(RTL8365MB_CHIP_RESET_HW_MASK, 1));
1932
1933 /* Realtek documentation says the chip needs 1 second to reset. Sleep
1934 * for 100 ms before accessing any registers to prevent ACK timeouts.
1935 */
1936 msleep(100);
1937 return regmap_read_poll_timeout(priv->map, RTL8365MB_CHIP_RESET_REG, val,
1938 !(val & RTL8365MB_CHIP_RESET_HW_MASK),
1939 20000, 1e6);
1940 }
1941
rtl8365mb_setup(struct dsa_switch * ds)1942 static int rtl8365mb_setup(struct dsa_switch *ds)
1943 {
1944 struct realtek_priv *priv = ds->priv;
1945 struct rtl8365mb_cpu *cpu;
1946 struct dsa_port *cpu_dp;
1947 struct rtl8365mb *mb;
1948 int ret;
1949 int i;
1950
1951 mb = priv->chip_data;
1952 cpu = &mb->cpu;
1953
1954 ret = rtl8365mb_reset_chip(priv);
1955 if (ret) {
1956 dev_err(priv->dev, "failed to reset chip: %d\n", ret);
1957 goto out_error;
1958 }
1959
1960 /* Configure switch to vendor-defined initial state */
1961 ret = rtl8365mb_switch_init(priv);
1962 if (ret) {
1963 dev_err(priv->dev, "failed to initialize switch: %d\n", ret);
1964 goto out_error;
1965 }
1966
1967 /* Set up cascading IRQs */
1968 ret = rtl8365mb_irq_setup(priv);
1969 if (ret == -EPROBE_DEFER)
1970 return ret;
1971 else if (ret)
1972 dev_info(priv->dev, "no interrupt support\n");
1973
1974 /* Configure CPU tagging */
1975 dsa_switch_for_each_cpu_port(cpu_dp, ds) {
1976 cpu->mask |= BIT(cpu_dp->index);
1977
1978 if (cpu->trap_port == RTL8365MB_MAX_NUM_PORTS)
1979 cpu->trap_port = cpu_dp->index;
1980 }
1981 cpu->enable = cpu->mask > 0;
1982 ret = rtl8365mb_cpu_config(priv);
1983 if (ret)
1984 goto out_teardown_irq;
1985
1986 /* Configure ports */
1987 for (i = 0; i < priv->num_ports; i++) {
1988 struct rtl8365mb_port *p = &mb->ports[i];
1989
1990 if (dsa_is_unused_port(ds, i))
1991 continue;
1992
1993 /* Forward only to the CPU */
1994 ret = rtl8365mb_port_set_isolation(priv, i, cpu->mask);
1995 if (ret)
1996 goto out_teardown_irq;
1997
1998 /* Disable learning */
1999 ret = rtl8365mb_port_set_learning(priv, i, false);
2000 if (ret)
2001 goto out_teardown_irq;
2002
2003 /* Set the initial STP state of all ports to DISABLED, otherwise
2004 * ports will still forward frames to the CPU despite being
2005 * administratively down by default.
2006 */
2007 rtl8365mb_port_stp_state_set(ds, i, BR_STATE_DISABLED);
2008
2009 /* Set up per-port private data */
2010 p->priv = priv;
2011 p->index = i;
2012 }
2013
2014 ret = rtl8365mb_port_change_mtu(ds, cpu->trap_port, ETH_DATA_LEN);
2015 if (ret)
2016 goto out_teardown_irq;
2017
2018 ret = rtl83xx_setup_user_mdio(ds);
2019 if (ret) {
2020 dev_err(priv->dev, "could not set up MDIO bus\n");
2021 goto out_teardown_irq;
2022 }
2023
2024 /* Start statistics counter polling */
2025 rtl8365mb_stats_setup(priv);
2026
2027 return 0;
2028
2029 out_teardown_irq:
2030 rtl8365mb_irq_teardown(priv);
2031
2032 out_error:
2033 return ret;
2034 }
2035
rtl8365mb_teardown(struct dsa_switch * ds)2036 static void rtl8365mb_teardown(struct dsa_switch *ds)
2037 {
2038 struct realtek_priv *priv = ds->priv;
2039
2040 rtl8365mb_stats_teardown(priv);
2041 rtl8365mb_irq_teardown(priv);
2042 }
2043
rtl8365mb_get_chip_id_and_ver(struct regmap * map,u32 * id,u32 * ver)2044 static int rtl8365mb_get_chip_id_and_ver(struct regmap *map, u32 *id, u32 *ver)
2045 {
2046 int ret;
2047
2048 /* For some reason we have to write a magic value to an arbitrary
2049 * register whenever accessing the chip ID/version registers.
2050 */
2051 ret = regmap_write(map, RTL8365MB_MAGIC_REG, RTL8365MB_MAGIC_VALUE);
2052 if (ret)
2053 return ret;
2054
2055 ret = regmap_read(map, RTL8365MB_CHIP_ID_REG, id);
2056 if (ret)
2057 return ret;
2058
2059 ret = regmap_read(map, RTL8365MB_CHIP_VER_REG, ver);
2060 if (ret)
2061 return ret;
2062
2063 /* Reset magic register */
2064 ret = regmap_write(map, RTL8365MB_MAGIC_REG, 0);
2065 if (ret)
2066 return ret;
2067
2068 return 0;
2069 }
2070
rtl8365mb_detect(struct realtek_priv * priv)2071 static int rtl8365mb_detect(struct realtek_priv *priv)
2072 {
2073 struct rtl8365mb *mb = priv->chip_data;
2074 u32 chip_id;
2075 u32 chip_ver;
2076 int ret;
2077 int i;
2078
2079 ret = rtl8365mb_get_chip_id_and_ver(priv->map, &chip_id, &chip_ver);
2080 if (ret) {
2081 dev_err(priv->dev, "failed to read chip id and version: %d\n",
2082 ret);
2083 return ret;
2084 }
2085
2086 for (i = 0; i < ARRAY_SIZE(rtl8365mb_chip_infos); i++) {
2087 const struct rtl8365mb_chip_info *ci = &rtl8365mb_chip_infos[i];
2088
2089 if (ci->chip_id == chip_id && ci->chip_ver == chip_ver) {
2090 mb->chip_info = ci;
2091 break;
2092 }
2093 }
2094
2095 if (!mb->chip_info) {
2096 dev_err(priv->dev,
2097 "unrecognized switch (id=0x%04x, ver=0x%04x)", chip_id,
2098 chip_ver);
2099 return -ENODEV;
2100 }
2101
2102 dev_info(priv->dev, "found an %s switch\n", mb->chip_info->name);
2103
2104 priv->num_ports = RTL8365MB_MAX_NUM_PORTS;
2105 mb->priv = priv;
2106 mb->cpu.trap_port = RTL8365MB_MAX_NUM_PORTS;
2107 mb->cpu.insert = RTL8365MB_CPU_INSERT_TO_ALL;
2108 mb->cpu.position = RTL8365MB_CPU_POS_AFTER_SA;
2109 mb->cpu.rx_length = RTL8365MB_CPU_RXLEN_64BYTES;
2110 mb->cpu.format = RTL8365MB_CPU_FORMAT_8BYTES;
2111
2112 return 0;
2113 }
2114
2115 static const struct phylink_mac_ops rtl8365mb_phylink_mac_ops = {
2116 .mac_config = rtl8365mb_phylink_mac_config,
2117 .mac_link_down = rtl8365mb_phylink_mac_link_down,
2118 .mac_link_up = rtl8365mb_phylink_mac_link_up,
2119 };
2120
2121 static const struct dsa_switch_ops rtl8365mb_switch_ops = {
2122 .get_tag_protocol = rtl8365mb_get_tag_protocol,
2123 .change_tag_protocol = rtl8365mb_change_tag_protocol,
2124 .setup = rtl8365mb_setup,
2125 .teardown = rtl8365mb_teardown,
2126 .phylink_get_caps = rtl8365mb_phylink_get_caps,
2127 .port_stp_state_set = rtl8365mb_port_stp_state_set,
2128 .get_strings = rtl8365mb_get_strings,
2129 .get_ethtool_stats = rtl8365mb_get_ethtool_stats,
2130 .get_sset_count = rtl8365mb_get_sset_count,
2131 .get_eth_phy_stats = rtl8365mb_get_phy_stats,
2132 .get_eth_mac_stats = rtl8365mb_get_mac_stats,
2133 .get_eth_ctrl_stats = rtl8365mb_get_ctrl_stats,
2134 .get_stats64 = rtl8365mb_get_stats64,
2135 .port_change_mtu = rtl8365mb_port_change_mtu,
2136 .port_max_mtu = rtl8365mb_port_max_mtu,
2137 };
2138
2139 static const struct realtek_ops rtl8365mb_ops = {
2140 .detect = rtl8365mb_detect,
2141 .phy_read = rtl8365mb_phy_read,
2142 .phy_write = rtl8365mb_phy_write,
2143 };
2144
2145 const struct realtek_variant rtl8365mb_variant = {
2146 .ds_ops = &rtl8365mb_switch_ops,
2147 .ops = &rtl8365mb_ops,
2148 .phylink_mac_ops = &rtl8365mb_phylink_mac_ops,
2149 .clk_delay = 10,
2150 .cmd_read = 0xb9,
2151 .cmd_write = 0xb8,
2152 .chip_data_sz = sizeof(struct rtl8365mb),
2153 };
2154
2155 static const struct of_device_id rtl8365mb_of_match[] = {
2156 { .compatible = "realtek,rtl8365mb", .data = &rtl8365mb_variant, },
2157 { /* sentinel */ },
2158 };
2159 MODULE_DEVICE_TABLE(of, rtl8365mb_of_match);
2160
2161 static struct platform_driver rtl8365mb_smi_driver = {
2162 .driver = {
2163 .name = "rtl8365mb-smi",
2164 .of_match_table = rtl8365mb_of_match,
2165 },
2166 .probe = realtek_smi_probe,
2167 .remove = realtek_smi_remove,
2168 .shutdown = realtek_smi_shutdown,
2169 };
2170
2171 static struct mdio_driver rtl8365mb_mdio_driver = {
2172 .mdiodrv.driver = {
2173 .name = "rtl8365mb-mdio",
2174 .of_match_table = rtl8365mb_of_match,
2175 },
2176 .probe = realtek_mdio_probe,
2177 .remove = realtek_mdio_remove,
2178 .shutdown = realtek_mdio_shutdown,
2179 };
2180
rtl8365mb_init(void)2181 static int rtl8365mb_init(void)
2182 {
2183 int ret;
2184
2185 ret = realtek_mdio_driver_register(&rtl8365mb_mdio_driver);
2186 if (ret)
2187 return ret;
2188
2189 ret = realtek_smi_driver_register(&rtl8365mb_smi_driver);
2190 if (ret) {
2191 realtek_mdio_driver_unregister(&rtl8365mb_mdio_driver);
2192 return ret;
2193 }
2194
2195 return 0;
2196 }
2197 module_init(rtl8365mb_init);
2198
rtl8365mb_exit(void)2199 static void __exit rtl8365mb_exit(void)
2200 {
2201 realtek_smi_driver_unregister(&rtl8365mb_smi_driver);
2202 realtek_mdio_driver_unregister(&rtl8365mb_mdio_driver);
2203 }
2204 module_exit(rtl8365mb_exit);
2205
2206 MODULE_AUTHOR("Alvin Šipraga <alsi@bang-olufsen.dk>");
2207 MODULE_DESCRIPTION("Driver for RTL8365MB-VC ethernet switch");
2208 MODULE_LICENSE("GPL");
2209 MODULE_IMPORT_NS("REALTEK_DSA");
2210