VLAN does not work with niu driver

index f9364d0..9559e42 100644
@@ -3480,6 +3480,7 @@ static int niu_process_rx_pkt(struct napi_struct *napi, struct niu *np,
       unsigned int index = rp->rcr_index;
       struct sk_buff *skb;
       int len, num_rcr;
+       struct vlan_ethhdr *veth;
 
       skb = netdev_alloc_skb(np->dev, RX_SKB_ALLOC_SIZE);
       if (unlikely(!skb))

@@ -3545,7 +3546,15 @@ static int niu_process_rx_pkt(struct napi_struct *napi, struct niu *np,
       rp->rcr_index = index;
 
       skb_reserve(skb, NET_IP_ALIGN);
-       __pskb_pull_tail(skb, min(len, NIU_RXPULL_MAX));
+       __pskb_pull_tail(skb, min(len, VLAN_ETH_HLEN));
+
+       veth = (struct vlan_ethhdr *)skb->data;
+       if (veth->h_vlan_proto != __constant_htons(ETH_P_8021Q)) {
+               skb->tail -= 4;
+               skb->data_len += 4;
+               skb_shinfo(skb)->frags[0].page_offset -= 4;
+               skb_shinfo(skb)->frags[0].size += 4;
+       }
 
       rp->rx_packets++;
       rp->rx_bytes += skb->len;