net/dsa/port.c

   1 /*
   2  * Handling of a single switch port
   3  *
   4  * Copyright (c) 2017 Savoir-faire Linux Inc.
   5  *      Vivien Didelot <[email protected]>
   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>
  14 #include <linux/notifier.h>
  15 #include <linux/of_mdio.h>
  16 #include <linux/of_net.h>
  17
  18 #include "dsa_priv.h"
  19
  20 static int dsa_port_notify(const struct dsa_port *dp, unsigned long e, void *v)
  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
  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
  61 static void dsa_port_set_state_now(struct dsa_port *dp, u8 state)
  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 }
  69
  70 int dsa_port_enable(struct dsa_port *dp, struct phy_device *phy)
  71 {
  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
  82         if (!dp->bridge_dev)
  83                 dsa_port_set_state_now(dp, BR_STATE_FORWARDING);
  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
  93         if (!dp->bridge_dev)
  94                 dsa_port_set_state_now(dp, BR_STATE_DISABLED);
  95
  96         if (ds->ops->port_disable)
  97                 ds->ops->port_disable(ds, port, phy);
  98 }
  99
 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 }
 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 }
 162
 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);
 168         struct dsa_notifier_ageing_time_info info = {
 169                 .ageing_time = ageing_time,
 170                 .trans = trans,
 171         };
 172
 173         if (switchdev_trans_ph_prepare(trans))
 174                 return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info);
 175
 176         dp->ageing_time = ageing_time;
 177
 178         return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info);
 179 }
 180
 181 int dsa_port_fdb_add(struct dsa_port *dp, const unsigned char *addr,
 182                      u16 vid)
 183 {
 184         struct dsa_notifier_fdb_info info = {
 185                 .sw_index = dp->ds->index,
 186                 .port = dp->index,
 187                 .addr = addr,
 188                 .vid = vid,
 189         };
 190
 191         return dsa_port_notify(dp, DSA_NOTIFIER_FDB_ADD, &info);
 192 }
 193
 194 int dsa_port_fdb_del(struct dsa_port *dp, const unsigned char *addr,
 195                      u16 vid)
 196 {
 197         struct dsa_notifier_fdb_info info = {
 198                 .sw_index = dp->ds->index,
 199                 .port = dp->index,
 200                 .addr = addr,
 201                 .vid = vid,
 202
 203         };
 204
 205         return dsa_port_notify(dp, DSA_NOTIFIER_FDB_DEL, &info);
 206 }
 207
 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
 219 int dsa_port_mdb_add(const struct dsa_port *dp,
 220                      const struct switchdev_obj_port_mdb *mdb,
 221                      struct switchdev_trans *trans)
 222 {
 223         struct dsa_notifier_mdb_info info = {
 224                 .sw_index = dp->ds->index,
 225                 .port = dp->index,
 226                 .trans = trans,
 227                 .mdb = mdb,
 228         };
 229
 230         return dsa_port_notify(dp, DSA_NOTIFIER_MDB_ADD, &info);
 231 }
 232
 233 int dsa_port_mdb_del(const struct dsa_port *dp,
 234                      const struct switchdev_obj_port_mdb *mdb)
 235 {
 236         struct dsa_notifier_mdb_info info = {
 237                 .sw_index = dp->ds->index,
 238                 .port = dp->index,
 239                 .mdb = mdb,
 240         };
 241
 242         return dsa_port_notify(dp, DSA_NOTIFIER_MDB_DEL, &info);
 243 }
 244
 245 int dsa_port_vlan_add(struct dsa_port *dp,
 246                       const struct switchdev_obj_port_vlan *vlan,
 247                       struct switchdev_trans *trans)
 248 {
 249         struct dsa_notifier_vlan_info info = {
 250                 .sw_index = dp->ds->index,
 251                 .port = dp->index,
 252                 .trans = trans,
 253                 .vlan = vlan,
 254         };
 255
 256         if (br_vlan_enabled(dp->bridge_dev))
 257                 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_ADD, &info);
 258
 259         return 0;
 260 }
 261
 262 int dsa_port_vlan_del(struct dsa_port *dp,
 263                       const struct switchdev_obj_port_vlan *vlan)
 264 {
 265         struct dsa_notifier_vlan_info info = {
 266                 .sw_index = dp->ds->index,
 267                 .port = dp->index,
 268                 .vlan = vlan,
 269         };
 270
 271         if (netif_is_bridge_master(vlan->obj.orig_dev))
 272                 return -EOPNOTSUPP;
 273
 274         if (br_vlan_enabled(dp->bridge_dev))
 275                 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info);
 276
 277         return 0;
 278 }
 279
 280 static struct phy_device *dsa_port_get_phy_device(struct dsa_port *dp)
 281 {
 282         struct device_node *phy_dn;
 283         struct phy_device *phydev;
 284
 285         phy_dn = of_parse_phandle(dp->dn, "phy-handle", 0);
 286         if (!phy_dn)
 287                 return NULL;
 288
 289         phydev = of_phy_find_device(phy_dn);
 290         if (!phydev) {
 291                 of_node_put(phy_dn);
 292                 return ERR_PTR(-EPROBE_DEFER);
 293         }
 294
 295         of_node_put(phy_dn);
 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
 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);
 338         return err;
 339 }
 340
 341 static int dsa_port_fixed_link_register_of(struct dsa_port *dp)
 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
 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         }
 357
 358         phydev = of_phy_find_device(dn);
 359
 360         mode = of_get_phy_mode(dn);
 361         if (mode < 0)
 362                 mode = PHY_INTERFACE_MODE_NA;
 363         phydev->interface = mode;
 364
 365         genphy_config_init(phydev);
 366         genphy_read_status(phydev);
 367
 368         if (ds->ops->adjust_link)
 369                 ds->ops->adjust_link(ds, port, phydev);
 370
 371         put_device(&phydev->mdio.dev);
 372
 373         return 0;
 374 }
 375
 376 int dsa_port_link_register_of(struct dsa_port *dp)
 377 {
 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 }
 383
 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);
 390 }
 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);