cregit-Linux how code gets into the kernel

Release 4.11 net/dsa/dsa2.c

Directory: net/dsa
/*
 * net/dsa/dsa2.c - Hardware switch handling, binding version 2
 * Copyright (c) 2008-2009 Marvell Semiconductor
 * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org>
 * Copyright (c) 2016 Andrew Lunn <andrew@lunn.ch>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <linux/device.h>
#include <linux/err.h>
#include <linux/list.h>
#include <linux/slab.h>
#include <linux/rtnetlink.h>
#include <net/dsa.h>
#include <linux/of.h>
#include <linux/of_net.h>
#include "dsa_priv.h"

static LIST_HEAD(dsa_switch_trees);
static DEFINE_MUTEX(dsa2_mutex);


static struct dsa_switch_tree *dsa_get_dst(u32 tree) { struct dsa_switch_tree *dst; list_for_each_entry(dst, &dsa_switch_trees, list) if (dst->tree == tree) { kref_get(&dst->refcount); return dst; } return NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn3879.17%150.00%
Nikita Yushchenko1020.83%150.00%
Total48100.00%2100.00%


static void dsa_free_dst(struct kref *ref) { struct dsa_switch_tree *dst = container_of(ref, struct dsa_switch_tree, refcount); list_del(&dst->list); kfree(dst); }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn39100.00%1100.00%
Total39100.00%1100.00%


static void dsa_put_dst(struct dsa_switch_tree *dst) { kref_put(&dst->refcount, dsa_free_dst); }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn21100.00%1100.00%
Total21100.00%1100.00%


static struct dsa_switch_tree *dsa_add_dst(u32 tree) { struct dsa_switch_tree *dst; dst = kzalloc(sizeof(*dst), GFP_KERNEL); if (!dst) return NULL; dst->tree = tree; INIT_LIST_HEAD(&dst->list); list_add_tail(&dsa_switch_trees, &dst->list); kref_init(&dst->refcount); return dst; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn73100.00%1100.00%
Total73100.00%1100.00%


static void dsa_dst_add_ds(struct dsa_switch_tree *dst, struct dsa_switch *ds, u32 index) { kref_get(&dst->refcount); dst->ds[index] = ds; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn36100.00%1100.00%
Total36100.00%1100.00%


static void dsa_dst_del_ds(struct dsa_switch_tree *dst, struct dsa_switch *ds, u32 index) { dst->ds[index] = NULL; kref_put(&dst->refcount, dsa_free_dst); }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn38100.00%1100.00%
Total38100.00%1100.00%

/* For platform data configurations, we need to have a valid name argument to * differentiate a disabled port from an enabled one */
static bool dsa_port_is_valid(struct dsa_port *port) { return !!(port->dn || port->name); }

Contributors

PersonTokensPropCommitsCommitProp
Florian Fainelli24100.00%2100.00%
Total24100.00%2100.00%


static bool dsa_port_is_dsa(struct dsa_port *port) { if (port->name && !strcmp(port->name, "dsa")) return true; else return !!of_parse_phandle(port->dn, "link", 0); }

Contributors

PersonTokensPropCommitsCommitProp
Florian Fainelli2351.11%250.00%
Andrew Lunn1635.56%125.00%
Vivien Didelot613.33%125.00%
Total45100.00%4100.00%


static bool dsa_port_is_cpu(struct dsa_port *port) { if (port->name && !strcmp(port->name, "cpu")) return true; else return !!of_parse_phandle(port->dn, "ethernet", 0); }

Contributors

PersonTokensPropCommitsCommitProp
Florian Fainelli2351.11%250.00%
Andrew Lunn1635.56%125.00%
Vivien Didelot613.33%125.00%
Total45100.00%4100.00%


