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
 8void 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
16int 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}

 
 1/*
 2 * Copyright (C) 2014 Felix Fietkau <nbd@openwrt.org>
 3 *
 4 * This program is free software; you can redistribute it and/or modify
 5 * it under the terms of the GNU General Public License version 2
 6 * as published by the Free Software Foundation
 7 *
 8 * This program is distributed in the hope that it will be useful,
 9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
11 * GNU General Public License for more details.
12 */
13
14#include "mt7601u.h"
15
16void mt76_remove_hdr_pad(struct sk_buff *skb)
17{
18	int len = ieee80211_get_hdrlen_from_skb(skb);
19
20	memmove(skb->data + 2, skb->data, len);
21	skb_pull(skb, 2);
22}
23
24int mt76_insert_hdr_pad(struct sk_buff *skb)
25{
26	int len = ieee80211_get_hdrlen_from_skb(skb);
27	int ret;
28
29	if (len % 4 == 0)
30		return 0;
31
32	ret = skb_cow(skb, 2);
33	if (ret)
34		return ret;
35
36	skb_push(skb, 2);
37	memmove(skb->data, skb->data + 2, len);
38
39	skb->data[len] = 0;
40	skb->data[len + 1] = 0;
41	return 0;
42}