Commit | Line | Data |
---|---|---|
a40c175b VD |
1 | /* |
2 | * Handling of a single switch port | |
3 | * | |
4 | * Copyright (c) 2017 Savoir-faire Linux Inc. | |
5 | * Vivien Didelot <vivien.didelot@savoirfairelinux.com> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
11 | */ | |
12 | ||
13 | #include <linux/if_bridge.h> | |
cfbed329 | 14 | #include <linux/notifier.h> |
57ab1ca2 VD |
15 | #include <linux/of_mdio.h> |
16 | #include <linux/of_net.h> | |
a40c175b VD |
17 | |
18 | #include "dsa_priv.h" | |
19 | ||
bb9f6031 | 20 | static int dsa_port_notify(const struct dsa_port *dp, unsigned long e, void *v) |
cfbed329 VD |
21 | { |
22 | struct raw_notifier_head *nh = &dp->ds->dst->nh; | |
23 | int err; | |
24 | ||
25 | err = raw_notifier_call_chain(nh, e, v); | |
26 | ||
27 | return notifier_to_errno(err); | |
28 | } | |
29 | ||
a40c175b VD |
30 | int dsa_port_set_state(struct dsa_port *dp, u8 state, |
31 | struct switchdev_trans *trans) | |
32 | { | |
33 | struct dsa_switch *ds = dp->ds; | |
34 | int port = dp->index; | |
35 | ||
36 | if (switchdev_trans_ph_prepare(trans)) | |
37 | return ds->ops->port_stp_state_set ? 0 : -EOPNOTSUPP; | |
38 | ||
39 | if (ds->ops->port_stp_state_set) | |
40 | ds->ops->port_stp_state_set(ds, port, state); | |
41 | ||
42 | if (ds->ops->port_fast_age) { | |
43 | /* Fast age FDB entries or flush appropriate forwarding database | |
44 | * for the given port, if we are moving it from Learning or | |
45 | * Forwarding state, to Disabled or Blocking or Listening state. | |
46 | */ | |
47 | ||
48 | if ((dp->stp_state == BR_STATE_LEARNING || | |
49 | dp->stp_state == BR_STATE_FORWARDING) && | |
50 | (state == BR_STATE_DISABLED || | |
51 | state == BR_STATE_BLOCKING || | |
52 | state == BR_STATE_LISTENING)) | |
53 | ds->ops->port_fast_age(ds, port); | |
54 | } | |
55 | ||
56 | dp->stp_state = state; | |
57 | ||
58 | return 0; | |
59 | } | |
60 | ||
fb8a6a2b | 61 | static void dsa_port_set_state_now(struct dsa_port *dp, u8 state) |
a40c175b VD |
62 | { |
63 | int err; | |
64 | ||
65 | err = dsa_port_set_state(dp, state, NULL); | |
66 | if (err) | |
67 | pr_err("DSA: failed to set STP state %u (%d)\n", state, err); | |
68 | } | |
cfbed329 | 69 | |
fb8a6a2b VD |
70 | int dsa_port_enable(struct dsa_port *dp, struct phy_device *phy) |
71 | { | |
fb8a6a2b VD |
72 | struct dsa_switch *ds = dp->ds; |
73 | int port = dp->index; | |
74 | int err; | |
75 | ||
76 | if (ds->ops->port_enable) { | |
77 | err = ds->ops->port_enable(ds, port, phy); | |
78 | if (err) | |
79 | return err; | |
80 | } | |
81 | ||
9c2054a5 RK |
82 | if (!dp->bridge_dev) |
83 | dsa_port_set_state_now(dp, BR_STATE_FORWARDING); | |
fb8a6a2b VD |
84 | |
85 | return 0; | |
86 | } | |
87 | ||
88 | void dsa_port_disable(struct dsa_port *dp, struct phy_device *phy) | |
89 | { | |
90 | struct dsa_switch *ds = dp->ds; | |
91 | int port = dp->index; | |
92 | ||
9c2054a5 RK |
93 | if (!dp->bridge_dev) |
94 | dsa_port_set_state_now(dp, BR_STATE_DISABLED); | |
fb8a6a2b VD |
95 | |
96 | if (ds->ops->port_disable) | |
97 | ds->ops->port_disable(ds, port, phy); | |
98 | } | |
99 | ||
cfbed329 VD |
100 | int dsa_port_bridge_join(struct dsa_port *dp, struct net_device *br) |
101 | { | |
102 | struct dsa_notifier_bridge_info info = { | |
103 | .sw_index = dp->ds->index, | |
104 | .port = dp->index, | |
105 | .br = br, | |
106 | }; | |
107 | int err; | |
108 | ||
109 | /* Here the port is already bridged. Reflect the current configuration | |
110 | * so that drivers can program their chips accordingly. | |
111 | */ | |
112 | dp->bridge_dev = br; | |
113 | ||
114 | err = dsa_port_notify(dp, DSA_NOTIFIER_BRIDGE_JOIN, &info); | |
115 | ||
116 | /* The bridging is rolled back on error */ | |
117 | if (err) | |
118 | dp->bridge_dev = NULL; | |
119 | ||
120 | return err; | |
121 | } | |
122 | ||
123 | void dsa_port_bridge_leave(struct dsa_port *dp, struct net_device *br) | |
124 | { | |
125 | struct dsa_notifier_bridge_info info = { | |
126 | .sw_index = dp->ds->index, | |
127 | .port = dp->index, | |
128 | .br = br, | |
129 | }; | |
130 | int err; | |
131 | ||
132 | /* Here the port is already unbridged. Reflect the current configuration | |
133 | * so that drivers can program their chips accordingly. | |
134 | */ | |
135 | dp->bridge_dev = NULL; | |
136 | ||
137 | err = dsa_port_notify(dp, DSA_NOTIFIER_BRIDGE_LEAVE, &info); | |
138 | if (err) | |
139 | pr_err("DSA: failed to notify DSA_NOTIFIER_BRIDGE_LEAVE\n"); | |
140 | ||
141 | /* Port left the bridge, put in BR_STATE_DISABLED by the bridge layer, | |
142 | * so allow it to be in BR_STATE_FORWARDING to be kept functional | |
143 | */ | |
144 | dsa_port_set_state_now(dp, BR_STATE_FORWARDING); | |
145 | } | |
4d61d304 VD |
146 | |
147 | int dsa_port_vlan_filtering(struct dsa_port *dp, bool vlan_filtering, | |
148 | struct switchdev_trans *trans) | |
149 | { | |
150 | struct dsa_switch *ds = dp->ds; | |
151 | ||
152 | /* bridge skips -EOPNOTSUPP, so skip the prepare phase */ | |
153 | if (switchdev_trans_ph_prepare(trans)) | |
154 | return 0; | |
155 | ||
156 | if (ds->ops->port_vlan_filtering) | |
157 | return ds->ops->port_vlan_filtering(ds, dp->index, | |
158 | vlan_filtering); | |
159 | ||
160 | return 0; | |
161 | } | |
d87bd94e | 162 | |
d87bd94e VD |
163 | int dsa_port_ageing_time(struct dsa_port *dp, clock_t ageing_clock, |
164 | struct switchdev_trans *trans) | |
165 | { | |
166 | unsigned long ageing_jiffies = clock_t_to_jiffies(ageing_clock); | |
167 | unsigned int ageing_time = jiffies_to_msecs(ageing_jiffies); | |
1faabf74 VD |
168 | struct dsa_notifier_ageing_time_info info = { |
169 | .ageing_time = ageing_time, | |
1faabf74 VD |
170 | .trans = trans, |
171 | }; | |
d87bd94e | 172 | |
1faabf74 VD |
173 | if (switchdev_trans_ph_prepare(trans)) |
174 | return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info); | |
d87bd94e | 175 | |
d87bd94e | 176 | dp->ageing_time = ageing_time; |
d87bd94e | 177 | |
1faabf74 | 178 | return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info); |
d87bd94e | 179 | } |
d1cffff0 | 180 | |
2acf4e6a AS |
181 | int dsa_port_fdb_add(struct dsa_port *dp, const unsigned char *addr, |
182 | u16 vid) | |
d1cffff0 | 183 | { |
685fb6a4 VD |
184 | struct dsa_notifier_fdb_info info = { |
185 | .sw_index = dp->ds->index, | |
186 | .port = dp->index, | |
2acf4e6a AS |
187 | .addr = addr, |
188 | .vid = vid, | |
685fb6a4 | 189 | }; |
d1cffff0 | 190 | |
685fb6a4 | 191 | return dsa_port_notify(dp, DSA_NOTIFIER_FDB_ADD, &info); |
d1cffff0 VD |
192 | } |
193 | ||
2acf4e6a AS |
194 | int dsa_port_fdb_del(struct dsa_port *dp, const unsigned char *addr, |
195 | u16 vid) | |
d1cffff0 | 196 | { |
685fb6a4 VD |
197 | struct dsa_notifier_fdb_info info = { |
198 | .sw_index = dp->ds->index, | |
199 | .port = dp->index, | |
2acf4e6a AS |
200 | .addr = addr, |
201 | .vid = vid, | |
202 | ||
685fb6a4 | 203 | }; |
d1cffff0 | 204 | |
685fb6a4 | 205 | return dsa_port_notify(dp, DSA_NOTIFIER_FDB_DEL, &info); |
d1cffff0 VD |
206 | } |
207 | ||
de40fc5d VD |
208 | int dsa_port_fdb_dump(struct dsa_port *dp, dsa_fdb_dump_cb_t *cb, void *data) |
209 | { | |
210 | struct dsa_switch *ds = dp->ds; | |
211 | int port = dp->index; | |
212 | ||
213 | if (!ds->ops->port_fdb_dump) | |
214 | return -EOPNOTSUPP; | |
215 | ||
216 | return ds->ops->port_fdb_dump(ds, port, cb, data); | |
217 | } | |
218 | ||
bb9f6031 | 219 | int dsa_port_mdb_add(const struct dsa_port *dp, |
3a9afea3 VD |
220 | const struct switchdev_obj_port_mdb *mdb, |
221 | struct switchdev_trans *trans) | |
222 | { | |
8ae5bcdc VD |
223 | struct dsa_notifier_mdb_info info = { |
224 | .sw_index = dp->ds->index, | |
225 | .port = dp->index, | |
226 | .trans = trans, | |
227 | .mdb = mdb, | |
228 | }; | |
3a9afea3 | 229 | |
8ae5bcdc | 230 | return dsa_port_notify(dp, DSA_NOTIFIER_MDB_ADD, &info); |
3a9afea3 VD |
231 | } |
232 | ||
bb9f6031 | 233 | int dsa_port_mdb_del(const struct dsa_port *dp, |
3a9afea3 VD |
234 | const struct switchdev_obj_port_mdb *mdb) |
235 | { | |
8ae5bcdc VD |
236 | struct dsa_notifier_mdb_info info = { |
237 | .sw_index = dp->ds->index, | |
238 | .port = dp->index, | |
239 | .mdb = mdb, | |
240 | }; | |
3a9afea3 | 241 | |
8ae5bcdc | 242 | return dsa_port_notify(dp, DSA_NOTIFIER_MDB_DEL, &info); |
3a9afea3 VD |
243 | } |
244 | ||
076e7133 VD |
245 | int dsa_port_vlan_add(struct dsa_port *dp, |
246 | const struct switchdev_obj_port_vlan *vlan, | |
247 | struct switchdev_trans *trans) | |
248 | { | |
d0c627b8 VD |
249 | struct dsa_notifier_vlan_info info = { |
250 | .sw_index = dp->ds->index, | |
251 | .port = dp->index, | |
252 | .trans = trans, | |
253 | .vlan = vlan, | |
254 | }; | |
076e7133 | 255 | |
2ea7a679 AL |
256 | if (br_vlan_enabled(dp->bridge_dev)) |
257 | return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_ADD, &info); | |
258 | ||
259 | return 0; | |
076e7133 VD |
260 | } |
261 | ||
262 | int dsa_port_vlan_del(struct dsa_port *dp, | |
263 | const struct switchdev_obj_port_vlan *vlan) | |
264 | { | |
d0c627b8 VD |
265 | struct dsa_notifier_vlan_info info = { |
266 | .sw_index = dp->ds->index, | |
267 | .port = dp->index, | |
268 | .vlan = vlan, | |
269 | }; | |
076e7133 | 270 | |
da0efa88 PM |
271 | if (netif_is_bridge_master(vlan->obj.orig_dev)) |
272 | return -EOPNOTSUPP; | |
273 | ||
2ea7a679 AL |
274 | if (br_vlan_enabled(dp->bridge_dev)) |
275 | return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info); | |
276 | ||
277 | return 0; | |
076e7133 | 278 | } |
57ab1ca2 | 279 | |
6207a78c | 280 | static struct phy_device *dsa_port_get_phy_device(struct dsa_port *dp) |
33615367 | 281 | { |
33615367 | 282 | struct device_node *phy_dn; |
33615367 | 283 | struct phy_device *phydev; |
33615367 | 284 | |
6207a78c | 285 | phy_dn = of_parse_phandle(dp->dn, "phy-handle", 0); |
33615367 | 286 | if (!phy_dn) |
6207a78c | 287 | return NULL; |
33615367 SR |
288 | |
289 | phydev = of_phy_find_device(phy_dn); | |
290 | if (!phydev) { | |
6207a78c FF |
291 | of_node_put(phy_dn); |
292 | return ERR_PTR(-EPROBE_DEFER); | |
33615367 SR |
293 | } |
294 | ||
9919a363 | 295 | of_node_put(phy_dn); |
6207a78c FF |
296 | return phydev; |
297 | } | |
298 | ||
299 | static int dsa_port_setup_phy_of(struct dsa_port *dp, bool enable) | |
300 | { | |
301 | struct dsa_switch *ds = dp->ds; | |
302 | struct phy_device *phydev; | |
303 | int port = dp->index; | |
304 | int err = 0; | |
305 | ||
306 | phydev = dsa_port_get_phy_device(dp); | |
307 | if (!phydev) | |
308 | return 0; | |
309 | ||
310 | if (IS_ERR(phydev)) | |
311 | return PTR_ERR(phydev); | |
312 | ||
33615367 SR |
313 | if (enable) { |
314 | err = genphy_config_init(phydev); | |
315 | if (err < 0) | |
316 | goto err_put_dev; | |
317 | ||
318 | err = genphy_resume(phydev); | |
319 | if (err < 0) | |
320 | goto err_put_dev; | |
321 | ||
322 | err = genphy_read_status(phydev); | |
323 | if (err < 0) | |
324 | goto err_put_dev; | |
325 | } else { | |
326 | err = genphy_suspend(phydev); | |
327 | if (err < 0) | |
328 | goto err_put_dev; | |
329 | } | |
330 | ||
331 | if (ds->ops->adjust_link) | |
332 | ds->ops->adjust_link(ds, port, phydev); | |
333 | ||
334 | dev_dbg(ds->dev, "enabled port's phy: %s", phydev_name(phydev)); | |
335 | ||
336 | err_put_dev: | |
337 | put_device(&phydev->mdio.dev); | |
33615367 SR |
338 | return err; |
339 | } | |
340 | ||
341 | static int dsa_port_fixed_link_register_of(struct dsa_port *dp) | |
57ab1ca2 VD |
342 | { |
343 | struct device_node *dn = dp->dn; | |
344 | struct dsa_switch *ds = dp->ds; | |
345 | struct phy_device *phydev; | |
346 | int port = dp->index; | |
347 | int mode; | |
348 | int err; | |
349 | ||
33615367 SR |
350 | err = of_phy_register_fixed_link(dn); |
351 | if (err) { | |
352 | dev_err(ds->dev, | |
353 | "failed to register the fixed PHY of port %d\n", | |
354 | port); | |
355 | return err; | |
356 | } | |
57ab1ca2 | 357 | |
33615367 | 358 | phydev = of_phy_find_device(dn); |
57ab1ca2 | 359 | |
33615367 SR |
360 | mode = of_get_phy_mode(dn); |
361 | if (mode < 0) | |
362 | mode = PHY_INTERFACE_MODE_NA; | |
363 | phydev->interface = mode; | |
57ab1ca2 | 364 | |
33615367 SR |
365 | genphy_config_init(phydev); |
366 | genphy_read_status(phydev); | |
57ab1ca2 | 367 | |
33615367 SR |
368 | if (ds->ops->adjust_link) |
369 | ds->ops->adjust_link(ds, port, phydev); | |
57ab1ca2 | 370 | |
33615367 | 371 | put_device(&phydev->mdio.dev); |
57ab1ca2 VD |
372 | |
373 | return 0; | |
374 | } | |
375 | ||
33615367 | 376 | int dsa_port_link_register_of(struct dsa_port *dp) |
57ab1ca2 | 377 | { |
33615367 SR |
378 | if (of_phy_is_fixed_link(dp->dn)) |
379 | return dsa_port_fixed_link_register_of(dp); | |
380 | else | |
381 | return dsa_port_setup_phy_of(dp, true); | |
382 | } | |
57ab1ca2 | 383 | |
33615367 SR |
384 | void dsa_port_link_unregister_of(struct dsa_port *dp) |
385 | { | |
386 | if (of_phy_is_fixed_link(dp->dn)) | |
387 | of_phy_deregister_fixed_link(dp->dn); | |
388 | else | |
389 | dsa_port_setup_phy_of(dp, false); | |
57ab1ca2 | 390 | } |
cf963573 FF |
391 | |
392 | int dsa_port_get_phy_strings(struct dsa_port *dp, uint8_t *data) | |
393 | { | |
394 | struct phy_device *phydev; | |
395 | int ret = -EOPNOTSUPP; | |
396 | ||
397 | if (of_phy_is_fixed_link(dp->dn)) | |
398 | return ret; | |
399 | ||
400 | phydev = dsa_port_get_phy_device(dp); | |
401 | if (IS_ERR_OR_NULL(phydev)) | |
402 | return ret; | |
403 | ||
404 | ret = phy_ethtool_get_strings(phydev, data); | |
405 | put_device(&phydev->mdio.dev); | |
406 | ||
407 | return ret; | |
408 | } | |
409 | EXPORT_SYMBOL_GPL(dsa_port_get_phy_strings); | |
410 | ||
411 | int dsa_port_get_ethtool_phy_stats(struct dsa_port *dp, uint64_t *data) | |
412 | { | |
413 | struct phy_device *phydev; | |
414 | int ret = -EOPNOTSUPP; | |
415 | ||
416 | if (of_phy_is_fixed_link(dp->dn)) | |
417 | return ret; | |
418 | ||
419 | phydev = dsa_port_get_phy_device(dp); | |
420 | if (IS_ERR_OR_NULL(phydev)) | |
421 | return ret; | |
422 | ||
423 | ret = phy_ethtool_get_stats(phydev, NULL, data); | |
424 | put_device(&phydev->mdio.dev); | |
425 | ||
426 | return ret; | |
427 | } | |
428 | EXPORT_SYMBOL_GPL(dsa_port_get_ethtool_phy_stats); | |
429 | ||
430 | int dsa_port_get_phy_sset_count(struct dsa_port *dp) | |
431 | { | |
432 | struct phy_device *phydev; | |
433 | int ret = -EOPNOTSUPP; | |
434 | ||
435 | if (of_phy_is_fixed_link(dp->dn)) | |
436 | return ret; | |
437 | ||
438 | phydev = dsa_port_get_phy_device(dp); | |
439 | if (IS_ERR_OR_NULL(phydev)) | |
440 | return ret; | |
441 | ||
442 | ret = phy_ethtool_get_sset_count(phydev); | |
443 | put_device(&phydev->mdio.dev); | |
444 | ||
445 | return ret; | |
446 | } | |
447 | EXPORT_SYMBOL_GPL(dsa_port_get_phy_sset_count); |