]> Git Repo - linux.git/blob - net/dsa/port.c
blackhole_netdev: use blackhole_netdev to invalidate dst entries
[linux.git] / net / dsa / port.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Handling of a single switch port
4  *
5  * Copyright (c) 2017 Savoir-faire Linux Inc.
6  *      Vivien Didelot <[email protected]>
7  */
8
9 #include <linux/if_bridge.h>
10 #include <linux/notifier.h>
11 #include <linux/of_mdio.h>
12 #include <linux/of_net.h>
13
14 #include "dsa_priv.h"
15
16 static int dsa_port_notify(const struct dsa_port *dp, unsigned long e, void *v)
17 {
18         struct raw_notifier_head *nh = &dp->ds->dst->nh;
19         int err;
20
21         err = raw_notifier_call_chain(nh, e, v);
22
23         return notifier_to_errno(err);
24 }
25
26 int dsa_port_set_state(struct dsa_port *dp, u8 state,
27                        struct switchdev_trans *trans)
28 {
29         struct dsa_switch *ds = dp->ds;
30         int port = dp->index;
31
32         if (switchdev_trans_ph_prepare(trans))
33                 return ds->ops->port_stp_state_set ? 0 : -EOPNOTSUPP;
34
35         if (ds->ops->port_stp_state_set)
36                 ds->ops->port_stp_state_set(ds, port, state);
37
38         if (ds->ops->port_fast_age) {
39                 /* Fast age FDB entries or flush appropriate forwarding database
40                  * for the given port, if we are moving it from Learning or
41                  * Forwarding state, to Disabled or Blocking or Listening state.
42                  */
43
44                 if ((dp->stp_state == BR_STATE_LEARNING ||
45                      dp->stp_state == BR_STATE_FORWARDING) &&
46                     (state == BR_STATE_DISABLED ||
47                      state == BR_STATE_BLOCKING ||
48                      state == BR_STATE_LISTENING))
49                         ds->ops->port_fast_age(ds, port);
50         }
51
52         dp->stp_state = state;
53
54         return 0;
55 }
56
57 static void dsa_port_set_state_now(struct dsa_port *dp, u8 state)
58 {
59         int err;
60
61         err = dsa_port_set_state(dp, state, NULL);
62         if (err)
63                 pr_err("DSA: failed to set STP state %u (%d)\n", state, err);
64 }
65
66 int dsa_port_enable(struct dsa_port *dp, struct phy_device *phy)
67 {
68         struct dsa_switch *ds = dp->ds;
69         int port = dp->index;
70         int err;
71
72         if (ds->ops->port_enable) {
73                 err = ds->ops->port_enable(ds, port, phy);
74                 if (err)
75                         return err;
76         }
77
78         if (!dp->bridge_dev)
79                 dsa_port_set_state_now(dp, BR_STATE_FORWARDING);
80
81         return 0;
82 }
83
84 void dsa_port_disable(struct dsa_port *dp)
85 {
86         struct dsa_switch *ds = dp->ds;
87         int port = dp->index;
88
89         if (!dp->bridge_dev)
90                 dsa_port_set_state_now(dp, BR_STATE_DISABLED);
91
92         if (ds->ops->port_disable)
93                 ds->ops->port_disable(ds, port);
94 }
95
96 int dsa_port_bridge_join(struct dsa_port *dp, struct net_device *br)
97 {
98         struct dsa_notifier_bridge_info info = {
99                 .sw_index = dp->ds->index,
100                 .port = dp->index,
101                 .br = br,
102         };
103         int err;
104
105         /* Set the flooding mode before joining the port in the switch */
106         err = dsa_port_bridge_flags(dp, BR_FLOOD | BR_MCAST_FLOOD, NULL);
107         if (err)
108                 return err;
109
110         /* Here the interface is already bridged. Reflect the current
111          * configuration so that drivers can program their chips accordingly.
112          */
113         dp->bridge_dev = br;
114
115         err = dsa_port_notify(dp, DSA_NOTIFIER_BRIDGE_JOIN, &info);
116
117         /* The bridging is rolled back on error */
118         if (err) {
119                 dsa_port_bridge_flags(dp, 0, NULL);
120                 dp->bridge_dev = NULL;
121         }
122
123         return err;
124 }
125
126 void dsa_port_bridge_leave(struct dsa_port *dp, struct net_device *br)
127 {
128         struct dsa_notifier_bridge_info info = {
129                 .sw_index = dp->ds->index,
130                 .port = dp->index,
131                 .br = br,
132         };
133         int err;
134
135         /* Here the port is already unbridged. Reflect the current configuration
136          * so that drivers can program their chips accordingly.
137          */
138         dp->bridge_dev = NULL;
139
140         err = dsa_port_notify(dp, DSA_NOTIFIER_BRIDGE_LEAVE, &info);
141         if (err)
142                 pr_err("DSA: failed to notify DSA_NOTIFIER_BRIDGE_LEAVE\n");
143
144         /* Port is leaving the bridge, disable flooding */
145         dsa_port_bridge_flags(dp, 0, NULL);
146
147         /* Port left the bridge, put in BR_STATE_DISABLED by the bridge layer,
148          * so allow it to be in BR_STATE_FORWARDING to be kept functional
149          */
150         dsa_port_set_state_now(dp, BR_STATE_FORWARDING);
151 }
152
153 static bool dsa_port_can_apply_vlan_filtering(struct dsa_port *dp,
154                                               bool vlan_filtering)
155 {
156         struct dsa_switch *ds = dp->ds;
157         int i;
158
159         if (!ds->vlan_filtering_is_global)
160                 return true;
161
162         /* For cases where enabling/disabling VLAN awareness is global to the
163          * switch, we need to handle the case where multiple bridges span
164          * different ports of the same switch device and one of them has a
165          * different setting than what is being requested.
166          */
167         for (i = 0; i < ds->num_ports; i++) {
168                 struct net_device *other_bridge;
169
170                 other_bridge = dsa_to_port(ds, i)->bridge_dev;
171                 if (!other_bridge)
172                         continue;
173                 /* If it's the same bridge, it also has same
174                  * vlan_filtering setting => no need to check
175                  */
176                 if (other_bridge == dp->bridge_dev)
177                         continue;
178                 if (br_vlan_enabled(other_bridge) != vlan_filtering) {
179                         dev_err(ds->dev, "VLAN filtering is a global setting\n");
180                         return false;
181                 }
182         }
183         return true;
184 }
185
186 int dsa_port_vlan_filtering(struct dsa_port *dp, bool vlan_filtering,
187                             struct switchdev_trans *trans)
188 {
189         struct dsa_switch *ds = dp->ds;
190         int err;
191
192         /* bridge skips -EOPNOTSUPP, so skip the prepare phase */
193         if (switchdev_trans_ph_prepare(trans))
194                 return 0;
195
196         if (!ds->ops->port_vlan_filtering)
197                 return 0;
198
199         if (!dsa_port_can_apply_vlan_filtering(dp, vlan_filtering))
200                 return -EINVAL;
201
202         if (dsa_port_is_vlan_filtering(dp) == vlan_filtering)
203                 return 0;
204
205         err = ds->ops->port_vlan_filtering(ds, dp->index,
206                                            vlan_filtering);
207         if (err)
208                 return err;
209
210         if (ds->vlan_filtering_is_global)
211                 ds->vlan_filtering = vlan_filtering;
212         else
213                 dp->vlan_filtering = vlan_filtering;
214         return 0;
215 }
216
217 int dsa_port_ageing_time(struct dsa_port *dp, clock_t ageing_clock,
218                          struct switchdev_trans *trans)
219 {
220         unsigned long ageing_jiffies = clock_t_to_jiffies(ageing_clock);
221         unsigned int ageing_time = jiffies_to_msecs(ageing_jiffies);
222         struct dsa_notifier_ageing_time_info info = {
223                 .ageing_time = ageing_time,
224                 .trans = trans,
225         };
226
227         if (switchdev_trans_ph_prepare(trans))
228                 return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info);
229
230         dp->ageing_time = ageing_time;
231
232         return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info);
233 }
234
235 int dsa_port_pre_bridge_flags(const struct dsa_port *dp, unsigned long flags,
236                               struct switchdev_trans *trans)
237 {
238         struct dsa_switch *ds = dp->ds;
239
240         if (!ds->ops->port_egress_floods ||
241             (flags & ~(BR_FLOOD | BR_MCAST_FLOOD)))
242                 return -EINVAL;
243
244         return 0;
245 }
246
247 int dsa_port_bridge_flags(const struct dsa_port *dp, unsigned long flags,
248                           struct switchdev_trans *trans)
249 {
250         struct dsa_switch *ds = dp->ds;
251         int port = dp->index;
252         int err = 0;
253
254         if (switchdev_trans_ph_prepare(trans))
255                 return 0;
256
257         if (ds->ops->port_egress_floods)
258                 err = ds->ops->port_egress_floods(ds, port, flags & BR_FLOOD,
259                                                   flags & BR_MCAST_FLOOD);
260
261         return err;
262 }
263
264 int dsa_port_fdb_add(struct dsa_port *dp, const unsigned char *addr,
265                      u16 vid)
266 {
267         struct dsa_notifier_fdb_info info = {
268                 .sw_index = dp->ds->index,
269                 .port = dp->index,
270                 .addr = addr,
271                 .vid = vid,
272         };
273
274         return dsa_port_notify(dp, DSA_NOTIFIER_FDB_ADD, &info);
275 }
276
277 int dsa_port_fdb_del(struct dsa_port *dp, const unsigned char *addr,
278                      u16 vid)
279 {
280         struct dsa_notifier_fdb_info info = {
281                 .sw_index = dp->ds->index,
282                 .port = dp->index,
283                 .addr = addr,
284                 .vid = vid,
285
286         };
287
288         return dsa_port_notify(dp, DSA_NOTIFIER_FDB_DEL, &info);
289 }
290
291 int dsa_port_fdb_dump(struct dsa_port *dp, dsa_fdb_dump_cb_t *cb, void *data)
292 {
293         struct dsa_switch *ds = dp->ds;
294         int port = dp->index;
295
296         if (!ds->ops->port_fdb_dump)
297                 return -EOPNOTSUPP;
298
299         return ds->ops->port_fdb_dump(ds, port, cb, data);
300 }
301
302 int dsa_port_mdb_add(const struct dsa_port *dp,
303                      const struct switchdev_obj_port_mdb *mdb,
304                      struct switchdev_trans *trans)
305 {
306         struct dsa_notifier_mdb_info info = {
307                 .sw_index = dp->ds->index,
308                 .port = dp->index,
309                 .trans = trans,
310                 .mdb = mdb,
311         };
312
313         return dsa_port_notify(dp, DSA_NOTIFIER_MDB_ADD, &info);
314 }
315
316 int dsa_port_mdb_del(const struct dsa_port *dp,
317                      const struct switchdev_obj_port_mdb *mdb)
318 {
319         struct dsa_notifier_mdb_info info = {
320                 .sw_index = dp->ds->index,
321                 .port = dp->index,
322                 .mdb = mdb,
323         };
324
325         return dsa_port_notify(dp, DSA_NOTIFIER_MDB_DEL, &info);
326 }
327
328 int dsa_port_vlan_add(struct dsa_port *dp,
329                       const struct switchdev_obj_port_vlan *vlan,
330                       struct switchdev_trans *trans)
331 {
332         struct dsa_notifier_vlan_info info = {
333                 .sw_index = dp->ds->index,
334                 .port = dp->index,
335                 .trans = trans,
336                 .vlan = vlan,
337         };
338
339         if (!dp->bridge_dev || br_vlan_enabled(dp->bridge_dev))
340                 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_ADD, &info);
341
342         return 0;
343 }
344
345 int dsa_port_vlan_del(struct dsa_port *dp,
346                       const struct switchdev_obj_port_vlan *vlan)
347 {
348         struct dsa_notifier_vlan_info info = {
349                 .sw_index = dp->ds->index,
350                 .port = dp->index,
351                 .vlan = vlan,
352         };
353
354         if (!dp->bridge_dev || br_vlan_enabled(dp->bridge_dev))
355                 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info);
356
357         return 0;
358 }
359
360 int dsa_port_vid_add(struct dsa_port *dp, u16 vid, u16 flags)
361 {
362         struct switchdev_obj_port_vlan vlan = {
363                 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
364                 .flags = flags,
365                 .vid_begin = vid,
366                 .vid_end = vid,
367         };
368         struct switchdev_trans trans;
369         int err;
370
371         trans.ph_prepare = true;
372         err = dsa_port_vlan_add(dp, &vlan, &trans);
373         if (err == -EOPNOTSUPP)
374                 return 0;
375
376         trans.ph_prepare = false;
377         return dsa_port_vlan_add(dp, &vlan, &trans);
378 }
379 EXPORT_SYMBOL(dsa_port_vid_add);
380
381 int dsa_port_vid_del(struct dsa_port *dp, u16 vid)
382 {
383         struct switchdev_obj_port_vlan vlan = {
384                 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
385                 .vid_begin = vid,
386                 .vid_end = vid,
387         };
388
389         return dsa_port_vlan_del(dp, &vlan);
390 }
391 EXPORT_SYMBOL(dsa_port_vid_del);
392
393 static struct phy_device *dsa_port_get_phy_device(struct dsa_port *dp)
394 {
395         struct device_node *phy_dn;
396         struct phy_device *phydev;
397
398         phy_dn = of_parse_phandle(dp->dn, "phy-handle", 0);
399         if (!phy_dn)
400                 return NULL;
401
402         phydev = of_phy_find_device(phy_dn);
403         if (!phydev) {
404                 of_node_put(phy_dn);
405                 return ERR_PTR(-EPROBE_DEFER);
406         }
407
408         of_node_put(phy_dn);
409         return phydev;
410 }
411
412 void dsa_port_phylink_validate(struct phylink_config *config,
413                                unsigned long *supported,
414                                struct phylink_link_state *state)
415 {
416         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
417         struct dsa_switch *ds = dp->ds;
418
419         if (!ds->ops->phylink_validate)
420                 return;
421
422         ds->ops->phylink_validate(ds, dp->index, supported, state);
423 }
424 EXPORT_SYMBOL_GPL(dsa_port_phylink_validate);
425
426 int dsa_port_phylink_mac_link_state(struct phylink_config *config,
427                                     struct phylink_link_state *state)
428 {
429         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
430         struct dsa_switch *ds = dp->ds;
431
432         /* Only called for SGMII and 802.3z */
433         if (!ds->ops->phylink_mac_link_state)
434                 return -EOPNOTSUPP;
435
436         return ds->ops->phylink_mac_link_state(ds, dp->index, state);
437 }
438 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_link_state);
439
440 void dsa_port_phylink_mac_config(struct phylink_config *config,
441                                  unsigned int mode,
442                                  const struct phylink_link_state *state)
443 {
444         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
445         struct dsa_switch *ds = dp->ds;
446
447         if (!ds->ops->phylink_mac_config)
448                 return;
449
450         ds->ops->phylink_mac_config(ds, dp->index, mode, state);
451 }
452 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_config);
453
454 void dsa_port_phylink_mac_an_restart(struct phylink_config *config)
455 {
456         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
457         struct dsa_switch *ds = dp->ds;
458
459         if (!ds->ops->phylink_mac_an_restart)
460                 return;
461
462         ds->ops->phylink_mac_an_restart(ds, dp->index);
463 }
464 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_an_restart);
465
466 void dsa_port_phylink_mac_link_down(struct phylink_config *config,
467                                     unsigned int mode,
468                                     phy_interface_t interface)
469 {
470         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
471         struct phy_device *phydev = NULL;
472         struct dsa_switch *ds = dp->ds;
473
474         if (dsa_is_user_port(ds, dp->index))
475                 phydev = dp->slave->phydev;
476
477         if (!ds->ops->phylink_mac_link_down) {
478                 if (ds->ops->adjust_link && phydev)
479                         ds->ops->adjust_link(ds, dp->index, phydev);
480                 return;
481         }
482
483         ds->ops->phylink_mac_link_down(ds, dp->index, mode, interface);
484 }
485 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_link_down);
486
487 void dsa_port_phylink_mac_link_up(struct phylink_config *config,
488                                   unsigned int mode,
489                                   phy_interface_t interface,
490                                   struct phy_device *phydev)
491 {
492         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
493         struct dsa_switch *ds = dp->ds;
494
495         if (!ds->ops->phylink_mac_link_up) {
496                 if (ds->ops->adjust_link && phydev)
497                         ds->ops->adjust_link(ds, dp->index, phydev);
498                 return;
499         }
500
501         ds->ops->phylink_mac_link_up(ds, dp->index, mode, interface, phydev);
502 }
503 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_link_up);
504
505 const struct phylink_mac_ops dsa_port_phylink_mac_ops = {
506         .validate = dsa_port_phylink_validate,
507         .mac_link_state = dsa_port_phylink_mac_link_state,
508         .mac_config = dsa_port_phylink_mac_config,
509         .mac_an_restart = dsa_port_phylink_mac_an_restart,
510         .mac_link_down = dsa_port_phylink_mac_link_down,
511         .mac_link_up = dsa_port_phylink_mac_link_up,
512 };
513
514 static int dsa_port_setup_phy_of(struct dsa_port *dp, bool enable)
515 {
516         struct dsa_switch *ds = dp->ds;
517         struct phy_device *phydev;
518         int port = dp->index;
519         int err = 0;
520
521         phydev = dsa_port_get_phy_device(dp);
522         if (!phydev)
523                 return 0;
524
525         if (IS_ERR(phydev))
526                 return PTR_ERR(phydev);
527
528         if (enable) {
529                 err = genphy_config_init(phydev);
530                 if (err < 0)
531                         goto err_put_dev;
532
533                 err = genphy_resume(phydev);
534                 if (err < 0)
535                         goto err_put_dev;
536
537                 err = genphy_read_status(phydev);
538                 if (err < 0)
539                         goto err_put_dev;
540         } else {
541                 err = genphy_suspend(phydev);
542                 if (err < 0)
543                         goto err_put_dev;
544         }
545
546         if (ds->ops->adjust_link)
547                 ds->ops->adjust_link(ds, port, phydev);
548
549         dev_dbg(ds->dev, "enabled port's phy: %s", phydev_name(phydev));
550
551 err_put_dev:
552         put_device(&phydev->mdio.dev);
553         return err;
554 }
555
556 static int dsa_port_fixed_link_register_of(struct dsa_port *dp)
557 {
558         struct device_node *dn = dp->dn;
559         struct dsa_switch *ds = dp->ds;
560         struct phy_device *phydev;
561         int port = dp->index;
562         int mode;
563         int err;
564
565         err = of_phy_register_fixed_link(dn);
566         if (err) {
567                 dev_err(ds->dev,
568                         "failed to register the fixed PHY of port %d\n",
569                         port);
570                 return err;
571         }
572
573         phydev = of_phy_find_device(dn);
574
575         mode = of_get_phy_mode(dn);
576         if (mode < 0)
577                 mode = PHY_INTERFACE_MODE_NA;
578         phydev->interface = mode;
579
580         genphy_config_init(phydev);
581         genphy_read_status(phydev);
582
583         if (ds->ops->adjust_link)
584                 ds->ops->adjust_link(ds, port, phydev);
585
586         put_device(&phydev->mdio.dev);
587
588         return 0;
589 }
590
591 static int dsa_port_phylink_register(struct dsa_port *dp)
592 {
593         struct dsa_switch *ds = dp->ds;
594         struct device_node *port_dn = dp->dn;
595         int mode, err;
596
597         mode = of_get_phy_mode(port_dn);
598         if (mode < 0)
599                 mode = PHY_INTERFACE_MODE_NA;
600
601         dp->pl_config.dev = ds->dev;
602         dp->pl_config.type = PHYLINK_DEV;
603
604         dp->pl = phylink_create(&dp->pl_config, of_fwnode_handle(port_dn),
605                                 mode, &dsa_port_phylink_mac_ops);
606         if (IS_ERR(dp->pl)) {
607                 pr_err("error creating PHYLINK: %ld\n", PTR_ERR(dp->pl));
608                 return PTR_ERR(dp->pl);
609         }
610
611         err = phylink_of_phy_connect(dp->pl, port_dn, 0);
612         if (err && err != -ENODEV) {
613                 pr_err("could not attach to PHY: %d\n", err);
614                 goto err_phy_connect;
615         }
616
617         rtnl_lock();
618         phylink_start(dp->pl);
619         rtnl_unlock();
620
621         return 0;
622
623 err_phy_connect:
624         phylink_destroy(dp->pl);
625         return err;
626 }
627
628 int dsa_port_link_register_of(struct dsa_port *dp)
629 {
630         struct dsa_switch *ds = dp->ds;
631
632         if (!ds->ops->adjust_link)
633                 return dsa_port_phylink_register(dp);
634
635         dev_warn(ds->dev,
636                  "Using legacy PHYLIB callbacks. Please migrate to PHYLINK!\n");
637
638         if (of_phy_is_fixed_link(dp->dn))
639                 return dsa_port_fixed_link_register_of(dp);
640         else
641                 return dsa_port_setup_phy_of(dp, true);
642 }
643
644 void dsa_port_link_unregister_of(struct dsa_port *dp)
645 {
646         struct dsa_switch *ds = dp->ds;
647
648         if (!ds->ops->adjust_link) {
649                 rtnl_lock();
650                 phylink_disconnect_phy(dp->pl);
651                 rtnl_unlock();
652                 phylink_destroy(dp->pl);
653                 return;
654         }
655
656         if (of_phy_is_fixed_link(dp->dn))
657                 of_phy_deregister_fixed_link(dp->dn);
658         else
659                 dsa_port_setup_phy_of(dp, false);
660 }
661
662 int dsa_port_get_phy_strings(struct dsa_port *dp, uint8_t *data)
663 {
664         struct phy_device *phydev;
665         int ret = -EOPNOTSUPP;
666
667         if (of_phy_is_fixed_link(dp->dn))
668                 return ret;
669
670         phydev = dsa_port_get_phy_device(dp);
671         if (IS_ERR_OR_NULL(phydev))
672                 return ret;
673
674         ret = phy_ethtool_get_strings(phydev, data);
675         put_device(&phydev->mdio.dev);
676
677         return ret;
678 }
679 EXPORT_SYMBOL_GPL(dsa_port_get_phy_strings);
680
681 int dsa_port_get_ethtool_phy_stats(struct dsa_port *dp, uint64_t *data)
682 {
683         struct phy_device *phydev;
684         int ret = -EOPNOTSUPP;
685
686         if (of_phy_is_fixed_link(dp->dn))
687                 return ret;
688
689         phydev = dsa_port_get_phy_device(dp);
690         if (IS_ERR_OR_NULL(phydev))
691                 return ret;
692
693         ret = phy_ethtool_get_stats(phydev, NULL, data);
694         put_device(&phydev->mdio.dev);
695
696         return ret;
697 }
698 EXPORT_SYMBOL_GPL(dsa_port_get_ethtool_phy_stats);
699
700 int dsa_port_get_phy_sset_count(struct dsa_port *dp)
701 {
702         struct phy_device *phydev;
703         int ret = -EOPNOTSUPP;
704
705         if (of_phy_is_fixed_link(dp->dn))
706                 return ret;
707
708         phydev = dsa_port_get_phy_device(dp);
709         if (IS_ERR_OR_NULL(phydev))
710                 return ret;
711
712         ret = phy_ethtool_get_sset_count(phydev);
713         put_device(&phydev->mdio.dev);
714
715         return ret;
716 }
717 EXPORT_SYMBOL_GPL(dsa_port_get_phy_sset_count);
This page took 0.073804 seconds and 4 git commands to generate.