LXR linux/drivers/net/wireless/mediatek/mt7601u/util.c

   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}
  43