ar71xx: fix broken LAN ports on the boards with AR8216 switch (closes #7024)

[openwrt/staging/yousong.git] / target / linux / ar71xx / files / drivers / net / ag71xx / ag71xx_ar8216.c

diff --git a/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c
index 564fae7eb59fe78da858555bb86fde93fd9f5f47..7801b9f0ed8f240041a27abc8f868f961c48b533 100644 (file)
--- a/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c
+++ b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c
@@ -25,19 +25,21 @@ void ag71xx_add_ar8216_header(struct ag71xx *ag, struct sk_buff *skb)
        skb->data[1] = 0x80;
 }
 
-int ag71xx_remove_ar8216_header(struct ag71xx *ag,
-                               struct sk_buff *skb)
+int ag71xx_remove_ar8216_header(struct ag71xx *ag, struct sk_buff *skb,
+                               int pktlen)
 {
        u8 type;
 
        type = skb->data[1] & AR8216_PACKET_TYPE_MASK;
        switch (type) {
        case AR8216_PACKET_TYPE_NORMAL:
-               skb_pull(skb, AR8216_HEADER_LEN);
                break;
+
        default:
                return -EINVAL;
        }
 
+       skb_put(skb, pktlen);
+       skb_pull(skb, AR8216_HEADER_LEN);
        return 0;
 }