1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only 2*4882a593Smuzhiyun /* 3*4882a593Smuzhiyun * Copyright (C) 2014 Felix Fietkau <nbd@openwrt.org> 4*4882a593Smuzhiyun */ 5*4882a593Smuzhiyun 6*4882a593Smuzhiyun #include "mt7601u.h" 7*4882a593Smuzhiyun mt76_remove_hdr_pad(struct sk_buff * skb)8*4882a593Smuzhiyunvoid mt76_remove_hdr_pad(struct sk_buff *skb) 9*4882a593Smuzhiyun { 10*4882a593Smuzhiyun int len = ieee80211_get_hdrlen_from_skb(skb); 11*4882a593Smuzhiyun 12*4882a593Smuzhiyun memmove(skb->data + 2, skb->data, len); 13*4882a593Smuzhiyun skb_pull(skb, 2); 14*4882a593Smuzhiyun } 15*4882a593Smuzhiyun mt76_insert_hdr_pad(struct sk_buff * skb)16*4882a593Smuzhiyunint mt76_insert_hdr_pad(struct sk_buff *skb) 17*4882a593Smuzhiyun { 18*4882a593Smuzhiyun int len = ieee80211_get_hdrlen_from_skb(skb); 19*4882a593Smuzhiyun int ret; 20*4882a593Smuzhiyun 21*4882a593Smuzhiyun if (len % 4 == 0) 22*4882a593Smuzhiyun return 0; 23*4882a593Smuzhiyun 24*4882a593Smuzhiyun ret = skb_cow(skb, 2); 25*4882a593Smuzhiyun if (ret) 26*4882a593Smuzhiyun return ret; 27*4882a593Smuzhiyun 28*4882a593Smuzhiyun skb_push(skb, 2); 29*4882a593Smuzhiyun memmove(skb->data, skb->data + 2, len); 30*4882a593Smuzhiyun 31*4882a593Smuzhiyun skb->data[len] = 0; 32*4882a593Smuzhiyun skb->data[len + 1] = 0; 33*4882a593Smuzhiyun return 0; 34*4882a593Smuzhiyun } 35