Commit 44e50ddb authored by Andrew Lunn's avatar Andrew Lunn Committed by David S. Miller

net: dsa: Consistently set and use ps->num_ports

As a step towards consolidating code, consistently set the
number of ports in the private state structure, and make use of it in
loops.
Signed-off-by: default avatarAndrew Lunn <andrew@lunn.ch>
Tested-by: default avatarGuenter Roeck <linux@roeck-us.net>
Reviewed-by: default avatarGuenter Roeck <linux@roeck-us.net>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 14ef6ad2
...@@ -38,12 +38,13 @@ static char *mv88e6171_probe(struct device *host_dev, int sw_addr) ...@@ -38,12 +38,13 @@ static char *mv88e6171_probe(struct device *host_dev, int sw_addr)
static int mv88e6171_switch_reset(struct dsa_switch *ds) static int mv88e6171_switch_reset(struct dsa_switch *ds)
{ {
struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
int i; int i;
int ret; int ret;
unsigned long timeout; unsigned long timeout;
/* Set all ports to the disabled state. */ /* Set all ports to the disabled state. */
for (i = 0; i < 8; i++) { for (i = 0; i < ps->num_ports; i++) {
ret = REG_READ(REG_PORT(i), 0x04); ret = REG_READ(REG_PORT(i), 0x04);
REG_WRITE(REG_PORT(i), 0x04, ret & 0xfffc); REG_WRITE(REG_PORT(i), 0x04, ret & 0xfffc);
} }
...@@ -70,7 +71,7 @@ static int mv88e6171_switch_reset(struct dsa_switch *ds) ...@@ -70,7 +71,7 @@ static int mv88e6171_switch_reset(struct dsa_switch *ds)
return -ETIMEDOUT; return -ETIMEDOUT;
/* Enable ports not under DSA, e.g. WAN port */ /* Enable ports not under DSA, e.g. WAN port */
for (i = 0; i < 8; i++) { for (i = 0; i < ps->num_ports; i++) {
if (dsa_is_cpu_port(ds, i) || ds->phys_port_mask & (1 << i)) if (dsa_is_cpu_port(ds, i) || ds->phys_port_mask & (1 << i))
continue; continue;
...@@ -83,6 +84,7 @@ static int mv88e6171_switch_reset(struct dsa_switch *ds) ...@@ -83,6 +84,7 @@ static int mv88e6171_switch_reset(struct dsa_switch *ds)
static int mv88e6171_setup_global(struct dsa_switch *ds) static int mv88e6171_setup_global(struct dsa_switch *ds)
{ {
struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
int ret; int ret;
int i; int i;
...@@ -147,7 +149,7 @@ static int mv88e6171_setup_global(struct dsa_switch *ds) ...@@ -147,7 +149,7 @@ static int mv88e6171_setup_global(struct dsa_switch *ds)
} }
/* Clear all trunk masks. */ /* Clear all trunk masks. */
for (i = 0; i < 8; i++) for (i = 0; i < ps->num_ports; i++)
REG_WRITE(REG_GLOBAL2, 0x07, 0x8000 | (i << 12) | 0xff); REG_WRITE(REG_GLOBAL2, 0x07, 0x8000 | (i << 12) | 0xff);
/* Clear all trunk mappings. */ /* Clear all trunk mappings. */
...@@ -270,6 +272,7 @@ static int mv88e6171_setup_port(struct dsa_switch *ds, int p) ...@@ -270,6 +272,7 @@ static int mv88e6171_setup_port(struct dsa_switch *ds, int p)
static int mv88e6171_setup(struct dsa_switch *ds) static int mv88e6171_setup(struct dsa_switch *ds)
{ {
struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
int i; int i;
int ret; int ret;
...@@ -277,6 +280,8 @@ static int mv88e6171_setup(struct dsa_switch *ds) ...@@ -277,6 +280,8 @@ static int mv88e6171_setup(struct dsa_switch *ds)
if (ret < 0) if (ret < 0)
return ret; return ret;
ps->num_ports = 7;
ret = mv88e6171_switch_reset(ds); ret = mv88e6171_switch_reset(ds);
if (ret < 0) if (ret < 0)
return ret; return ret;
...@@ -287,7 +292,7 @@ static int mv88e6171_setup(struct dsa_switch *ds) ...@@ -287,7 +292,7 @@ static int mv88e6171_setup(struct dsa_switch *ds)
if (ret < 0) if (ret < 0)
return ret; return ret;
for (i = 0; i < 8; i++) { for (i = 0; i < ps->num_ports; i++) {
if (!(dsa_is_cpu_port(ds, i) || ds->phys_port_mask & (1 << i))) if (!(dsa_is_cpu_port(ds, i) || ds->phys_port_mask & (1 << i)))
continue; continue;
...@@ -299,9 +304,11 @@ static int mv88e6171_setup(struct dsa_switch *ds) ...@@ -299,9 +304,11 @@ static int mv88e6171_setup(struct dsa_switch *ds)
return 0; return 0;
} }
static int mv88e6171_port_to_phy_addr(int port) static int mv88e6171_port_to_phy_addr(struct dsa_switch *ds, int port)
{ {
if (port >= 0 && port <= 4) struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
if (port >= 0 && port < ps->num_ports)
return port; return port;
return -1; return -1;
} }
...@@ -310,7 +317,7 @@ static int ...@@ -310,7 +317,7 @@ static int
mv88e6171_phy_read(struct dsa_switch *ds, int port, int regnum) mv88e6171_phy_read(struct dsa_switch *ds, int port, int regnum)
{ {
struct mv88e6xxx_priv_state *ps = ds_to_priv(ds); struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
int addr = mv88e6171_port_to_phy_addr(port); int addr = mv88e6171_port_to_phy_addr(ds, port);
int ret; int ret;
mutex_lock(&ps->phy_mutex); mutex_lock(&ps->phy_mutex);
...@@ -324,7 +331,7 @@ mv88e6171_phy_write(struct dsa_switch *ds, ...@@ -324,7 +331,7 @@ mv88e6171_phy_write(struct dsa_switch *ds,
int port, int regnum, u16 val) int port, int regnum, u16 val)
{ {
struct mv88e6xxx_priv_state *ps = ds_to_priv(ds); struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
int addr = mv88e6171_port_to_phy_addr(port); int addr = mv88e6171_port_to_phy_addr(ds, port);
int ret; int ret;
mutex_lock(&ps->phy_mutex); mutex_lock(&ps->phy_mutex);
......
...@@ -47,12 +47,13 @@ static char *mv88e6352_probe(struct device *host_dev, int sw_addr) ...@@ -47,12 +47,13 @@ static char *mv88e6352_probe(struct device *host_dev, int sw_addr)
static int mv88e6352_switch_reset(struct dsa_switch *ds) static int mv88e6352_switch_reset(struct dsa_switch *ds)
{ {
struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
unsigned long timeout; unsigned long timeout;
int ret; int ret;
int i; int i;
/* Set all ports to the disabled state. */ /* Set all ports to the disabled state. */
for (i = 0; i < 7; i++) { for (i = 0; i < ps->num_ports; i++) {
ret = REG_READ(REG_PORT(i), 0x04); ret = REG_READ(REG_PORT(i), 0x04);
REG_WRITE(REG_PORT(i), 0x04, ret & 0xfffc); REG_WRITE(REG_PORT(i), 0x04, ret & 0xfffc);
} }
...@@ -82,6 +83,7 @@ static int mv88e6352_switch_reset(struct dsa_switch *ds) ...@@ -82,6 +83,7 @@ static int mv88e6352_switch_reset(struct dsa_switch *ds)
static int mv88e6352_setup_global(struct dsa_switch *ds) static int mv88e6352_setup_global(struct dsa_switch *ds)
{ {
struct mv88e6xxx_priv_state *ps = ds_to_priv(ds);
int ret; int ret;
int i; int i;
...@@ -152,7 +154,7 @@ static int mv88e6352_setup_global(struct dsa_switch *ds) ...@@ -152,7 +154,7 @@ static int mv88e6352_setup_global(struct dsa_switch *ds)
/* Disable ingress rate limiting by resetting all ingress /* Disable ingress rate limiting by resetting all ingress
* rate limit registers to their initial state. * rate limit registers to their initial state.
*/ */
for (i = 0; i < 7; i++) for (i = 0; i < ps->num_ports; i++)
REG_WRITE(REG_GLOBAL2, 0x09, 0x9000 | (i << 8)); REG_WRITE(REG_GLOBAL2, 0x09, 0x9000 | (i << 8));
/* Initialise cross-chip port VLAN table to reset defaults. */ /* Initialise cross-chip port VLAN table to reset defaults. */
...@@ -367,6 +369,8 @@ static int mv88e6352_setup(struct dsa_switch *ds) ...@@ -367,6 +369,8 @@ static int mv88e6352_setup(struct dsa_switch *ds)
if (ret < 0) if (ret < 0)
return ret; return ret;
ps->num_ports = 7;
mutex_init(&ps->eeprom_mutex); mutex_init(&ps->eeprom_mutex);
ret = mv88e6352_switch_reset(ds); ret = mv88e6352_switch_reset(ds);
...@@ -379,7 +383,7 @@ static int mv88e6352_setup(struct dsa_switch *ds) ...@@ -379,7 +383,7 @@ static int mv88e6352_setup(struct dsa_switch *ds)
if (ret < 0) if (ret < 0)
return ret; return ret;
for (i = 0; i < 7; i++) { for (i = 0; i < ps->num_ports; i++) {
ret = mv88e6352_setup_port(ds, i); ret = mv88e6352_setup_port(ds, i);
if (ret < 0) if (ret < 0)
return ret; return ret;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment