1 // SPDX-License-Identifier: (GPL-2.0 OR MIT)
2 /* Distributed Switch Architecture VSC9953 driver
3 * Copyright (C) 2020, Maxim Kochetkov <fido_max@inbox.ru>
5 #include <linux/types.h>
6 #include <soc/mscc/ocelot_vcap.h>
7 #include <soc/mscc/ocelot_sys.h>
8 #include <soc/mscc/ocelot.h>
9 #include <linux/of_platform.h>
10 #include <linux/pcs-lynx.h>
11 #include <linux/packing.h>
12 #include <linux/iopoll.h>
15 #define VSC9953_VCAP_IS2_CNT 1024
16 #define VSC9953_VCAP_IS2_ENTRY_WIDTH 376
17 #define VSC9953_VCAP_PORT_CNT 10
19 #define MSCC_MIIM_REG_STATUS 0x0
20 #define MSCC_MIIM_STATUS_STAT_BUSY BIT(3)
21 #define MSCC_MIIM_REG_CMD 0x8
22 #define MSCC_MIIM_CMD_OPR_WRITE BIT(1)
23 #define MSCC_MIIM_CMD_OPR_READ BIT(2)
24 #define MSCC_MIIM_CMD_WRDATA_SHIFT 4
25 #define MSCC_MIIM_CMD_REGAD_SHIFT 20
26 #define MSCC_MIIM_CMD_PHYAD_SHIFT 25
27 #define MSCC_MIIM_CMD_VLD BIT(31)
28 #define MSCC_MIIM_REG_DATA 0xC
29 #define MSCC_MIIM_DATA_ERROR (BIT(16) | BIT(17))
31 #define MSCC_PHY_REG_PHY_CFG 0x0
32 #define PHY_CFG_PHY_ENA (BIT(0) | BIT(1) | BIT(2) | BIT(3))
33 #define PHY_CFG_PHY_COMMON_RESET BIT(4)
34 #define PHY_CFG_PHY_RESET (BIT(5) | BIT(6) | BIT(7) | BIT(8))
35 #define MSCC_PHY_REG_PHY_STATUS 0x4
37 static const u32 vsc9953_ana_regmap
[] = {
38 REG(ANA_ADVLEARN
, 0x00b500),
39 REG(ANA_VLANMASK
, 0x00b504),
40 REG_RESERVED(ANA_PORT_B_DOMAIN
),
41 REG(ANA_ANAGEFIL
, 0x00b50c),
42 REG(ANA_ANEVENTS
, 0x00b510),
43 REG(ANA_STORMLIMIT_BURST
, 0x00b514),
44 REG(ANA_STORMLIMIT_CFG
, 0x00b518),
45 REG(ANA_ISOLATED_PORTS
, 0x00b528),
46 REG(ANA_COMMUNITY_PORTS
, 0x00b52c),
47 REG(ANA_AUTOAGE
, 0x00b530),
48 REG(ANA_MACTOPTIONS
, 0x00b534),
49 REG(ANA_LEARNDISC
, 0x00b538),
50 REG(ANA_AGENCTRL
, 0x00b53c),
51 REG(ANA_MIRRORPORTS
, 0x00b540),
52 REG(ANA_EMIRRORPORTS
, 0x00b544),
53 REG(ANA_FLOODING
, 0x00b548),
54 REG(ANA_FLOODING_IPMC
, 0x00b54c),
55 REG(ANA_SFLOW_CFG
, 0x00b550),
56 REG(ANA_PORT_MODE
, 0x00b57c),
57 REG_RESERVED(ANA_CUT_THRU_CFG
),
58 REG(ANA_PGID_PGID
, 0x00b600),
59 REG(ANA_TABLES_ANMOVED
, 0x00b4ac),
60 REG(ANA_TABLES_MACHDATA
, 0x00b4b0),
61 REG(ANA_TABLES_MACLDATA
, 0x00b4b4),
62 REG_RESERVED(ANA_TABLES_STREAMDATA
),
63 REG(ANA_TABLES_MACACCESS
, 0x00b4b8),
64 REG(ANA_TABLES_MACTINDX
, 0x00b4bc),
65 REG(ANA_TABLES_VLANACCESS
, 0x00b4c0),
66 REG(ANA_TABLES_VLANTIDX
, 0x00b4c4),
67 REG_RESERVED(ANA_TABLES_ISDXACCESS
),
68 REG_RESERVED(ANA_TABLES_ISDXTIDX
),
69 REG(ANA_TABLES_ENTRYLIM
, 0x00b480),
70 REG_RESERVED(ANA_TABLES_PTP_ID_HIGH
),
71 REG_RESERVED(ANA_TABLES_PTP_ID_LOW
),
72 REG_RESERVED(ANA_TABLES_STREAMACCESS
),
73 REG_RESERVED(ANA_TABLES_STREAMTIDX
),
74 REG_RESERVED(ANA_TABLES_SEQ_HISTORY
),
75 REG_RESERVED(ANA_TABLES_SEQ_MASK
),
76 REG_RESERVED(ANA_TABLES_SFID_MASK
),
77 REG_RESERVED(ANA_TABLES_SFIDACCESS
),
78 REG_RESERVED(ANA_TABLES_SFIDTIDX
),
79 REG_RESERVED(ANA_MSTI_STATE
),
80 REG_RESERVED(ANA_OAM_UPM_LM_CNT
),
81 REG_RESERVED(ANA_SG_ACCESS_CTRL
),
82 REG_RESERVED(ANA_SG_CONFIG_REG_1
),
83 REG_RESERVED(ANA_SG_CONFIG_REG_2
),
84 REG_RESERVED(ANA_SG_CONFIG_REG_3
),
85 REG_RESERVED(ANA_SG_CONFIG_REG_4
),
86 REG_RESERVED(ANA_SG_CONFIG_REG_5
),
87 REG_RESERVED(ANA_SG_GCL_GS_CONFIG
),
88 REG_RESERVED(ANA_SG_GCL_TI_CONFIG
),
89 REG_RESERVED(ANA_SG_STATUS_REG_1
),
90 REG_RESERVED(ANA_SG_STATUS_REG_2
),
91 REG_RESERVED(ANA_SG_STATUS_REG_3
),
92 REG(ANA_PORT_VLAN_CFG
, 0x000000),
93 REG(ANA_PORT_DROP_CFG
, 0x000004),
94 REG(ANA_PORT_QOS_CFG
, 0x000008),
95 REG(ANA_PORT_VCAP_CFG
, 0x00000c),
96 REG(ANA_PORT_VCAP_S1_KEY_CFG
, 0x000010),
97 REG(ANA_PORT_VCAP_S2_CFG
, 0x00001c),
98 REG(ANA_PORT_PCP_DEI_MAP
, 0x000020),
99 REG(ANA_PORT_CPU_FWD_CFG
, 0x000060),
100 REG(ANA_PORT_CPU_FWD_BPDU_CFG
, 0x000064),
101 REG(ANA_PORT_CPU_FWD_GARP_CFG
, 0x000068),
102 REG(ANA_PORT_CPU_FWD_CCM_CFG
, 0x00006c),
103 REG(ANA_PORT_PORT_CFG
, 0x000070),
104 REG(ANA_PORT_POL_CFG
, 0x000074),
105 REG_RESERVED(ANA_PORT_PTP_CFG
),
106 REG_RESERVED(ANA_PORT_PTP_DLY1_CFG
),
107 REG_RESERVED(ANA_PORT_PTP_DLY2_CFG
),
108 REG_RESERVED(ANA_PORT_SFID_CFG
),
109 REG(ANA_PFC_PFC_CFG
, 0x00c000),
110 REG_RESERVED(ANA_PFC_PFC_TIMER
),
111 REG_RESERVED(ANA_IPT_OAM_MEP_CFG
),
112 REG_RESERVED(ANA_IPT_IPT
),
113 REG_RESERVED(ANA_PPT_PPT
),
114 REG_RESERVED(ANA_FID_MAP_FID_MAP
),
115 REG(ANA_AGGR_CFG
, 0x00c600),
116 REG(ANA_CPUQ_CFG
, 0x00c604),
117 REG_RESERVED(ANA_CPUQ_CFG2
),
118 REG(ANA_CPUQ_8021_CFG
, 0x00c60c),
119 REG(ANA_DSCP_CFG
, 0x00c64c),
120 REG(ANA_DSCP_REWR_CFG
, 0x00c74c),
121 REG(ANA_VCAP_RNG_TYPE_CFG
, 0x00c78c),
122 REG(ANA_VCAP_RNG_VAL_CFG
, 0x00c7ac),
123 REG_RESERVED(ANA_VRAP_CFG
),
124 REG_RESERVED(ANA_VRAP_HDR_DATA
),
125 REG_RESERVED(ANA_VRAP_HDR_MASK
),
126 REG(ANA_DISCARD_CFG
, 0x00c7d8),
127 REG(ANA_FID_CFG
, 0x00c7dc),
128 REG(ANA_POL_PIR_CFG
, 0x00a000),
129 REG(ANA_POL_CIR_CFG
, 0x00a004),
130 REG(ANA_POL_MODE_CFG
, 0x00a008),
131 REG(ANA_POL_PIR_STATE
, 0x00a00c),
132 REG(ANA_POL_CIR_STATE
, 0x00a010),
133 REG_RESERVED(ANA_POL_STATE
),
134 REG(ANA_POL_FLOWC
, 0x00c280),
135 REG(ANA_POL_HYST
, 0x00c2ec),
136 REG_RESERVED(ANA_POL_MISC_CFG
),
139 static const u32 vsc9953_qs_regmap
[] = {
140 REG(QS_XTR_GRP_CFG
, 0x000000),
141 REG(QS_XTR_RD
, 0x000008),
142 REG(QS_XTR_FRM_PRUNING
, 0x000010),
143 REG(QS_XTR_FLUSH
, 0x000018),
144 REG(QS_XTR_DATA_PRESENT
, 0x00001c),
145 REG(QS_XTR_CFG
, 0x000020),
146 REG(QS_INJ_GRP_CFG
, 0x000024),
147 REG(QS_INJ_WR
, 0x00002c),
148 REG(QS_INJ_CTRL
, 0x000034),
149 REG(QS_INJ_STATUS
, 0x00003c),
150 REG(QS_INJ_ERR
, 0x000040),
151 REG_RESERVED(QS_INH_DBG
),
154 static const u32 vsc9953_s2_regmap
[] = {
155 REG(S2_CORE_UPDATE_CTRL
, 0x000000),
156 REG(S2_CORE_MV_CFG
, 0x000004),
157 REG(S2_CACHE_ENTRY_DAT
, 0x000008),
158 REG(S2_CACHE_MASK_DAT
, 0x000108),
159 REG(S2_CACHE_ACTION_DAT
, 0x000208),
160 REG(S2_CACHE_CNT_DAT
, 0x000308),
161 REG(S2_CACHE_TG_DAT
, 0x000388),
164 static const u32 vsc9953_qsys_regmap
[] = {
165 REG(QSYS_PORT_MODE
, 0x003600),
166 REG(QSYS_SWITCH_PORT_MODE
, 0x003630),
167 REG(QSYS_STAT_CNT_CFG
, 0x00365c),
168 REG(QSYS_EEE_CFG
, 0x003660),
169 REG(QSYS_EEE_THRES
, 0x003688),
170 REG(QSYS_IGR_NO_SHARING
, 0x00368c),
171 REG(QSYS_EGR_NO_SHARING
, 0x003690),
172 REG(QSYS_SW_STATUS
, 0x003694),
173 REG(QSYS_EXT_CPU_CFG
, 0x0036c0),
174 REG_RESERVED(QSYS_PAD_CFG
),
175 REG(QSYS_CPU_GROUP_MAP
, 0x0036c8),
176 REG_RESERVED(QSYS_QMAP
),
177 REG_RESERVED(QSYS_ISDX_SGRP
),
178 REG_RESERVED(QSYS_TIMED_FRAME_ENTRY
),
179 REG_RESERVED(QSYS_TFRM_MISC
),
180 REG_RESERVED(QSYS_TFRM_PORT_DLY
),
181 REG_RESERVED(QSYS_TFRM_TIMER_CFG_1
),
182 REG_RESERVED(QSYS_TFRM_TIMER_CFG_2
),
183 REG_RESERVED(QSYS_TFRM_TIMER_CFG_3
),
184 REG_RESERVED(QSYS_TFRM_TIMER_CFG_4
),
185 REG_RESERVED(QSYS_TFRM_TIMER_CFG_5
),
186 REG_RESERVED(QSYS_TFRM_TIMER_CFG_6
),
187 REG_RESERVED(QSYS_TFRM_TIMER_CFG_7
),
188 REG_RESERVED(QSYS_TFRM_TIMER_CFG_8
),
189 REG(QSYS_RED_PROFILE
, 0x003724),
190 REG(QSYS_RES_QOS_MODE
, 0x003764),
191 REG(QSYS_RES_CFG
, 0x004000),
192 REG(QSYS_RES_STAT
, 0x004004),
193 REG(QSYS_EGR_DROP_MODE
, 0x003768),
194 REG(QSYS_EQ_CTRL
, 0x00376c),
195 REG_RESERVED(QSYS_EVENTS_CORE
),
196 REG_RESERVED(QSYS_QMAXSDU_CFG_0
),
197 REG_RESERVED(QSYS_QMAXSDU_CFG_1
),
198 REG_RESERVED(QSYS_QMAXSDU_CFG_2
),
199 REG_RESERVED(QSYS_QMAXSDU_CFG_3
),
200 REG_RESERVED(QSYS_QMAXSDU_CFG_4
),
201 REG_RESERVED(QSYS_QMAXSDU_CFG_5
),
202 REG_RESERVED(QSYS_QMAXSDU_CFG_6
),
203 REG_RESERVED(QSYS_QMAXSDU_CFG_7
),
204 REG_RESERVED(QSYS_PREEMPTION_CFG
),
205 REG(QSYS_CIR_CFG
, 0x000000),
206 REG_RESERVED(QSYS_EIR_CFG
),
207 REG(QSYS_SE_CFG
, 0x000008),
208 REG(QSYS_SE_DWRR_CFG
, 0x00000c),
209 REG_RESERVED(QSYS_SE_CONNECT
),
210 REG_RESERVED(QSYS_SE_DLB_SENSE
),
211 REG(QSYS_CIR_STATE
, 0x000044),
212 REG_RESERVED(QSYS_EIR_STATE
),
213 REG_RESERVED(QSYS_SE_STATE
),
214 REG(QSYS_HSCH_MISC_CFG
, 0x003774),
215 REG_RESERVED(QSYS_TAG_CONFIG
),
216 REG_RESERVED(QSYS_TAS_PARAM_CFG_CTRL
),
217 REG_RESERVED(QSYS_PORT_MAX_SDU
),
218 REG_RESERVED(QSYS_PARAM_CFG_REG_1
),
219 REG_RESERVED(QSYS_PARAM_CFG_REG_2
),
220 REG_RESERVED(QSYS_PARAM_CFG_REG_3
),
221 REG_RESERVED(QSYS_PARAM_CFG_REG_4
),
222 REG_RESERVED(QSYS_PARAM_CFG_REG_5
),
223 REG_RESERVED(QSYS_GCL_CFG_REG_1
),
224 REG_RESERVED(QSYS_GCL_CFG_REG_2
),
225 REG_RESERVED(QSYS_PARAM_STATUS_REG_1
),
226 REG_RESERVED(QSYS_PARAM_STATUS_REG_2
),
227 REG_RESERVED(QSYS_PARAM_STATUS_REG_3
),
228 REG_RESERVED(QSYS_PARAM_STATUS_REG_4
),
229 REG_RESERVED(QSYS_PARAM_STATUS_REG_5
),
230 REG_RESERVED(QSYS_PARAM_STATUS_REG_6
),
231 REG_RESERVED(QSYS_PARAM_STATUS_REG_7
),
232 REG_RESERVED(QSYS_PARAM_STATUS_REG_8
),
233 REG_RESERVED(QSYS_PARAM_STATUS_REG_9
),
234 REG_RESERVED(QSYS_GCL_STATUS_REG_1
),
235 REG_RESERVED(QSYS_GCL_STATUS_REG_2
),
238 static const u32 vsc9953_rew_regmap
[] = {
239 REG(REW_PORT_VLAN_CFG
, 0x000000),
240 REG(REW_TAG_CFG
, 0x000004),
241 REG(REW_PORT_CFG
, 0x000008),
242 REG(REW_DSCP_CFG
, 0x00000c),
243 REG(REW_PCP_DEI_QOS_MAP_CFG
, 0x000010),
244 REG_RESERVED(REW_PTP_CFG
),
245 REG_RESERVED(REW_PTP_DLY1_CFG
),
246 REG_RESERVED(REW_RED_TAG_CFG
),
247 REG(REW_DSCP_REMAP_DP1_CFG
, 0x000610),
248 REG(REW_DSCP_REMAP_CFG
, 0x000710),
249 REG_RESERVED(REW_STAT_CFG
),
250 REG_RESERVED(REW_REW_STICKY
),
251 REG_RESERVED(REW_PPT
),
254 static const u32 vsc9953_sys_regmap
[] = {
255 REG(SYS_COUNT_RX_OCTETS
, 0x000000),
256 REG(SYS_COUNT_RX_MULTICAST
, 0x000008),
257 REG(SYS_COUNT_RX_SHORTS
, 0x000010),
258 REG(SYS_COUNT_RX_FRAGMENTS
, 0x000014),
259 REG(SYS_COUNT_RX_JABBERS
, 0x000018),
260 REG(SYS_COUNT_RX_64
, 0x000024),
261 REG(SYS_COUNT_RX_65_127
, 0x000028),
262 REG(SYS_COUNT_RX_128_255
, 0x00002c),
263 REG(SYS_COUNT_RX_256_1023
, 0x000030),
264 REG(SYS_COUNT_RX_1024_1526
, 0x000034),
265 REG(SYS_COUNT_RX_1527_MAX
, 0x000038),
266 REG(SYS_COUNT_RX_LONGS
, 0x000048),
267 REG(SYS_COUNT_TX_OCTETS
, 0x000100),
268 REG(SYS_COUNT_TX_COLLISION
, 0x000110),
269 REG(SYS_COUNT_TX_DROPS
, 0x000114),
270 REG(SYS_COUNT_TX_64
, 0x00011c),
271 REG(SYS_COUNT_TX_65_127
, 0x000120),
272 REG(SYS_COUNT_TX_128_511
, 0x000124),
273 REG(SYS_COUNT_TX_512_1023
, 0x000128),
274 REG(SYS_COUNT_TX_1024_1526
, 0x00012c),
275 REG(SYS_COUNT_TX_1527_MAX
, 0x000130),
276 REG(SYS_COUNT_TX_AGING
, 0x000178),
277 REG(SYS_RESET_CFG
, 0x000318),
278 REG_RESERVED(SYS_SR_ETYPE_CFG
),
279 REG(SYS_VLAN_ETYPE_CFG
, 0x000320),
280 REG(SYS_PORT_MODE
, 0x000324),
281 REG(SYS_FRONT_PORT_MODE
, 0x000354),
282 REG(SYS_FRM_AGING
, 0x00037c),
283 REG(SYS_STAT_CFG
, 0x000380),
284 REG_RESERVED(SYS_SW_STATUS
),
285 REG_RESERVED(SYS_MISC_CFG
),
286 REG_RESERVED(SYS_REW_MAC_HIGH_CFG
),
287 REG_RESERVED(SYS_REW_MAC_LOW_CFG
),
288 REG_RESERVED(SYS_TIMESTAMP_OFFSET
),
289 REG(SYS_PAUSE_CFG
, 0x00044c),
290 REG(SYS_PAUSE_TOT_CFG
, 0x000478),
291 REG(SYS_ATOP
, 0x00047c),
292 REG(SYS_ATOP_TOT_CFG
, 0x0004a8),
293 REG(SYS_MAC_FC_CFG
, 0x0004ac),
294 REG(SYS_MMGT
, 0x0004d4),
295 REG_RESERVED(SYS_MMGT_FAST
),
296 REG_RESERVED(SYS_EVENTS_DIF
),
297 REG_RESERVED(SYS_EVENTS_CORE
),
298 REG_RESERVED(SYS_CNT
),
299 REG_RESERVED(SYS_PTP_STATUS
),
300 REG_RESERVED(SYS_PTP_TXSTAMP
),
301 REG_RESERVED(SYS_PTP_NXT
),
302 REG_RESERVED(SYS_PTP_CFG
),
303 REG_RESERVED(SYS_RAM_INIT
),
304 REG_RESERVED(SYS_CM_ADDR
),
305 REG_RESERVED(SYS_CM_DATA_WR
),
306 REG_RESERVED(SYS_CM_DATA_RD
),
307 REG_RESERVED(SYS_CM_OP
),
308 REG_RESERVED(SYS_CM_DATA
),
311 static const u32 vsc9953_gcb_regmap
[] = {
312 REG(GCB_SOFT_RST
, 0x000008),
313 REG(GCB_MIIM_MII_STATUS
, 0x0000ac),
314 REG(GCB_MIIM_MII_CMD
, 0x0000b4),
315 REG(GCB_MIIM_MII_DATA
, 0x0000b8),
318 static const u32 vsc9953_dev_gmii_regmap
[] = {
319 REG(DEV_CLOCK_CFG
, 0x0),
320 REG(DEV_PORT_MISC
, 0x4),
321 REG_RESERVED(DEV_EVENTS
),
322 REG(DEV_EEE_CFG
, 0xc),
323 REG_RESERVED(DEV_RX_PATH_DELAY
),
324 REG_RESERVED(DEV_TX_PATH_DELAY
),
325 REG_RESERVED(DEV_PTP_PREDICT_CFG
),
326 REG(DEV_MAC_ENA_CFG
, 0x10),
327 REG(DEV_MAC_MODE_CFG
, 0x14),
328 REG(DEV_MAC_MAXLEN_CFG
, 0x18),
329 REG(DEV_MAC_TAGS_CFG
, 0x1c),
330 REG(DEV_MAC_ADV_CHK_CFG
, 0x20),
331 REG(DEV_MAC_IFG_CFG
, 0x24),
332 REG(DEV_MAC_HDX_CFG
, 0x28),
333 REG_RESERVED(DEV_MAC_DBG_CFG
),
334 REG(DEV_MAC_FC_MAC_LOW_CFG
, 0x30),
335 REG(DEV_MAC_FC_MAC_HIGH_CFG
, 0x34),
336 REG(DEV_MAC_STICKY
, 0x38),
337 REG_RESERVED(PCS1G_CFG
),
338 REG_RESERVED(PCS1G_MODE_CFG
),
339 REG_RESERVED(PCS1G_SD_CFG
),
340 REG_RESERVED(PCS1G_ANEG_CFG
),
341 REG_RESERVED(PCS1G_ANEG_NP_CFG
),
342 REG_RESERVED(PCS1G_LB_CFG
),
343 REG_RESERVED(PCS1G_DBG_CFG
),
344 REG_RESERVED(PCS1G_CDET_CFG
),
345 REG_RESERVED(PCS1G_ANEG_STATUS
),
346 REG_RESERVED(PCS1G_ANEG_NP_STATUS
),
347 REG_RESERVED(PCS1G_LINK_STATUS
),
348 REG_RESERVED(PCS1G_LINK_DOWN_CNT
),
349 REG_RESERVED(PCS1G_STICKY
),
350 REG_RESERVED(PCS1G_DEBUG_STATUS
),
351 REG_RESERVED(PCS1G_LPI_CFG
),
352 REG_RESERVED(PCS1G_LPI_WAKE_ERROR_CNT
),
353 REG_RESERVED(PCS1G_LPI_STATUS
),
354 REG_RESERVED(PCS1G_TSTPAT_MODE_CFG
),
355 REG_RESERVED(PCS1G_TSTPAT_STATUS
),
356 REG_RESERVED(DEV_PCS_FX100_CFG
),
357 REG_RESERVED(DEV_PCS_FX100_STATUS
),
360 static const u32
*vsc9953_regmap
[TARGET_MAX
] = {
361 [ANA
] = vsc9953_ana_regmap
,
362 [QS
] = vsc9953_qs_regmap
,
363 [QSYS
] = vsc9953_qsys_regmap
,
364 [REW
] = vsc9953_rew_regmap
,
365 [SYS
] = vsc9953_sys_regmap
,
366 [S2
] = vsc9953_s2_regmap
,
367 [GCB
] = vsc9953_gcb_regmap
,
368 [DEV_GMII
] = vsc9953_dev_gmii_regmap
,
371 /* Addresses are relative to the device's base address */
372 static const struct resource vsc9953_target_io_res
[TARGET_MAX
] = {
411 .name
= "devcpu_gcb",
415 static const struct resource vsc9953_port_io_res
[] = {
468 static const struct reg_field vsc9953_regfields
[REGFIELD_MAX
] = {
469 [ANA_ADVLEARN_VLAN_CHK
] = REG_FIELD(ANA_ADVLEARN
, 10, 10),
470 [ANA_ADVLEARN_LEARN_MIRROR
] = REG_FIELD(ANA_ADVLEARN
, 0, 9),
471 [ANA_ANEVENTS_AUTOAGE
] = REG_FIELD(ANA_ANEVENTS
, 24, 24),
472 [ANA_ANEVENTS_STORM_DROP
] = REG_FIELD(ANA_ANEVENTS
, 22, 22),
473 [ANA_ANEVENTS_LEARN_DROP
] = REG_FIELD(ANA_ANEVENTS
, 21, 21),
474 [ANA_ANEVENTS_AGED_ENTRY
] = REG_FIELD(ANA_ANEVENTS
, 20, 20),
475 [ANA_ANEVENTS_CPU_LEARN_FAILED
] = REG_FIELD(ANA_ANEVENTS
, 19, 19),
476 [ANA_ANEVENTS_AUTO_LEARN_FAILED
] = REG_FIELD(ANA_ANEVENTS
, 18, 18),
477 [ANA_ANEVENTS_LEARN_REMOVE
] = REG_FIELD(ANA_ANEVENTS
, 17, 17),
478 [ANA_ANEVENTS_AUTO_LEARNED
] = REG_FIELD(ANA_ANEVENTS
, 16, 16),
479 [ANA_ANEVENTS_AUTO_MOVED
] = REG_FIELD(ANA_ANEVENTS
, 15, 15),
480 [ANA_ANEVENTS_CLASSIFIED_DROP
] = REG_FIELD(ANA_ANEVENTS
, 13, 13),
481 [ANA_ANEVENTS_CLASSIFIED_COPY
] = REG_FIELD(ANA_ANEVENTS
, 12, 12),
482 [ANA_ANEVENTS_VLAN_DISCARD
] = REG_FIELD(ANA_ANEVENTS
, 11, 11),
483 [ANA_ANEVENTS_FWD_DISCARD
] = REG_FIELD(ANA_ANEVENTS
, 10, 10),
484 [ANA_ANEVENTS_MULTICAST_FLOOD
] = REG_FIELD(ANA_ANEVENTS
, 9, 9),
485 [ANA_ANEVENTS_UNICAST_FLOOD
] = REG_FIELD(ANA_ANEVENTS
, 8, 8),
486 [ANA_ANEVENTS_DEST_KNOWN
] = REG_FIELD(ANA_ANEVENTS
, 7, 7),
487 [ANA_ANEVENTS_BUCKET3_MATCH
] = REG_FIELD(ANA_ANEVENTS
, 6, 6),
488 [ANA_ANEVENTS_BUCKET2_MATCH
] = REG_FIELD(ANA_ANEVENTS
, 5, 5),
489 [ANA_ANEVENTS_BUCKET1_MATCH
] = REG_FIELD(ANA_ANEVENTS
, 4, 4),
490 [ANA_ANEVENTS_BUCKET0_MATCH
] = REG_FIELD(ANA_ANEVENTS
, 3, 3),
491 [ANA_ANEVENTS_CPU_OPERATION
] = REG_FIELD(ANA_ANEVENTS
, 2, 2),
492 [ANA_ANEVENTS_DMAC_LOOKUP
] = REG_FIELD(ANA_ANEVENTS
, 1, 1),
493 [ANA_ANEVENTS_SMAC_LOOKUP
] = REG_FIELD(ANA_ANEVENTS
, 0, 0),
494 [ANA_TABLES_MACACCESS_B_DOM
] = REG_FIELD(ANA_TABLES_MACACCESS
, 16, 16),
495 [ANA_TABLES_MACTINDX_BUCKET
] = REG_FIELD(ANA_TABLES_MACTINDX
, 11, 12),
496 [ANA_TABLES_MACTINDX_M_INDEX
] = REG_FIELD(ANA_TABLES_MACTINDX
, 0, 10),
497 [SYS_RESET_CFG_CORE_ENA
] = REG_FIELD(SYS_RESET_CFG
, 7, 7),
498 [SYS_RESET_CFG_MEM_ENA
] = REG_FIELD(SYS_RESET_CFG
, 6, 6),
499 [SYS_RESET_CFG_MEM_INIT
] = REG_FIELD(SYS_RESET_CFG
, 5, 5),
500 [GCB_SOFT_RST_SWC_RST
] = REG_FIELD(GCB_SOFT_RST
, 0, 0),
501 [GCB_MIIM_MII_STATUS_PENDING
] = REG_FIELD(GCB_MIIM_MII_STATUS
, 2, 2),
502 [GCB_MIIM_MII_STATUS_BUSY
] = REG_FIELD(GCB_MIIM_MII_STATUS
, 3, 3),
503 /* Replicated per number of ports (11), register size 4 per port */
504 [QSYS_SWITCH_PORT_MODE_PORT_ENA
] = REG_FIELD_ID(QSYS_SWITCH_PORT_MODE
, 13, 13, 11, 4),
505 [QSYS_SWITCH_PORT_MODE_YEL_RSRVD
] = REG_FIELD_ID(QSYS_SWITCH_PORT_MODE
, 10, 10, 11, 4),
506 [QSYS_SWITCH_PORT_MODE_INGRESS_DROP_MODE
] = REG_FIELD_ID(QSYS_SWITCH_PORT_MODE
, 9, 9, 11, 4),
507 [QSYS_SWITCH_PORT_MODE_TX_PFC_ENA
] = REG_FIELD_ID(QSYS_SWITCH_PORT_MODE
, 1, 8, 11, 4),
508 [QSYS_SWITCH_PORT_MODE_TX_PFC_MODE
] = REG_FIELD_ID(QSYS_SWITCH_PORT_MODE
, 0, 0, 11, 4),
509 [SYS_PORT_MODE_INCL_INJ_HDR
] = REG_FIELD_ID(SYS_PORT_MODE
, 4, 5, 11, 4),
510 [SYS_PORT_MODE_INCL_XTR_HDR
] = REG_FIELD_ID(SYS_PORT_MODE
, 2, 3, 11, 4),
511 [SYS_PORT_MODE_INCL_HDR_ERR
] = REG_FIELD_ID(SYS_PORT_MODE
, 0, 0, 11, 4),
512 [SYS_PAUSE_CFG_PAUSE_START
] = REG_FIELD_ID(SYS_PAUSE_CFG
, 11, 20, 11, 4),
513 [SYS_PAUSE_CFG_PAUSE_STOP
] = REG_FIELD_ID(SYS_PAUSE_CFG
, 1, 10, 11, 4),
514 [SYS_PAUSE_CFG_PAUSE_ENA
] = REG_FIELD_ID(SYS_PAUSE_CFG
, 0, 1, 11, 4),
517 static const struct ocelot_stat_layout vsc9953_stats_layout
[] = {
518 { .offset
= 0x00, .name
= "rx_octets", },
519 { .offset
= 0x01, .name
= "rx_unicast", },
520 { .offset
= 0x02, .name
= "rx_multicast", },
521 { .offset
= 0x03, .name
= "rx_broadcast", },
522 { .offset
= 0x04, .name
= "rx_shorts", },
523 { .offset
= 0x05, .name
= "rx_fragments", },
524 { .offset
= 0x06, .name
= "rx_jabbers", },
525 { .offset
= 0x07, .name
= "rx_crc_align_errs", },
526 { .offset
= 0x08, .name
= "rx_sym_errs", },
527 { .offset
= 0x09, .name
= "rx_frames_below_65_octets", },
528 { .offset
= 0x0A, .name
= "rx_frames_65_to_127_octets", },
529 { .offset
= 0x0B, .name
= "rx_frames_128_to_255_octets", },
530 { .offset
= 0x0C, .name
= "rx_frames_256_to_511_octets", },
531 { .offset
= 0x0D, .name
= "rx_frames_512_to_1023_octets", },
532 { .offset
= 0x0E, .name
= "rx_frames_1024_to_1526_octets", },
533 { .offset
= 0x0F, .name
= "rx_frames_over_1526_octets", },
534 { .offset
= 0x10, .name
= "rx_pause", },
535 { .offset
= 0x11, .name
= "rx_control", },
536 { .offset
= 0x12, .name
= "rx_longs", },
537 { .offset
= 0x13, .name
= "rx_classified_drops", },
538 { .offset
= 0x14, .name
= "rx_red_prio_0", },
539 { .offset
= 0x15, .name
= "rx_red_prio_1", },
540 { .offset
= 0x16, .name
= "rx_red_prio_2", },
541 { .offset
= 0x17, .name
= "rx_red_prio_3", },
542 { .offset
= 0x18, .name
= "rx_red_prio_4", },
543 { .offset
= 0x19, .name
= "rx_red_prio_5", },
544 { .offset
= 0x1A, .name
= "rx_red_prio_6", },
545 { .offset
= 0x1B, .name
= "rx_red_prio_7", },
546 { .offset
= 0x1C, .name
= "rx_yellow_prio_0", },
547 { .offset
= 0x1D, .name
= "rx_yellow_prio_1", },
548 { .offset
= 0x1E, .name
= "rx_yellow_prio_2", },
549 { .offset
= 0x1F, .name
= "rx_yellow_prio_3", },
550 { .offset
= 0x20, .name
= "rx_yellow_prio_4", },
551 { .offset
= 0x21, .name
= "rx_yellow_prio_5", },
552 { .offset
= 0x22, .name
= "rx_yellow_prio_6", },
553 { .offset
= 0x23, .name
= "rx_yellow_prio_7", },
554 { .offset
= 0x24, .name
= "rx_green_prio_0", },
555 { .offset
= 0x25, .name
= "rx_green_prio_1", },
556 { .offset
= 0x26, .name
= "rx_green_prio_2", },
557 { .offset
= 0x27, .name
= "rx_green_prio_3", },
558 { .offset
= 0x28, .name
= "rx_green_prio_4", },
559 { .offset
= 0x29, .name
= "rx_green_prio_5", },
560 { .offset
= 0x2A, .name
= "rx_green_prio_6", },
561 { .offset
= 0x2B, .name
= "rx_green_prio_7", },
562 { .offset
= 0x40, .name
= "tx_octets", },
563 { .offset
= 0x41, .name
= "tx_unicast", },
564 { .offset
= 0x42, .name
= "tx_multicast", },
565 { .offset
= 0x43, .name
= "tx_broadcast", },
566 { .offset
= 0x44, .name
= "tx_collision", },
567 { .offset
= 0x45, .name
= "tx_drops", },
568 { .offset
= 0x46, .name
= "tx_pause", },
569 { .offset
= 0x47, .name
= "tx_frames_below_65_octets", },
570 { .offset
= 0x48, .name
= "tx_frames_65_to_127_octets", },
571 { .offset
= 0x49, .name
= "tx_frames_128_255_octets", },
572 { .offset
= 0x4A, .name
= "tx_frames_256_511_octets", },
573 { .offset
= 0x4B, .name
= "tx_frames_512_1023_octets", },
574 { .offset
= 0x4C, .name
= "tx_frames_1024_1526_octets", },
575 { .offset
= 0x4D, .name
= "tx_frames_over_1526_octets", },
576 { .offset
= 0x4E, .name
= "tx_yellow_prio_0", },
577 { .offset
= 0x4F, .name
= "tx_yellow_prio_1", },
578 { .offset
= 0x50, .name
= "tx_yellow_prio_2", },
579 { .offset
= 0x51, .name
= "tx_yellow_prio_3", },
580 { .offset
= 0x52, .name
= "tx_yellow_prio_4", },
581 { .offset
= 0x53, .name
= "tx_yellow_prio_5", },
582 { .offset
= 0x54, .name
= "tx_yellow_prio_6", },
583 { .offset
= 0x55, .name
= "tx_yellow_prio_7", },
584 { .offset
= 0x56, .name
= "tx_green_prio_0", },
585 { .offset
= 0x57, .name
= "tx_green_prio_1", },
586 { .offset
= 0x58, .name
= "tx_green_prio_2", },
587 { .offset
= 0x59, .name
= "tx_green_prio_3", },
588 { .offset
= 0x5A, .name
= "tx_green_prio_4", },
589 { .offset
= 0x5B, .name
= "tx_green_prio_5", },
590 { .offset
= 0x5C, .name
= "tx_green_prio_6", },
591 { .offset
= 0x5D, .name
= "tx_green_prio_7", },
592 { .offset
= 0x5E, .name
= "tx_aged", },
593 { .offset
= 0x80, .name
= "drop_local", },
594 { .offset
= 0x81, .name
= "drop_tail", },
595 { .offset
= 0x82, .name
= "drop_yellow_prio_0", },
596 { .offset
= 0x83, .name
= "drop_yellow_prio_1", },
597 { .offset
= 0x84, .name
= "drop_yellow_prio_2", },
598 { .offset
= 0x85, .name
= "drop_yellow_prio_3", },
599 { .offset
= 0x86, .name
= "drop_yellow_prio_4", },
600 { .offset
= 0x87, .name
= "drop_yellow_prio_5", },
601 { .offset
= 0x88, .name
= "drop_yellow_prio_6", },
602 { .offset
= 0x89, .name
= "drop_yellow_prio_7", },
603 { .offset
= 0x8A, .name
= "drop_green_prio_0", },
604 { .offset
= 0x8B, .name
= "drop_green_prio_1", },
605 { .offset
= 0x8C, .name
= "drop_green_prio_2", },
606 { .offset
= 0x8D, .name
= "drop_green_prio_3", },
607 { .offset
= 0x8E, .name
= "drop_green_prio_4", },
608 { .offset
= 0x8F, .name
= "drop_green_prio_5", },
609 { .offset
= 0x90, .name
= "drop_green_prio_6", },
610 { .offset
= 0x91, .name
= "drop_green_prio_7", },
613 static struct vcap_field vsc9953_vcap_is2_keys
[] = {
614 /* Common: 41 bits */
615 [VCAP_IS2_TYPE
] = { 0, 4},
616 [VCAP_IS2_HK_FIRST
] = { 4, 1},
617 [VCAP_IS2_HK_PAG
] = { 5, 8},
618 [VCAP_IS2_HK_IGR_PORT_MASK
] = { 13, 11},
619 [VCAP_IS2_HK_RSV2
] = { 24, 1},
620 [VCAP_IS2_HK_HOST_MATCH
] = { 25, 1},
621 [VCAP_IS2_HK_L2_MC
] = { 26, 1},
622 [VCAP_IS2_HK_L2_BC
] = { 27, 1},
623 [VCAP_IS2_HK_VLAN_TAGGED
] = { 28, 1},
624 [VCAP_IS2_HK_VID
] = { 29, 12},
625 [VCAP_IS2_HK_DEI
] = { 41, 1},
626 [VCAP_IS2_HK_PCP
] = { 42, 3},
627 /* MAC_ETYPE / MAC_LLC / MAC_SNAP / OAM common */
628 [VCAP_IS2_HK_L2_DMAC
] = { 45, 48},
629 [VCAP_IS2_HK_L2_SMAC
] = { 93, 48},
630 /* MAC_ETYPE (TYPE=000) */
631 [VCAP_IS2_HK_MAC_ETYPE_ETYPE
] = {141, 16},
632 [VCAP_IS2_HK_MAC_ETYPE_L2_PAYLOAD0
] = {157, 16},
633 [VCAP_IS2_HK_MAC_ETYPE_L2_PAYLOAD1
] = {173, 8},
634 [VCAP_IS2_HK_MAC_ETYPE_L2_PAYLOAD2
] = {181, 3},
635 /* MAC_LLC (TYPE=001) */
636 [VCAP_IS2_HK_MAC_LLC_L2_LLC
] = {141, 40},
637 /* MAC_SNAP (TYPE=010) */
638 [VCAP_IS2_HK_MAC_SNAP_L2_SNAP
] = {141, 40},
639 /* MAC_ARP (TYPE=011) */
640 [VCAP_IS2_HK_MAC_ARP_SMAC
] = { 45, 48},
641 [VCAP_IS2_HK_MAC_ARP_ADDR_SPACE_OK
] = { 93, 1},
642 [VCAP_IS2_HK_MAC_ARP_PROTO_SPACE_OK
] = { 94, 1},
643 [VCAP_IS2_HK_MAC_ARP_LEN_OK
] = { 95, 1},
644 [VCAP_IS2_HK_MAC_ARP_TARGET_MATCH
] = { 96, 1},
645 [VCAP_IS2_HK_MAC_ARP_SENDER_MATCH
] = { 97, 1},
646 [VCAP_IS2_HK_MAC_ARP_OPCODE_UNKNOWN
] = { 98, 1},
647 [VCAP_IS2_HK_MAC_ARP_OPCODE
] = { 99, 2},
648 [VCAP_IS2_HK_MAC_ARP_L3_IP4_DIP
] = {101, 32},
649 [VCAP_IS2_HK_MAC_ARP_L3_IP4_SIP
] = {133, 32},
650 [VCAP_IS2_HK_MAC_ARP_DIP_EQ_SIP
] = {165, 1},
651 /* IP4_TCP_UDP / IP4_OTHER common */
652 [VCAP_IS2_HK_IP4
] = { 45, 1},
653 [VCAP_IS2_HK_L3_FRAGMENT
] = { 46, 1},
654 [VCAP_IS2_HK_L3_FRAG_OFS_GT0
] = { 47, 1},
655 [VCAP_IS2_HK_L3_OPTIONS
] = { 48, 1},
656 [VCAP_IS2_HK_IP4_L3_TTL_GT0
] = { 49, 1},
657 [VCAP_IS2_HK_L3_TOS
] = { 50, 8},
658 [VCAP_IS2_HK_L3_IP4_DIP
] = { 58, 32},
659 [VCAP_IS2_HK_L3_IP4_SIP
] = { 90, 32},
660 [VCAP_IS2_HK_DIP_EQ_SIP
] = {122, 1},
661 /* IP4_TCP_UDP (TYPE=100) */
662 [VCAP_IS2_HK_TCP
] = {123, 1},
663 [VCAP_IS2_HK_L4_SPORT
] = {124, 16},
664 [VCAP_IS2_HK_L4_DPORT
] = {140, 16},
665 [VCAP_IS2_HK_L4_RNG
] = {156, 8},
666 [VCAP_IS2_HK_L4_SPORT_EQ_DPORT
] = {164, 1},
667 [VCAP_IS2_HK_L4_SEQUENCE_EQ0
] = {165, 1},
668 [VCAP_IS2_HK_L4_URG
] = {166, 1},
669 [VCAP_IS2_HK_L4_ACK
] = {167, 1},
670 [VCAP_IS2_HK_L4_PSH
] = {168, 1},
671 [VCAP_IS2_HK_L4_RST
] = {169, 1},
672 [VCAP_IS2_HK_L4_SYN
] = {170, 1},
673 [VCAP_IS2_HK_L4_FIN
] = {171, 1},
674 /* IP4_OTHER (TYPE=101) */
675 [VCAP_IS2_HK_IP4_L3_PROTO
] = {123, 8},
676 [VCAP_IS2_HK_L3_PAYLOAD
] = {131, 56},
677 /* IP6_STD (TYPE=110) */
678 [VCAP_IS2_HK_IP6_L3_TTL_GT0
] = { 45, 1},
679 [VCAP_IS2_HK_L3_IP6_SIP
] = { 46, 128},
680 [VCAP_IS2_HK_IP6_L3_PROTO
] = {174, 8},
683 static struct vcap_field vsc9953_vcap_is2_actions
[] = {
684 [VCAP_IS2_ACT_HIT_ME_ONCE
] = { 0, 1},
685 [VCAP_IS2_ACT_CPU_COPY_ENA
] = { 1, 1},
686 [VCAP_IS2_ACT_CPU_QU_NUM
] = { 2, 3},
687 [VCAP_IS2_ACT_MASK_MODE
] = { 5, 2},
688 [VCAP_IS2_ACT_MIRROR_ENA
] = { 7, 1},
689 [VCAP_IS2_ACT_LRN_DIS
] = { 8, 1},
690 [VCAP_IS2_ACT_POLICE_ENA
] = { 9, 1},
691 [VCAP_IS2_ACT_POLICE_IDX
] = { 10, 8},
692 [VCAP_IS2_ACT_POLICE_VCAP_ONLY
] = { 21, 1},
693 [VCAP_IS2_ACT_PORT_MASK
] = { 22, 10},
694 [VCAP_IS2_ACT_ACL_ID
] = { 44, 6},
695 [VCAP_IS2_ACT_HIT_CNT
] = { 50, 32},
698 static const struct vcap_props vsc9953_vcap_props
[] = {
702 .entry_count
= VSC9953_VCAP_IS2_CNT
,
703 .entry_width
= VSC9953_VCAP_IS2_ENTRY_WIDTH
,
704 .action_count
= VSC9953_VCAP_IS2_CNT
+
705 VSC9953_VCAP_PORT_CNT
+ 2,
707 .action_type_width
= 1,
709 [IS2_ACTION_TYPE_NORMAL
] = {
713 [IS2_ACTION_TYPE_SMAC_SIP
] = {
723 #define VSC9953_INIT_TIMEOUT 50000
724 #define VSC9953_GCB_RST_SLEEP 100
725 #define VSC9953_SYS_RAMINIT_SLEEP 80
726 #define VCS9953_MII_TIMEOUT 10000
728 static int vsc9953_gcb_soft_rst_status(struct ocelot
*ocelot
)
732 ocelot_field_read(ocelot
, GCB_SOFT_RST_SWC_RST
, &val
);
737 static int vsc9953_sys_ram_init_status(struct ocelot
*ocelot
)
741 ocelot_field_read(ocelot
, SYS_RESET_CFG_MEM_INIT
, &val
);
746 static int vsc9953_gcb_miim_pending_status(struct ocelot
*ocelot
)
750 ocelot_field_read(ocelot
, GCB_MIIM_MII_STATUS_PENDING
, &val
);
755 static int vsc9953_gcb_miim_busy_status(struct ocelot
*ocelot
)
759 ocelot_field_read(ocelot
, GCB_MIIM_MII_STATUS_BUSY
, &val
);
764 static int vsc9953_mdio_write(struct mii_bus
*bus
, int phy_id
, int regnum
,
767 struct ocelot
*ocelot
= bus
->priv
;
770 /* Wait while MIIM controller becomes idle */
771 err
= readx_poll_timeout(vsc9953_gcb_miim_pending_status
, ocelot
,
772 val
, !val
, 10, VCS9953_MII_TIMEOUT
);
774 dev_err(ocelot
->dev
, "MDIO write: pending timeout\n");
778 cmd
= MSCC_MIIM_CMD_VLD
| (phy_id
<< MSCC_MIIM_CMD_PHYAD_SHIFT
) |
779 (regnum
<< MSCC_MIIM_CMD_REGAD_SHIFT
) |
780 (value
<< MSCC_MIIM_CMD_WRDATA_SHIFT
) |
781 MSCC_MIIM_CMD_OPR_WRITE
;
783 ocelot_write(ocelot
, cmd
, GCB_MIIM_MII_CMD
);
789 static int vsc9953_mdio_read(struct mii_bus
*bus
, int phy_id
, int regnum
)
791 struct ocelot
*ocelot
= bus
->priv
;
794 /* Wait until MIIM controller becomes idle */
795 err
= readx_poll_timeout(vsc9953_gcb_miim_pending_status
, ocelot
,
796 val
, !val
, 10, VCS9953_MII_TIMEOUT
);
798 dev_err(ocelot
->dev
, "MDIO read: pending timeout\n");
802 /* Write the MIIM COMMAND register */
803 cmd
= MSCC_MIIM_CMD_VLD
| (phy_id
<< MSCC_MIIM_CMD_PHYAD_SHIFT
) |
804 (regnum
<< MSCC_MIIM_CMD_REGAD_SHIFT
) | MSCC_MIIM_CMD_OPR_READ
;
806 ocelot_write(ocelot
, cmd
, GCB_MIIM_MII_CMD
);
808 /* Wait while read operation via the MIIM controller is in progress */
809 err
= readx_poll_timeout(vsc9953_gcb_miim_busy_status
, ocelot
,
810 val
, !val
, 10, VCS9953_MII_TIMEOUT
);
812 dev_err(ocelot
->dev
, "MDIO read: busy timeout\n");
816 val
= ocelot_read(ocelot
, GCB_MIIM_MII_DATA
);
823 /* CORE_ENA is in SYS:SYSTEM:RESET_CFG
824 * MEM_INIT is in SYS:SYSTEM:RESET_CFG
825 * MEM_ENA is in SYS:SYSTEM:RESET_CFG
827 static int vsc9953_reset(struct ocelot
*ocelot
)
831 /* soft-reset the switch core */
832 ocelot_field_write(ocelot
, GCB_SOFT_RST_SWC_RST
, 1);
834 err
= readx_poll_timeout(vsc9953_gcb_soft_rst_status
, ocelot
, val
, !val
,
835 VSC9953_GCB_RST_SLEEP
, VSC9953_INIT_TIMEOUT
);
837 dev_err(ocelot
->dev
, "timeout: switch core reset\n");
841 /* initialize switch mem ~40us */
842 ocelot_field_write(ocelot
, SYS_RESET_CFG_MEM_ENA
, 1);
843 ocelot_field_write(ocelot
, SYS_RESET_CFG_MEM_INIT
, 1);
845 err
= readx_poll_timeout(vsc9953_sys_ram_init_status
, ocelot
, val
, !val
,
846 VSC9953_SYS_RAMINIT_SLEEP
,
847 VSC9953_INIT_TIMEOUT
);
849 dev_err(ocelot
->dev
, "timeout: switch sram init\n");
853 /* enable switch core */
854 ocelot_field_write(ocelot
, SYS_RESET_CFG_CORE_ENA
, 1);
859 static void vsc9953_phylink_validate(struct ocelot
*ocelot
, int port
,
860 unsigned long *supported
,
861 struct phylink_link_state
*state
)
863 struct ocelot_port
*ocelot_port
= ocelot
->ports
[port
];
864 __ETHTOOL_DECLARE_LINK_MODE_MASK(mask
) = { 0, };
866 if (state
->interface
!= PHY_INTERFACE_MODE_NA
&&
867 state
->interface
!= ocelot_port
->phy_mode
) {
868 bitmap_zero(supported
, __ETHTOOL_LINK_MODE_MASK_NBITS
);
872 phylink_set_port_modes(mask
);
873 phylink_set(mask
, Autoneg
);
874 phylink_set(mask
, Pause
);
875 phylink_set(mask
, Asym_Pause
);
876 phylink_set(mask
, 10baseT_Full
);
877 phylink_set(mask
, 10baseT_Half
);
878 phylink_set(mask
, 100baseT_Full
);
879 phylink_set(mask
, 100baseT_Half
);
880 phylink_set(mask
, 1000baseT_Full
);
882 if (state
->interface
== PHY_INTERFACE_MODE_INTERNAL
) {
883 phylink_set(mask
, 2500baseT_Full
);
884 phylink_set(mask
, 2500baseX_Full
);
887 bitmap_and(supported
, supported
, mask
,
888 __ETHTOOL_LINK_MODE_MASK_NBITS
);
889 bitmap_and(state
->advertising
, state
->advertising
, mask
,
890 __ETHTOOL_LINK_MODE_MASK_NBITS
);
893 static int vsc9953_prevalidate_phy_mode(struct ocelot
*ocelot
, int port
,
894 phy_interface_t phy_mode
)
897 case PHY_INTERFACE_MODE_INTERNAL
:
898 if (port
!= 8 && port
!= 9)
901 case PHY_INTERFACE_MODE_SGMII
:
902 case PHY_INTERFACE_MODE_QSGMII
:
903 /* Not supported on internal to-CPU ports */
904 if (port
== 8 || port
== 9)
913 * Bit 9: Unit; 0:1, 1:16
914 * Bit 8-0: Value to be multiplied with unit
916 static u16
vsc9953_wm_enc(u16 value
)
919 return BIT(9) | (value
/ 16);
924 static const struct ocelot_ops vsc9953_ops
= {
925 .reset
= vsc9953_reset
,
926 .wm_enc
= vsc9953_wm_enc
,
929 static int vsc9953_mdio_bus_alloc(struct ocelot
*ocelot
)
931 struct felix
*felix
= ocelot_to_felix(ocelot
);
932 struct device
*dev
= ocelot
->dev
;
937 felix
->pcs
= devm_kcalloc(dev
, felix
->info
->num_ports
,
938 sizeof(struct phy_device
*),
941 dev_err(dev
, "failed to allocate array for PCS PHYs\n");
945 bus
= devm_mdiobus_alloc(dev
);
949 bus
->name
= "VSC9953 internal MDIO bus";
950 bus
->read
= vsc9953_mdio_read
;
951 bus
->write
= vsc9953_mdio_write
;
954 snprintf(bus
->id
, MII_BUS_ID_SIZE
, "%s-imdio", dev_name(dev
));
956 /* Needed in order to initialize the bus mutex lock */
957 rc
= mdiobus_register(bus
);
959 dev_err(dev
, "failed to register MDIO bus\n");
965 for (port
= 0; port
< felix
->info
->num_ports
; port
++) {
966 struct ocelot_port
*ocelot_port
= ocelot
->ports
[port
];
968 struct mdio_device
*pcs
;
969 struct lynx_pcs
*lynx
;
971 if (dsa_is_unused_port(felix
->ds
, port
))
974 if (ocelot_port
->phy_mode
== PHY_INTERFACE_MODE_INTERNAL
)
977 pcs
= mdio_device_create(felix
->imdio
, addr
);
981 lynx
= lynx_pcs_create(pcs
);
983 mdio_device_free(pcs
);
987 felix
->pcs
[port
] = lynx
;
989 dev_info(dev
, "Found PCS at internal MDIO address %d\n", addr
);
995 static void vsc9953_xmit_template_populate(struct ocelot
*ocelot
, int port
)
997 struct ocelot_port
*ocelot_port
= ocelot
->ports
[port
];
998 u8
*template = ocelot_port
->xmit_template
;
999 u64 bypass
, dest
, src
;
1001 /* Set the source port as the CPU port module and not the
1004 src
= ocelot
->num_phys_ports
;
1008 packing(template, &bypass
, 127, 127, OCELOT_TAG_LEN
, PACK
, 0);
1009 packing(template, &dest
, 67, 57, OCELOT_TAG_LEN
, PACK
, 0);
1010 packing(template, &src
, 46, 43, OCELOT_TAG_LEN
, PACK
, 0);
1013 static const struct felix_info seville_info_vsc9953
= {
1014 .target_io_res
= vsc9953_target_io_res
,
1015 .port_io_res
= vsc9953_port_io_res
,
1016 .regfields
= vsc9953_regfields
,
1017 .map
= vsc9953_regmap
,
1018 .ops
= &vsc9953_ops
,
1019 .stats_layout
= vsc9953_stats_layout
,
1020 .num_stats
= ARRAY_SIZE(vsc9953_stats_layout
),
1021 .vcap_is2_keys
= vsc9953_vcap_is2_keys
,
1022 .vcap_is2_actions
= vsc9953_vcap_is2_actions
,
1023 .vcap
= vsc9953_vcap_props
,
1024 .shared_queue_sz
= 128 * 1024,
1025 .num_mact_rows
= 2048,
1027 .mdio_bus_alloc
= vsc9953_mdio_bus_alloc
,
1028 .mdio_bus_free
= vsc9959_mdio_bus_free
,
1029 .phylink_validate
= vsc9953_phylink_validate
,
1030 .prevalidate_phy_mode
= vsc9953_prevalidate_phy_mode
,
1031 .xmit_template_populate
= vsc9953_xmit_template_populate
,
1034 static int seville_probe(struct platform_device
*pdev
)
1036 struct dsa_switch
*ds
;
1037 struct ocelot
*ocelot
;
1038 struct resource
*res
;
1039 struct felix
*felix
;
1042 felix
= kzalloc(sizeof(struct felix
), GFP_KERNEL
);
1045 dev_err(&pdev
->dev
, "Failed to allocate driver memory\n");
1046 goto err_alloc_felix
;
1049 platform_set_drvdata(pdev
, felix
);
1051 ocelot
= &felix
->ocelot
;
1052 ocelot
->dev
= &pdev
->dev
;
1053 felix
->info
= &seville_info_vsc9953
;
1055 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1056 felix
->switch_base
= res
->start
;
1058 ds
= kzalloc(sizeof(struct dsa_switch
), GFP_KERNEL
);
1061 dev_err(&pdev
->dev
, "Failed to allocate DSA switch\n");
1065 ds
->dev
= &pdev
->dev
;
1066 ds
->num_ports
= felix
->info
->num_ports
;
1067 ds
->ops
= &felix_switch_ops
;
1071 err
= dsa_register_switch(ds
);
1073 dev_err(&pdev
->dev
, "Failed to register DSA switch: %d\n", err
);
1074 goto err_register_ds
;
1087 static int seville_remove(struct platform_device
*pdev
)
1089 struct felix
*felix
;
1091 felix
= platform_get_drvdata(pdev
);
1093 dsa_unregister_switch(felix
->ds
);
1101 static const struct of_device_id seville_of_match
[] = {
1102 { .compatible
= "mscc,vsc9953-switch" },
1105 MODULE_DEVICE_TABLE(of
, seville_of_match
);
1107 struct platform_driver seville_vsc9953_driver
= {
1108 .probe
= seville_probe
,
1109 .remove
= seville_remove
,
1111 .name
= "mscc_seville",
1112 .of_match_table
= of_match_ptr(seville_of_match
),