mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-12-25 18:58:58 +02:00
generic: rtl8366: add common rtl8366_sw_{get,set}_vlan_ports functions
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@22204 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
parent
dac77d22af
commit
8007d48891
@ -830,6 +830,57 @@ int rtl8366_sw_get_vlan_info(struct switch_dev *dev,
|
|||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_info);
|
EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_info);
|
||||||
|
|
||||||
|
int rtl8366_sw_get_vlan_ports(struct switch_dev *dev, struct switch_val *val)
|
||||||
|
{
|
||||||
|
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
||||||
|
struct switch_port *port;
|
||||||
|
struct rtl8366_vlan_4k vlan4k;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
if (!smi->ops->is_vlan_valid(smi, val->port_vlan))
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
smi->ops->get_vlan_4k(smi, val->port_vlan, &vlan4k);
|
||||||
|
|
||||||
|
port = &val->value.ports[0];
|
||||||
|
val->len = 0;
|
||||||
|
for (i = 0; i < smi->num_ports; i++) {
|
||||||
|
if (!(vlan4k.member & BIT(i)))
|
||||||
|
continue;
|
||||||
|
|
||||||
|
port->id = i;
|
||||||
|
port->flags = (vlan4k.untag & BIT(i)) ?
|
||||||
|
0 : BIT(SWITCH_PORT_FLAG_TAGGED);
|
||||||
|
val->len++;
|
||||||
|
port++;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_ports);
|
||||||
|
|
||||||
|
int rtl8366_sw_set_vlan_ports(struct switch_dev *dev, struct switch_val *val)
|
||||||
|
{
|
||||||
|
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
||||||
|
struct switch_port *port;
|
||||||
|
u32 member = 0;
|
||||||
|
u32 untag = 0;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
if (!smi->ops->is_vlan_valid(smi, val->port_vlan))
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
port = &val->value.ports[0];
|
||||||
|
for (i = 0; i < val->len; i++, port++) {
|
||||||
|
member |= BIT(port->id);
|
||||||
|
|
||||||
|
if (!(port->flags & BIT(SWITCH_PORT_FLAG_TAGGED)))
|
||||||
|
untag |= BIT(port->id);
|
||||||
|
}
|
||||||
|
|
||||||
|
return rtl8366_set_vlan(smi, val->port_vlan, member, untag, 0);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_ports);
|
||||||
|
|
||||||
struct rtl8366_smi *rtl8366_smi_alloc(struct device *parent)
|
struct rtl8366_smi *rtl8366_smi_alloc(struct device *parent)
|
||||||
{
|
{
|
||||||
struct rtl8366_smi *smi;
|
struct rtl8366_smi *smi;
|
||||||
|
@ -117,5 +117,7 @@ int rtl8366_sw_get_port_mib(struct switch_dev *dev,
|
|||||||
int rtl8366_sw_get_vlan_info(struct switch_dev *dev,
|
int rtl8366_sw_get_vlan_info(struct switch_dev *dev,
|
||||||
const struct switch_attr *attr,
|
const struct switch_attr *attr,
|
||||||
struct switch_val *val);
|
struct switch_val *val);
|
||||||
|
int rtl8366_sw_get_vlan_ports(struct switch_dev *dev, struct switch_val *val);
|
||||||
|
int rtl8366_sw_set_vlan_ports(struct switch_dev *dev, struct switch_val *val);
|
||||||
|
|
||||||
#endif /* _RTL8366_SMI_H */
|
#endif /* _RTL8366_SMI_H */
|
||||||
|
@ -759,57 +759,6 @@ static int rtl8366rb_sw_reset_port_mibs(struct switch_dev *dev,
|
|||||||
RTL8366RB_MIB_CTRL_PORT_RESET(val->port_vlan));
|
RTL8366RB_MIB_CTRL_PORT_RESET(val->port_vlan));
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rtl8366rb_sw_get_vlan_ports(struct switch_dev *dev,
|
|
||||||
struct switch_val *val)
|
|
||||||
{
|
|
||||||
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
|
||||||
struct switch_port *port;
|
|
||||||
struct rtl8366_vlan_4k vlan4k;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
if (!smi->ops->is_vlan_valid(smi, val->port_vlan))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
smi->ops->get_vlan_4k(smi, val->port_vlan, &vlan4k);
|
|
||||||
|
|
||||||
port = &val->value.ports[0];
|
|
||||||
val->len = 0;
|
|
||||||
for (i = 0; i < smi->num_ports; i++) {
|
|
||||||
if (!(vlan4k.member & BIT(i)))
|
|
||||||
continue;
|
|
||||||
|
|
||||||
port->id = i;
|
|
||||||
port->flags = (vlan4k.untag & BIT(i)) ?
|
|
||||||
0 : BIT(SWITCH_PORT_FLAG_TAGGED);
|
|
||||||
val->len++;
|
|
||||||
port++;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rtl8366rb_sw_set_vlan_ports(struct switch_dev *dev,
|
|
||||||
struct switch_val *val)
|
|
||||||
{
|
|
||||||
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
|
||||||
struct switch_port *port;
|
|
||||||
u32 member = 0;
|
|
||||||
u32 untag = 0;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
if (!smi->ops->is_vlan_valid(smi, val->port_vlan))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
port = &val->value.ports[0];
|
|
||||||
for (i = 0; i < val->len; i++, port++) {
|
|
||||||
member |= BIT(port->id);
|
|
||||||
|
|
||||||
if (!(port->flags & BIT(SWITCH_PORT_FLAG_TAGGED)))
|
|
||||||
untag |= BIT(port->id);
|
|
||||||
}
|
|
||||||
|
|
||||||
return rtl8366_set_vlan(smi, val->port_vlan, member, untag, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rtl8366rb_sw_reset_switch(struct switch_dev *dev)
|
static int rtl8366rb_sw_reset_switch(struct switch_dev *dev)
|
||||||
{
|
{
|
||||||
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
||||||
@ -919,8 +868,8 @@ static struct switch_dev rtl8366_switch_dev = {
|
|||||||
.n_attr = ARRAY_SIZE(rtl8366rb_vlan),
|
.n_attr = ARRAY_SIZE(rtl8366rb_vlan),
|
||||||
},
|
},
|
||||||
|
|
||||||
.get_vlan_ports = rtl8366rb_sw_get_vlan_ports,
|
.get_vlan_ports = rtl8366_sw_get_vlan_ports,
|
||||||
.set_vlan_ports = rtl8366rb_sw_set_vlan_ports,
|
.set_vlan_ports = rtl8366_sw_set_vlan_ports,
|
||||||
.get_port_pvid = rtl8366_sw_get_port_pvid,
|
.get_port_pvid = rtl8366_sw_get_port_pvid,
|
||||||
.set_port_pvid = rtl8366_sw_set_port_pvid,
|
.set_port_pvid = rtl8366_sw_set_port_pvid,
|
||||||
.reset_switch = rtl8366rb_sw_reset_switch,
|
.reset_switch = rtl8366rb_sw_reset_switch,
|
||||||
|
@ -786,57 +786,6 @@ static int rtl8366s_sw_reset_port_mibs(struct switch_dev *dev,
|
|||||||
0, (1 << (val->port_vlan + 3)));
|
0, (1 << (val->port_vlan + 3)));
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rtl8366s_sw_get_vlan_ports(struct switch_dev *dev,
|
|
||||||
struct switch_val *val)
|
|
||||||
{
|
|
||||||
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
|
||||||
struct switch_port *port;
|
|
||||||
struct rtl8366_vlan_4k vlan4k;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
if (!smi->ops->is_vlan_valid(smi, val->port_vlan))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
smi->ops->get_vlan_4k(smi, val->port_vlan, &vlan4k);
|
|
||||||
|
|
||||||
port = &val->value.ports[0];
|
|
||||||
val->len = 0;
|
|
||||||
for (i = 0; i < smi->num_ports; i++) {
|
|
||||||
if (!(vlan4k.member & BIT(i)))
|
|
||||||
continue;
|
|
||||||
|
|
||||||
port->id = i;
|
|
||||||
port->flags = (vlan4k.untag & BIT(i)) ?
|
|
||||||
0 : BIT(SWITCH_PORT_FLAG_TAGGED);
|
|
||||||
val->len++;
|
|
||||||
port++;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rtl8366s_sw_set_vlan_ports(struct switch_dev *dev,
|
|
||||||
struct switch_val *val)
|
|
||||||
{
|
|
||||||
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
|
||||||
struct switch_port *port;
|
|
||||||
u32 member = 0;
|
|
||||||
u32 untag = 0;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
if (!smi->ops->is_vlan_valid(smi, val->port_vlan))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
port = &val->value.ports[0];
|
|
||||||
for (i = 0; i < val->len; i++, port++) {
|
|
||||||
member |= BIT(port->id);
|
|
||||||
|
|
||||||
if (!(port->flags & BIT(SWITCH_PORT_FLAG_TAGGED)))
|
|
||||||
untag |= BIT(port->id);
|
|
||||||
}
|
|
||||||
|
|
||||||
return rtl8366_set_vlan(smi, val->port_vlan, member, untag, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rtl8366s_sw_reset_switch(struct switch_dev *dev)
|
static int rtl8366s_sw_reset_switch(struct switch_dev *dev)
|
||||||
{
|
{
|
||||||
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
|
||||||
@ -946,8 +895,8 @@ static struct switch_dev rtl8366_switch_dev = {
|
|||||||
.n_attr = ARRAY_SIZE(rtl8366s_vlan),
|
.n_attr = ARRAY_SIZE(rtl8366s_vlan),
|
||||||
},
|
},
|
||||||
|
|
||||||
.get_vlan_ports = rtl8366s_sw_get_vlan_ports,
|
.get_vlan_ports = rtl8366_sw_get_vlan_ports,
|
||||||
.set_vlan_ports = rtl8366s_sw_set_vlan_ports,
|
.set_vlan_ports = rtl8366_sw_set_vlan_ports,
|
||||||
.get_port_pvid = rtl8366_sw_get_port_pvid,
|
.get_port_pvid = rtl8366_sw_get_port_pvid,
|
||||||
.set_port_pvid = rtl8366_sw_set_port_pvid,
|
.set_port_pvid = rtl8366_sw_set_port_pvid,
|
||||||
.reset_switch = rtl8366s_sw_reset_switch,
|
.reset_switch = rtl8366s_sw_reset_switch,
|
||||||
|
Loading…
Reference in New Issue
Block a user