Commit dc437974 authored by Jiri Pirko's avatar Jiri Pirko Committed by David S. Miller

atl2: do vlan cleanup

- unify vlan and nonvlan rx path
- kill adapter->vlgrp and atl2_vlan_rx_register
- allow to turn on/off rx/tx vlan accel via ethtool (set_features)
Signed-off-by: default avatarJiri Pirko <jpirko@redhat.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 92491709
...@@ -361,36 +361,59 @@ static inline void atl2_irq_disable(struct atl2_adapter *adapter) ...@@ -361,36 +361,59 @@ static inline void atl2_irq_disable(struct atl2_adapter *adapter)
synchronize_irq(adapter->pdev->irq); synchronize_irq(adapter->pdev->irq);
} }
#ifdef NETIF_F_HW_VLAN_TX static void __atl2_vlan_mode(u32 features, u32 *ctrl)
static void atl2_vlan_rx_register(struct net_device *netdev, {
struct vlan_group *grp) if (features & NETIF_F_HW_VLAN_RX) {
/* enable VLAN tag insert/strip */
*ctrl |= MAC_CTRL_RMV_VLAN;
} else {
/* disable VLAN tag insert/strip */
*ctrl &= ~MAC_CTRL_RMV_VLAN;
}
}
static void atl2_vlan_mode(struct net_device *netdev, u32 features)
{ {
struct atl2_adapter *adapter = netdev_priv(netdev); struct atl2_adapter *adapter = netdev_priv(netdev);
u32 ctrl; u32 ctrl;
atl2_irq_disable(adapter); atl2_irq_disable(adapter);
adapter->vlgrp = grp;
if (grp) { ctrl = ATL2_READ_REG(&adapter->hw, REG_MAC_CTRL);
/* enable VLAN tag insert/strip */ __atl2_vlan_mode(features, &ctrl);
ctrl = ATL2_READ_REG(&adapter->hw, REG_MAC_CTRL); ATL2_WRITE_REG(&adapter->hw, REG_MAC_CTRL, ctrl);
ctrl |= MAC_CTRL_RMV_VLAN;
ATL2_WRITE_REG(&adapter->hw, REG_MAC_CTRL, ctrl);
} else {
/* disable VLAN tag insert/strip */
ctrl = ATL2_READ_REG(&adapter->hw, REG_MAC_CTRL);
ctrl &= ~MAC_CTRL_RMV_VLAN;
ATL2_WRITE_REG(&adapter->hw, REG_MAC_CTRL, ctrl);
}
atl2_irq_enable(adapter); atl2_irq_enable(adapter);
} }
static void atl2_restore_vlan(struct atl2_adapter *adapter) static void atl2_restore_vlan(struct atl2_adapter *adapter)
{ {
atl2_vlan_rx_register(adapter->netdev, adapter->vlgrp); atl2_vlan_mode(adapter->netdev, adapter->netdev->features);
}
static u32 atl2_fix_features(struct net_device *netdev, u32 features)
{
/*
* Since there is no support for separate rx/tx vlan accel
* enable/disable make sure tx flag is always in same state as rx.
*/
if (features & NETIF_F_HW_VLAN_RX)
features |= NETIF_F_HW_VLAN_TX;
else
features &= ~NETIF_F_HW_VLAN_TX;
return features;
}
static int atl2_set_features(struct net_device *netdev, u32 features)
{
u32 changed = netdev->features ^ features;
if (changed & NETIF_F_HW_VLAN_RX)
atl2_vlan_mode(netdev, features);
return 0;
} }
#endif
static void atl2_intr_rx(struct atl2_adapter *adapter) static void atl2_intr_rx(struct atl2_adapter *adapter)
{ {
...@@ -424,14 +447,13 @@ static void atl2_intr_rx(struct atl2_adapter *adapter) ...@@ -424,14 +447,13 @@ static void atl2_intr_rx(struct atl2_adapter *adapter)
memcpy(skb->data, rxd->packet, rx_size); memcpy(skb->data, rxd->packet, rx_size);
skb_put(skb, rx_size); skb_put(skb, rx_size);
skb->protocol = eth_type_trans(skb, netdev); skb->protocol = eth_type_trans(skb, netdev);
#ifdef NETIF_F_HW_VLAN_TX if (rxd->status.vlan) {
if (adapter->vlgrp && (rxd->status.vlan)) {
u16 vlan_tag = (rxd->status.vtag>>4) | u16 vlan_tag = (rxd->status.vtag>>4) |
((rxd->status.vtag&7) << 13) | ((rxd->status.vtag&7) << 13) |
((rxd->status.vtag&8) << 9); ((rxd->status.vtag&8) << 9);
vlan_hwaccel_rx(skb, adapter->vlgrp, vlan_tag);
} else __vlan_hwaccel_put_tag(skb, vlan_tag);
#endif }
netif_rx(skb); netif_rx(skb);
netdev->stats.rx_bytes += rx_size; netdev->stats.rx_bytes += rx_size;
netdev->stats.rx_packets++; netdev->stats.rx_packets++;
...@@ -704,9 +726,7 @@ static int atl2_open(struct net_device *netdev) ...@@ -704,9 +726,7 @@ static int atl2_open(struct net_device *netdev)
atl2_set_multi(netdev); atl2_set_multi(netdev);
init_ring_ptrs(adapter); init_ring_ptrs(adapter);
#ifdef NETIF_F_HW_VLAN_TX
atl2_restore_vlan(adapter); atl2_restore_vlan(adapter);
#endif
if (atl2_configure(adapter)) { if (atl2_configure(adapter)) {
err = -EIO; err = -EIO;
...@@ -1082,9 +1102,7 @@ static int atl2_up(struct atl2_adapter *adapter) ...@@ -1082,9 +1102,7 @@ static int atl2_up(struct atl2_adapter *adapter)
atl2_set_multi(netdev); atl2_set_multi(netdev);
init_ring_ptrs(adapter); init_ring_ptrs(adapter);
#ifdef NETIF_F_HW_VLAN_TX
atl2_restore_vlan(adapter); atl2_restore_vlan(adapter);
#endif
if (atl2_configure(adapter)) { if (atl2_configure(adapter)) {
err = -EIO; err = -EIO;
...@@ -1145,8 +1163,7 @@ static void atl2_setup_mac_ctrl(struct atl2_adapter *adapter) ...@@ -1145,8 +1163,7 @@ static void atl2_setup_mac_ctrl(struct atl2_adapter *adapter)
MAC_CTRL_PRMLEN_SHIFT); MAC_CTRL_PRMLEN_SHIFT);
/* vlan */ /* vlan */
if (adapter->vlgrp) __atl2_vlan_mode(netdev->features, &value);
value |= MAC_CTRL_RMV_VLAN;
/* filter mode */ /* filter mode */
value |= MAC_CTRL_BC_EN; value |= MAC_CTRL_BC_EN;
...@@ -1312,9 +1329,10 @@ static const struct net_device_ops atl2_netdev_ops = { ...@@ -1312,9 +1329,10 @@ static const struct net_device_ops atl2_netdev_ops = {
.ndo_validate_addr = eth_validate_addr, .ndo_validate_addr = eth_validate_addr,
.ndo_set_mac_address = atl2_set_mac, .ndo_set_mac_address = atl2_set_mac,
.ndo_change_mtu = atl2_change_mtu, .ndo_change_mtu = atl2_change_mtu,
.ndo_fix_features = atl2_fix_features,
.ndo_set_features = atl2_set_features,
.ndo_do_ioctl = atl2_ioctl, .ndo_do_ioctl = atl2_ioctl,
.ndo_tx_timeout = atl2_tx_timeout, .ndo_tx_timeout = atl2_tx_timeout,
.ndo_vlan_rx_register = atl2_vlan_rx_register,
#ifdef CONFIG_NET_POLL_CONTROLLER #ifdef CONFIG_NET_POLL_CONTROLLER
.ndo_poll_controller = atl2_poll_controller, .ndo_poll_controller = atl2_poll_controller,
#endif #endif
...@@ -1410,7 +1428,7 @@ static int __devinit atl2_probe(struct pci_dev *pdev, ...@@ -1410,7 +1428,7 @@ static int __devinit atl2_probe(struct pci_dev *pdev,
err = -EIO; err = -EIO;
netdev->hw_features = NETIF_F_SG; netdev->hw_features = NETIF_F_SG | NETIF_F_HW_VLAN_RX;
netdev->features |= (NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX); netdev->features |= (NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX);
/* Init PHY as early as possible due to power saving issue */ /* Init PHY as early as possible due to power saving issue */
......
...@@ -453,9 +453,6 @@ struct atl2_adapter { ...@@ -453,9 +453,6 @@ struct atl2_adapter {
/* OS defined structs */ /* OS defined structs */
struct net_device *netdev; struct net_device *netdev;
struct pci_dev *pdev; struct pci_dev *pdev;
#ifdef NETIF_F_HW_VLAN_TX
struct vlan_group *vlgrp;
#endif
u32 wol; u32 wol;
u16 link_speed; u16 link_speed;
u16 link_duplex; u16 link_duplex;
......
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