return rtl_rmw(dev, r->page, r->phy, r->reg, mask, val);
}
-static void
-rtl_fix_pvids(struct switch_dev *dev)
-{
- unsigned int port, vlan, mask;
-
- for (port = 0; port < RTL8306_NUM_PORTS; port++)
- {
- /* skip tagged ports */
- if (rtl_get(dev, RTL_PORT_REG(port, TAG_INSERT)) != 1)
- continue;
-
- for (vlan = 0; vlan < RTL8306_NUM_VLANS; vlan++)
- {
- mask = rtl_get(dev, RTL_VLAN_REG(vlan, PORTMASK));
- /* skip non-members */
- if (!(mask & (1 << port)))
- continue;
-
- rtl_set(dev, RTL_PORT_REG(port, PVID), vlan);
- /* next port */
- break;
- }
- }
-}
-
static void
rtl_phy_save(struct switch_dev *dev, int port, struct rtl_phyregs *regs)
{
rtl_hw_init(struct switch_dev *dev)
{
struct rtl_priv *priv = to_rtl(dev);
+ int cpu_mask = 1 << dev->cpu_port;
int i;
rtl_set(dev, RTL_REG_VLAN_ENABLE, 0);
rtl_set(dev, RTL_VLAN_REG(i, PORTMASK), 0);
}
-#ifdef DEBUG
/* default to port isolation */
for (i = 0; i < RTL8306_NUM_PORTS; i++) {
- if (i != dev->cpu_port)
- rtl_set(dev, RTL_VLAN_REG(i, PORTMASK), (1 << dev->cpu_port) | (1 << i));
+ unsigned long mask;
+
+ if ((1 << i) == cpu_mask)
+ mask = ((1 << RTL8306_NUM_PORTS) - 1) & ~cpu_mask; /* all bits set */
+ else
+ mask = cpu_mask | (1 << i);
+
+ rtl_set(dev, RTL_VLAN_REG(i, PORTMASK), mask);
rtl_set(dev, RTL_PORT_REG(i, PVID), i);
rtl_set(dev, RTL_PORT_REG(i, NULL_VID_REPLACE), 1);
rtl_set(dev, RTL_PORT_REG(i, VID_INSERT), 1);
rtl_set(dev, RTL_PORT_REG(i, TAG_INSERT), 3);
}
-#endif
- rtl_fix_pvids(dev);
-
rtl_hw_apply(dev);
}
return 0;
}
-#ifdef DEBUG
static int
rtl_attr_set_port_int(struct switch_dev *dev, const struct switch_attr *attr, struct switch_val *val)
{
return -EINVAL;
return rtl_attr_get_int(dev, attr, val);
}
-#endif
-
-static int
-rtl_attr_set_port_pvid(struct switch_dev *dev, const struct switch_attr *attr, struct switch_val *val)
-{
- unsigned int vlan;
-
- if (val->port_vlan >= RTL8306_NUM_PORTS)
- return -EINVAL;
-
- for (vlan = 0; vlan < RTL8306_NUM_VLANS; vlan++) {
- if (rtl_get(dev, RTL_VLAN_REG(vlan, VID)) == val->value.i) {
- rtl_set(dev, RTL_PORT_REG(val->port_vlan, PVID), vlan);
- break;
- }
- }
-
- return 0;
-}
-
-static int
-rtl_attr_get_port_pvid(struct switch_dev *dev, const struct switch_attr *attr, struct switch_val *val)
-{
- unsigned int vlan;
-
- if (val->port_vlan >= RTL8306_NUM_PORTS)
- return -EINVAL;
-
- vlan = rtl_get(dev, RTL_PORT_REG(val->port_vlan, PVID));
- val->value.i = rtl_get(dev, RTL_VLAN_REG(vlan, VID));
-
- return 0;
-}
static int
rtl_get_port_link(struct switch_dev *dev, int port, struct switch_port_link *link)
port = &val->value.ports[val->len];
port->id = i;
- if (rtl_get(dev, RTL_PORT_REG(i, TAG_INSERT)) == 2)
+ if (rtl_get(dev, RTL_PORT_REG(i, TAG_INSERT)) == 2 || i == dev->cpu_port)
port->flags = (1 << SWITCH_PORT_FLAG_TAGGED);
val->len++;
}
if (i > 3)
rtl_phy_save(dev, val->port_vlan, &port);
rtl_set(dev, RTL_PORT_REG(i, NULL_VID_REPLACE), 1);
- rtl_set(dev, RTL_PORT_REG(i, VID_INSERT), 1);
- rtl_set(dev, RTL_PORT_REG(i, TAG_INSERT), (en ? 1 : 3));
+ rtl_set(dev, RTL_PORT_REG(i, VID_INSERT), (en ? (i == dev->cpu_port ? 0 : 1) : 1));
+ rtl_set(dev, RTL_PORT_REG(i, TAG_INSERT), (en ? (i == dev->cpu_port ? 2 : 1) : 3));
if (i > 3)
rtl_phy_restore(dev, val->port_vlan, &port);
}
rtl_set(dev, RTL_REG_VLAN_ENABLE, en);
- rtl_fix_pvids(dev);
-
return 0;
}
rtl_set_ports(struct switch_dev *dev, struct switch_val *val)
{
unsigned int mask = 0;
+ unsigned int oldmask;
int i;
for(i = 0; i < val->len; i++)
mask |= (1 << port->id);
- if (port->flags & (1 << SWITCH_PORT_FLAG_TAGGED))
+ if (port->id == dev->cpu_port)
+ continue;
+
+ if ((i == dev->cpu_port) ||
+ (port->flags & (1 << SWITCH_PORT_FLAG_TAGGED)))
tagged = true;
+ /* fix up PVIDs for added ports */
+ if (!tagged)
+ rtl_set(dev, RTL_PORT_REG(port->id, PVID), val->port_vlan);
+
rtl_set(dev, RTL_PORT_REG(port->id, NON_PVID_DISCARD), (tagged ? 0 : 1));
rtl_set(dev, RTL_PORT_REG(port->id, VID_INSERT), (tagged ? 0 : 1));
rtl_set(dev, RTL_PORT_REG(port->id, TAG_INSERT), (tagged ? 2 : 1));
}
+ oldmask = rtl_get(dev, RTL_VLAN_REG(val->port_vlan, PORTMASK));
rtl_set(dev, RTL_VLAN_REG(val->port_vlan, PORTMASK), mask);
- rtl_fix_pvids(dev);
+ /* fix up PVIDs for removed ports, default to last vlan */
+ oldmask &= ~mask;
+ for (i = 0; i < RTL8306_NUM_PORTS; i++) {
+ if (!(oldmask & (1 << i)))
+ continue;
+
+ if (i == dev->cpu_port)
+ continue;
+
+ if (rtl_get(dev, RTL_PORT_REG(i, PVID)) == val->port_vlan)
+ rtl_set(dev, RTL_PORT_REG(i, PVID), dev->vlans - 1);
+ }
return 0;
}
};
static struct switch_attr rtl_port[] = {
{
- .type = SWITCH_TYPE_INT,
- .set = rtl_attr_set_port_pvid,
- .get = rtl_attr_get_port_pvid,
+ RTL_PORT_REGATTR(PVID),
.name = "pvid",
.description = "Port VLAN ID",
- .max = 4095,
+ .max = RTL8306_NUM_VLANS - 1,
},
#ifdef DEBUG
{