static bool dsa_ds_find_port_dn(struct dsa_switch *ds, struct device_node *port) { u32 index; for (index = 0; index < ds->num_ports; index++) if (ds->ports[index].dn == port) return true; return false; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn4992.45%133.33%
Vivien Didelot35.66%133.33%
Florian Fainelli11.89%133.33%
Total53100.00%3100.00%


static struct dsa_switch *dsa_dst_find_port_dn(struct dsa_switch_tree *dst, struct device_node *port) { struct dsa_switch *ds; u32 index; for (index = 0; index < DSA_MAX_SWITCHES; index++) { ds = dst->ds[index]; if (!ds) continue; if (dsa_ds_find_port_dn(ds, port)) return ds; } return NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn6997.18%150.00%
Florian Fainelli22.82%150.00%
Total71100.00%2100.00%


static int dsa_port_complete(struct dsa_switch_tree *dst, struct dsa_switch *src_ds, struct dsa_port *port, u32 src_port) { struct device_node *link; int index; struct dsa_switch *dst_ds; for (index = 0;; index++) { link = of_parse_phandle(port->dn, "link", index); if (!link) break; dst_ds = dsa_dst_find_port_dn(dst, link); of_node_put(link); if (!dst_ds) return 1; src_ds->rtable[dst_ds->index] = src_port; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn10096.15%133.33%
Florian Fainelli43.85%266.67%
Total104100.00%3100.00%

/* A switch is complete if all the DSA ports phandles point to ports * known in the tree. A return value of 1 means the tree is not * complete. This is not an error condition. A value of 0 is * success. */
static int dsa_ds_complete(struct dsa_switch_tree *dst, struct dsa_switch *ds) { struct dsa_port *port; u32 index; int err; for (index = 0; index < ds->num_ports; index++) { port = &ds->ports[index]; if (!dsa_port_is_valid(port)) continue; if (!dsa_port_is_dsa(port)) continue; err = dsa_port_complete(dst, ds, port, index); if (err != 0) return err; ds->dsa_port_mask |= BIT(index); } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn9892.45%133.33%
Florian Fainelli54.72%133.33%
Vivien Didelot32.83%133.33%
Total106100.00%3100.00%

/* A tree is complete if all the DSA ports phandles point to ports * known in the tree. A return value of 1 means the tree is not * complete. This is not an error condition. A value of 0 is * success. */
static int dsa_dst_complete(struct dsa_switch_tree *dst) { struct dsa_switch *ds; u32 index; int err; for (index = 0; index < DSA_MAX_SWITCHES; index++) { ds = dst->ds[index]; if (!ds) continue; err = dsa_ds_complete(dst, ds); if (err != 0) return err; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn73100.00%1100.00%
Total73100.00%1100.00%


static int dsa_dsa_port_apply(struct dsa_port *port, u32 index, struct dsa_switch *ds) { int err; err = dsa_cpu_dsa_setup(ds, ds->dev, port, index); if (err) { dev_warn(ds->dev, "Failed to setup dsa port %d: %d\n", index, err); return err; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn6198.39%150.00%
Florian Fainelli11.61%150.00%
Total62100.00%2100.00%


static void dsa_dsa_port_unapply(struct dsa_port *port, u32 index, struct dsa_switch *ds) { dsa_cpu_dsa_destroy(port); }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn2395.83%150.00%
Florian Fainelli14.17%150.00%
Total24100.00%2100.00%


static int dsa_cpu_port_apply(struct dsa_port *port, u32 index, struct dsa_switch *ds) { int err; err = dsa_cpu_dsa_setup(ds, ds->dev, port, index); if (err) { dev_warn(ds->dev, "Failed to setup cpu port %d: %d\n", index, err); return err; } ds->cpu_port_mask |= BIT(index); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn7098.59%150.00%
Florian Fainelli11.41%150.00%
Total71100.00%2100.00%


static void dsa_cpu_port_unapply(struct dsa_port *port, u32 index, struct dsa_switch *ds) { dsa_cpu_dsa_destroy(port); ds->cpu_port_mask &= ~BIT(index); }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn3397.06%150.00%
Florian Fainelli12.94%150.00%
Total34100.00%2100.00%


static int dsa_user_port_apply(struct dsa_port *port, u32 index, struct dsa_switch *ds) { const char *name = port->name; int err; if (port->dn) name = of_get_property(port->dn, "label", NULL); if (!name) name = "eth%d"; err = dsa_slave_create(ds, ds->dev, index, name); if (err) { dev_warn(ds->dev, "Failed to create slave %d: %d\n", index, err); ds->ports[index].netdev = NULL; return err; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn7770.00%120.00%
Florian Fainelli2421.82%360.00%
Vivien Didelot98.18%120.00%
Total110100.00%5100.00%


static void dsa_user_port_unapply(struct dsa_port *port, u32 index, struct dsa_switch *ds) { if (ds->ports[index].netdev) { dsa_slave_destroy(ds->ports[index].netdev); ds->ports[index].netdev = NULL; ds->enabled_port_mask &= ~(1 << index); } }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn5481.82%133.33%
Florian Fainelli1218.18%266.67%
Total66100.00%3100.00%


static int dsa_ds_apply(struct dsa_switch_tree *dst, struct dsa_switch *ds) { struct dsa_port *port; u32 index; int err; /* Initialize ds->phys_mii_mask before registering the slave MDIO bus * driver and before ops->setup() has run, since the switch drivers and * the slave MDIO bus driver rely on these values for probing PHY * devices or not */ ds->phys_mii_mask = ds->enabled_port_mask; err = ds->ops->setup(ds); if (err < 0) return err; err = dsa_switch_register_notifier(ds); if (err) return err; if (ds->ops->set_addr) { err = ds->ops->set_addr(ds, dst->master_netdev->dev_addr); if (err < 0) return err; } if (!ds->slave_mii_bus && ds->ops->phy_read) { ds->slave_mii_bus = devm_mdiobus_alloc(ds->dev); if (!ds->slave_mii_bus) return -ENOMEM; dsa_slave_mii_bus_init(ds); err = mdiobus_register(ds->slave_mii_bus); if (err < 0) return err; } for (index = 0; index < ds->num_ports; index++) { port = &ds->ports[index]; if (!dsa_port_is_valid(port)) continue; if (dsa_port_is_dsa(port)) { err = dsa_dsa_port_apply(port, index, ds); if (err) return err; continue; } if (dsa_port_is_cpu(port)) { err = dsa_cpu_port_apply(port, index, ds); if (err) return err; continue; } err = dsa_user_port_apply(port, index, ds); if (err) continue; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn17462.82%112.50%
Florian Fainelli7225.99%337.50%
Vivien Didelot217.58%337.50%
John Crispin103.61%112.50%
Total277100.00%8100.00%


static void dsa_ds_unapply(struct dsa_switch_tree *dst, struct dsa_switch *ds) { struct dsa_port *port; u32 index; for (index = 0; index < ds->num_ports; index++) { port = &ds->ports[index]; if (!dsa_port_is_valid(port)) continue; if (dsa_port_is_dsa(port)) { dsa_dsa_port_unapply(port, index, ds); continue; } if (dsa_port_is_cpu(port)) { dsa_cpu_port_unapply(port, index, ds); continue; } dsa_user_port_unapply(port, index, ds); } if (ds->slave_mii_bus && ds->ops->phy_read) mdiobus_unregister(ds->slave_mii_bus); dsa_switch_unregister_notifier(ds); }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn9975.57%116.67%
Florian Fainelli2317.56%233.33%
Vivien Didelot96.87%350.00%
Total131100.00%6100.00%


static int dsa_dst_apply(struct dsa_switch_tree *dst) { struct dsa_switch *ds; u32 index; int err; for (index = 0; index < DSA_MAX_SWITCHES; index++) { ds = dst->ds[index]; if (!ds) continue; err = dsa_ds_apply(dst, ds); if (err) return err; } if (dst->cpu_switch) { err = dsa_cpu_port_ethtool_setup(dst->cpu_switch); if (err) return err; } /* If we use a tagging format that doesn't have an ethertype * field, make sure that all packets from this point on get * sent to the tag format's receive function. */ wmb(); dst->master_netdev->dsa_ptr = (void *)dst; dst->applied = true; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn9379.49%125.00%
Florian Fainelli2218.80%250.00%
Vivien Didelot21.71%125.00%
Total117100.00%4100.00%


static void dsa_dst_unapply(struct dsa_switch_tree *dst) { struct dsa_switch *ds; u32 index; if (!dst->applied) return; dst->master_netdev->dsa_ptr = NULL; /* If we used a tagging format that doesn't have an ethertype * field, make sure that all packets from this point get sent * without the tag and go through the regular receive path. */ wmb(); for (index = 0; index < DSA_MAX_SWITCHES; index++) { ds = dst->ds[index]; if (!ds) continue; dsa_ds_unapply(dst, ds); } if (dst->cpu_switch) dsa_cpu_port_ethtool_restore(dst->cpu_switch); pr_info("DSA: tree %d unapplied\n", dst->tree); dst->applied = false; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn9187.50%125.00%
Florian Fainelli1110.58%250.00%
Vivien Didelot21.92%125.00%
Total104100.00%4100.00%


static int dsa_cpu_parse(struct dsa_port *port, u32 index, struct dsa_switch_tree *dst, struct dsa_switch *ds) { enum dsa_tag_protocol tag_protocol; struct net_device *ethernet_dev; struct device_node *ethernet; if (port->dn) { ethernet = of_parse_phandle(port->dn, "ethernet", 0); if (!ethernet) return -EINVAL; ethernet_dev = of_find_net_device_by_node(ethernet); } else { ethernet_dev = dsa_dev_to_net_device(ds->cd->netdev[index]); dev_put(ethernet_dev); } if (!ethernet_dev) return -EPROBE_DEFER; if (!ds->master_netdev) ds->master_netdev = ethernet_dev; if (!dst->master_netdev) dst->master_netdev = ethernet_dev; if (!dst->cpu_switch) { dst->cpu_switch = ds; dst->cpu_port = index; } tag_protocol = ds->ops->get_tag_protocol(ds); dst->tag_ops = dsa_resolve_tag_protocol(tag_protocol); if (IS_ERR(dst->tag_ops)) { dev_warn(ds->dev, "No tagger for this switch\n"); return PTR_ERR(dst->tag_ops); } dst->rcv = dst->tag_ops->rcv; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn17983.64%233.33%
Florian Fainelli3315.42%233.33%
Vivien Didelot20.93%233.33%
Total214100.00%6100.00%


static int dsa_ds_parse(struct dsa_switch_tree *dst, struct dsa_switch *ds) { struct dsa_port *port; u32 index; int err; for (index = 0; index < ds->num_ports; index++) { port = &ds->ports[index]; if (!dsa_port_is_valid(port)) continue; if (dsa_port_is_cpu(port)) { err = dsa_cpu_parse(port, index, dst, ds); if (err) return err; } } pr_info("DSA: switch %d %d parsed\n", dst->tree, ds->index); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn10092.59%133.33%
Florian Fainelli54.63%133.33%
Vivien Didelot32.78%133.33%
Total108100.00%3100.00%


static int dsa_dst_parse(struct dsa_switch_tree *dst) { struct dsa_switch *ds; u32 index; int err; for (index = 0; index < DSA_MAX_SWITCHES; index++) { ds = dst->ds[index]; if (!ds) continue; err = dsa_ds_parse(dst, ds); if (err) return err; } if (!dst->master_netdev) { pr_warn("Tree has no master device\n"); return -EINVAL; } pr_info("DSA: tree %d parsed\n", dst->tree); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn98100.00%1100.00%
Total98100.00%1100.00%


static int dsa_parse_ports_dn(struct device_node *ports, struct dsa_switch *ds) { struct device_node *port; int err; u32 reg; for_each_available_child_of_node(ports, port) { err = of_property_read_u32(port, "reg", &reg); if (err) return err; if (reg >= ds->num_ports) return -EINVAL; ds->ports[reg].dn = port; /* Initialize enabled_port_mask now for ops->setup() * to have access to a correct value, just like what * net/dsa/dsa.c::dsa_switch_setup_one does. */ if (!dsa_port_is_cpu(&ds->ports[reg])) ds->enabled_port_mask |= 1 << reg; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn7774.76%120.00%
Florian Fainelli2221.36%240.00%
Vivien Didelot43.88%240.00%
Total103100.00%5100.00%


static int dsa_parse_ports(struct dsa_chip_data *cd, struct dsa_switch *ds) { bool valid_name_found = false; unsigned int i; for (i = 0; i < DSA_MAX_PORTS; i++) { if (!cd->port_names[i]) continue; ds->ports[i].name = cd->port_names[i]; /* Initialize enabled_port_mask now for drv->setup() * to have access to a correct value, just like what * net/dsa/dsa.c::dsa_switch_setup_one does. */ if (!dsa_port_is_cpu(&ds->ports[i])) ds->enabled_port_mask |= 1 << i; valid_name_found = true; } if (!valid_name_found && i == DSA_MAX_PORTS) return -EINVAL; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Florian Fainelli110100.00%1100.00%
Total110100.00%1100.00%


static int dsa_parse_member_dn(struct device_node *np, u32 *tree, u32 *index) { int err; *tree = *index = 0; err = of_property_read_u32_index(np, "dsa,member", 0, tree); if (err) { /* Does not exist, but it is optional */ if (err == -EINVAL) return 0; return err; } err = of_property_read_u32_index(np, "dsa,member", 1, index); if (err) return err; if (*index >= DSA_MAX_SWITCHES) return -EINVAL; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn9698.97%150.00%
Florian Fainelli11.03%150.00%
Total97100.00%2100.00%


static int dsa_parse_member(struct dsa_chip_data *pd, u32 *tree, u32 *index) { if (!pd) return -ENODEV; /* We do not support complex trees with dsa_chip_data */ *tree = 0; *index = 0; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Florian Fainelli42100.00%1100.00%
Total42100.00%1100.00%


static struct device_node *dsa_get_ports(struct dsa_switch *ds, struct device_node *np) { struct device_node *ports; ports = of_get_child_by_name(np, "ports"); if (!ports) { dev_err(ds->dev, "no ports child node found\n"); return ERR_PTR(-EINVAL); } return ports; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn58100.00%1100.00%
Total58100.00%1100.00%


static int _dsa_register_switch(struct dsa_switch *ds, struct device *dev) { struct dsa_chip_data *pdata = dev->platform_data; struct device_node *np = dev->of_node; struct dsa_switch_tree *dst; struct device_node *ports; u32 tree, index; int i, err; if (np) { err = dsa_parse_member_dn(np, &tree, &index); if (err) return err; ports = dsa_get_ports(ds, np); if (IS_ERR(ports)) return PTR_ERR(ports); err = dsa_parse_ports_dn(ports, ds); if (err) return err; } else { err = dsa_parse_member(pdata, &tree, &index); if (err) return err; err = dsa_parse_ports(pdata, ds); if (err) return err; } dst = dsa_get_dst(tree); if (!dst) { dst = dsa_add_dst(tree); if (!dst) return -ENOMEM; } if (dst->ds[index]) { err = -EBUSY; goto out; } ds->dst = dst; ds->index = index; ds->cd = pdata; /* Initialize the routing table */ for (i = 0; i < DSA_MAX_SWITCHES; ++i) ds->rtable[i] = DSA_RTABLE_NONE; dsa_dst_add_ds(dst, ds, index); err = dsa_dst_complete(dst); if (err < 0) goto out_del_dst; if (err == 1) { /* Not all switches registered yet */ err = 0; goto out; } if (dst->applied) { pr_info("DSA: Disjoint trees?\n"); return -EINVAL; } err = dsa_dst_parse(dst); if (err) { if (err == -EPROBE_DEFER) { dsa_dst_del_ds(dst, ds, ds->index); return err; } goto out_del_dst; } err = dsa_dst_apply(dst); if (err) { dsa_dst_unapply(dst); goto out_del_dst; } dsa_put_dst(dst); return 0; out_del_dst: dsa_dst_del_ds(dst, ds, ds->index); out: dsa_put_dst(dst); return err; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Lunn26266.16%114.29%
Florian Fainelli8421.21%457.14%
Vivien Didelot256.31%114.29%
Volodymyr Bendiuga256.31%114.29%
Total396100.00%7100.00%


struct dsa_switch *dsa_switch_alloc(struct devic