|
@@ -214,66 +214,59 @@ static int dsa_dst_complete(struct dsa_switch_tree *dst)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
-static int dsa_dsa_port_apply(struct dsa_port *port, u32 index,
|
|
|
|
- struct dsa_switch *ds)
|
|
|
|
|
|
+static int dsa_dsa_port_apply(struct dsa_port *port)
|
|
{
|
|
{
|
|
|
|
+ struct dsa_switch *ds = port->ds;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- err = dsa_cpu_dsa_setup(ds, ds->dev, port, index);
|
|
|
|
|
|
+ err = dsa_cpu_dsa_setup(ds, ds->dev, port, port->index);
|
|
if (err) {
|
|
if (err) {
|
|
dev_warn(ds->dev, "Failed to setup dsa port %d: %d\n",
|
|
dev_warn(ds->dev, "Failed to setup dsa port %d: %d\n",
|
|
- index, err);
|
|
|
|
|
|
+ port->index, err);
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
- memset(&ds->ports[index].devlink_port, 0,
|
|
|
|
- sizeof(ds->ports[index].devlink_port));
|
|
|
|
|
|
+ memset(&port->devlink_port, 0, sizeof(port->devlink_port));
|
|
|
|
|
|
- return devlink_port_register(ds->devlink,
|
|
|
|
- &ds->ports[index].devlink_port,
|
|
|
|
- index);
|
|
|
|
|
|
+ return devlink_port_register(ds->devlink, &port->devlink_port,
|
|
|
|
+ port->index);
|
|
}
|
|
}
|
|
|
|
|
|
-static void dsa_dsa_port_unapply(struct dsa_port *port, u32 index,
|
|
|
|
- struct dsa_switch *ds)
|
|
|
|
|
|
+static void dsa_dsa_port_unapply(struct dsa_port *port)
|
|
{
|
|
{
|
|
- devlink_port_unregister(&ds->ports[index].devlink_port);
|
|
|
|
|
|
+ devlink_port_unregister(&port->devlink_port);
|
|
dsa_cpu_dsa_destroy(port);
|
|
dsa_cpu_dsa_destroy(port);
|
|
}
|
|
}
|
|
|
|
|
|
-static int dsa_cpu_port_apply(struct dsa_port *port, u32 index,
|
|
|
|
- struct dsa_switch *ds)
|
|
|
|
|
|
+static int dsa_cpu_port_apply(struct dsa_port *port)
|
|
{
|
|
{
|
|
|
|
+ struct dsa_switch *ds = port->ds;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- err = dsa_cpu_dsa_setup(ds, ds->dev, port, index);
|
|
|
|
|
|
+ err = dsa_cpu_dsa_setup(ds, ds->dev, port, port->index);
|
|
if (err) {
|
|
if (err) {
|
|
dev_warn(ds->dev, "Failed to setup cpu port %d: %d\n",
|
|
dev_warn(ds->dev, "Failed to setup cpu port %d: %d\n",
|
|
- index, err);
|
|
|
|
|
|
+ port->index, err);
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
- ds->cpu_port_mask |= BIT(index);
|
|
|
|
-
|
|
|
|
- memset(&ds->ports[index].devlink_port, 0,
|
|
|
|
- sizeof(ds->ports[index].devlink_port));
|
|
|
|
- err = devlink_port_register(ds->devlink, &ds->ports[index].devlink_port,
|
|
|
|
- index);
|
|
|
|
|
|
+ memset(&port->devlink_port, 0, sizeof(port->devlink_port));
|
|
|
|
+ err = devlink_port_register(ds->devlink, &port->devlink_port,
|
|
|
|
+ port->index);
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-static void dsa_cpu_port_unapply(struct dsa_port *port, u32 index,
|
|
|
|
- struct dsa_switch *ds)
|
|
|
|
|
|
+static void dsa_cpu_port_unapply(struct dsa_port *port)
|
|
{
|
|
{
|
|
- devlink_port_unregister(&ds->ports[index].devlink_port);
|
|
|
|
|
|
+ devlink_port_unregister(&port->devlink_port);
|
|
dsa_cpu_dsa_destroy(port);
|
|
dsa_cpu_dsa_destroy(port);
|
|
- ds->cpu_port_mask &= ~BIT(index);
|
|
|
|
|
|
+ port->ds->cpu_port_mask &= ~BIT(port->index);
|
|
|
|
|
|
}
|
|
}
|
|
|
|
|
|
-static int dsa_user_port_apply(struct dsa_port *port, u32 index,
|
|
|
|
- struct dsa_switch *ds)
|
|
|
|
|
|
+static int dsa_user_port_apply(struct dsa_port *port)
|
|
{
|
|
{
|
|
|
|
+ struct dsa_switch *ds = port->ds;
|
|
const char *name = port->name;
|
|
const char *name = port->name;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
@@ -282,35 +275,32 @@ static int dsa_user_port_apply(struct dsa_port *port, u32 index,
|
|
if (!name)
|
|
if (!name)
|
|
name = "eth%d";
|
|
name = "eth%d";
|
|
|
|
|
|
- err = dsa_slave_create(ds, ds->dev, index, name);
|
|
|
|
|
|
+ err = dsa_slave_create(ds, ds->dev, port->index, name);
|
|
if (err) {
|
|
if (err) {
|
|
dev_warn(ds->dev, "Failed to create slave %d: %d\n",
|
|
dev_warn(ds->dev, "Failed to create slave %d: %d\n",
|
|
- index, err);
|
|
|
|
- ds->ports[index].netdev = NULL;
|
|
|
|
|
|
+ port->index, err);
|
|
|
|
+ port->netdev = NULL;
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
- memset(&ds->ports[index].devlink_port, 0,
|
|
|
|
- sizeof(ds->ports[index].devlink_port));
|
|
|
|
- err = devlink_port_register(ds->devlink, &ds->ports[index].devlink_port,
|
|
|
|
- index);
|
|
|
|
|
|
+ memset(&port->devlink_port, 0, sizeof(port->devlink_port));
|
|
|
|
+ err = devlink_port_register(ds->devlink, &port->devlink_port,
|
|
|
|
+ port->index);
|
|
if (err)
|
|
if (err)
|
|
return err;
|
|
return err;
|
|
|
|
|
|
- devlink_port_type_eth_set(&ds->ports[index].devlink_port,
|
|
|
|
- ds->ports[index].netdev);
|
|
|
|
|
|
+ devlink_port_type_eth_set(&port->devlink_port, port->netdev);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
-static void dsa_user_port_unapply(struct dsa_port *port, u32 index,
|
|
|
|
- struct dsa_switch *ds)
|
|
|
|
|
|
+static void dsa_user_port_unapply(struct dsa_port *port)
|
|
{
|
|
{
|
|
- devlink_port_unregister(&ds->ports[index].devlink_port);
|
|
|
|
- if (ds->ports[index].netdev) {
|
|
|
|
- dsa_slave_destroy(ds->ports[index].netdev);
|
|
|
|
- ds->ports[index].netdev = NULL;
|
|
|
|
- ds->enabled_port_mask &= ~(1 << index);
|
|
|
|
|
|
+ devlink_port_unregister(&port->devlink_port);
|
|
|
|
+ if (port->netdev) {
|
|
|
|
+ dsa_slave_destroy(port->netdev);
|
|
|
|
+ port->netdev = NULL;
|
|
|
|
+ port->ds->enabled_port_mask &= ~(1 << port->index);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
@@ -370,20 +360,20 @@ static int dsa_ds_apply(struct dsa_switch_tree *dst, struct dsa_switch *ds)
|
|
continue;
|
|
continue;
|
|
|
|
|
|
if (dsa_port_is_dsa(port)) {
|
|
if (dsa_port_is_dsa(port)) {
|
|
- err = dsa_dsa_port_apply(port, index, ds);
|
|
|
|
|
|
+ err = dsa_dsa_port_apply(port);
|
|
if (err)
|
|
if (err)
|
|
return err;
|
|
return err;
|
|
continue;
|
|
continue;
|
|
}
|
|
}
|
|
|
|
|
|
if (dsa_port_is_cpu(port)) {
|
|
if (dsa_port_is_cpu(port)) {
|
|
- err = dsa_cpu_port_apply(port, index, ds);
|
|
|
|
|
|
+ err = dsa_cpu_port_apply(port);
|
|
if (err)
|
|
if (err)
|
|
return err;
|
|
return err;
|
|
continue;
|
|
continue;
|
|
}
|
|
}
|
|
|
|
|
|
- err = dsa_user_port_apply(port, index, ds);
|
|
|
|
|
|
+ err = dsa_user_port_apply(port);
|
|
if (err)
|
|
if (err)
|
|
continue;
|
|
continue;
|
|
}
|
|
}
|
|
@@ -402,16 +392,16 @@ static void dsa_ds_unapply(struct dsa_switch_tree *dst, struct dsa_switch *ds)
|
|
continue;
|
|
continue;
|
|
|
|
|
|
if (dsa_port_is_dsa(port)) {
|
|
if (dsa_port_is_dsa(port)) {
|
|
- dsa_dsa_port_unapply(port, index, ds);
|
|
|
|
|
|
+ dsa_dsa_port_unapply(port);
|
|
continue;
|
|
continue;
|
|
}
|
|
}
|
|
|
|
|
|
if (dsa_port_is_cpu(port)) {
|
|
if (dsa_port_is_cpu(port)) {
|
|
- dsa_cpu_port_unapply(port, index, ds);
|
|
|
|
|
|
+ dsa_cpu_port_unapply(port);
|
|
continue;
|
|
continue;
|
|
}
|
|
}
|
|
|
|
|
|
- dsa_user_port_unapply(port, index, ds);
|
|
|
|
|
|
+ dsa_user_port_unapply(port);
|
|
}
|
|
}
|
|
|
|
|
|
if (ds->slave_mii_bus && ds->ops->phy_read)
|
|
if (ds->slave_mii_bus && ds->ops->phy_read)
|
|
@@ -444,7 +434,7 @@ static int dsa_dst_apply(struct dsa_switch_tree *dst)
|
|
}
|
|
}
|
|
|
|
|
|
if (dst->cpu_dp) {
|
|
if (dst->cpu_dp) {
|
|
- err = dsa_cpu_port_ethtool_setup(dst->cpu_dp->ds);
|
|
|
|
|
|
+ err = dsa_cpu_port_ethtool_setup(dst->cpu_dp);
|
|
if (err)
|
|
if (err)
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
@@ -485,7 +475,7 @@ static void dsa_dst_unapply(struct dsa_switch_tree *dst)
|
|
}
|
|
}
|
|
|
|
|
|
if (dst->cpu_dp)
|
|
if (dst->cpu_dp)
|
|
- dsa_cpu_port_ethtool_restore(dst->cpu_dp->ds);
|
|
|
|
|
|
+ dsa_cpu_port_ethtool_restore(dst->cpu_dp);
|
|
|
|
|
|
pr_info("DSA: tree %d unapplied\n", dst->tree);
|
|
pr_info("DSA: tree %d unapplied\n", dst->tree);
|
|
dst->applied = false;
|
|
dst->applied = false;
|
|
@@ -530,6 +520,12 @@ static int dsa_cpu_parse(struct dsa_port *port, u32 index,
|
|
|
|
|
|
dst->rcv = dst->tag_ops->rcv;
|
|
dst->rcv = dst->tag_ops->rcv;
|
|
|
|
|
|
|
|
+ /* Initialize cpu_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.
|
|
|
|
+ */
|
|
|
|
+ ds->cpu_port_mask |= BIT(index);
|
|
|
|
+
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -541,14 +537,22 @@ static int dsa_ds_parse(struct dsa_switch_tree *dst, struct dsa_switch *ds)
|
|
|
|
|
|
for (index = 0; index < ds->num_ports; index++) {
|
|
for (index = 0; index < ds->num_ports; index++) {
|
|
port = &ds->ports[index];
|
|
port = &ds->ports[index];
|
|
- if (!dsa_port_is_valid(port))
|
|
|
|
|
|
+ if (!dsa_port_is_valid(port) ||
|
|
|
|
+ dsa_port_is_dsa(port))
|
|
continue;
|
|
continue;
|
|
|
|
|
|
if (dsa_port_is_cpu(port)) {
|
|
if (dsa_port_is_cpu(port)) {
|
|
err = dsa_cpu_parse(port, index, dst, ds);
|
|
err = dsa_cpu_parse(port, index, dst, ds);
|
|
if (err)
|
|
if (err)
|
|
return err;
|
|
return err;
|
|
|
|
+ } else {
|
|
|
|
+ /* 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.
|
|
|
|
+ */
|
|
|
|
+ ds->enabled_port_mask |= BIT(index);
|
|
}
|
|
}
|
|
|
|
+
|
|
}
|
|
}
|
|
|
|
|
|
pr_info("DSA: switch %d %d parsed\n", dst->tree, ds->index);
|
|
pr_info("DSA: switch %d %d parsed\n", dst->tree, ds->index);
|
|
@@ -597,13 +601,6 @@ static int dsa_parse_ports_dn(struct device_node *ports, struct dsa_switch *ds)
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
|
|
|
|
ds->ports[reg].dn = port;
|
|
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;
|
|
return 0;
|
|
@@ -619,14 +616,6 @@ static int dsa_parse_ports(struct dsa_chip_data *cd, struct dsa_switch *ds)
|
|
continue;
|
|
continue;
|
|
|
|
|
|
ds->ports[i].name = cd->port_names[i];
|
|
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;
|
|
valid_name_found = true;
|
|
}
|
|
}
|
|
|
|
|