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