LXR linux/net/mac802154/util.c

   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 *
   4 * Authors:
   5 * Alexander Aring <aar@pengutronix.de>
   6 *
   7 * Based on: net/mac80211/util.c
   8 */
   9
  10#include "ieee802154_i.h"
  11#include "driver-ops.h"
  12
  13/* privid for wpan_phys to determine whether they belong to us or not */
  14const void *const mac802154_wpan_phy_privid = &mac802154_wpan_phy_privid;
  15
  16void ieee802154_wake_queue(struct ieee802154_hw *hw)
  17{
  18        struct ieee802154_local *local = hw_to_local(hw);
  19        struct ieee802154_sub_if_data *sdata;
  20
  21        rcu_read_lock();
  22        list_for_each_entry_rcu(sdata, &local->interfaces, list) {
  23                if (!sdata->dev)
  24                        continue;
  25
  26                netif_wake_queue(sdata->dev);
  27        }
  28        rcu_read_unlock();
  29}
  30EXPORT_SYMBOL(ieee802154_wake_queue);
  31
  32void ieee802154_stop_queue(struct ieee802154_hw *hw)
  33{
  34        struct ieee802154_local *local = hw_to_local(hw);
  35        struct ieee802154_sub_if_data *sdata;
  36
  37        rcu_read_lock();
  38        list_for_each_entry_rcu(sdata, &local->interfaces, list) {
  39                if (!sdata->dev)
  40                        continue;
  41
  42                netif_stop_queue(sdata->dev);
  43        }
  44        rcu_read_unlock();
  45}
  46EXPORT_SYMBOL(ieee802154_stop_queue);
  47
  48enum hrtimer_restart ieee802154_xmit_ifs_timer(struct hrtimer *timer)
  49{
  50        struct ieee802154_local *local =
  51                container_of(timer, struct ieee802154_local, ifs_timer);
  52
  53        ieee802154_wake_queue(&local->hw);
  54
  55        return HRTIMER_NORESTART;
  56}
  57
  58void ieee802154_xmit_complete(struct ieee802154_hw *hw, struct sk_buff *skb,
  59                              bool ifs_handling)
  60{
  61        if (ifs_handling) {
  62                struct ieee802154_local *local = hw_to_local(hw);
  63                u8 max_sifs_size;
  64
  65                /* If transceiver sets CRC on his own we need to use lifs
  66                 * threshold len above 16 otherwise 18, because it's not
  67                 * part of skb->len.
  68                 */
  69                if (hw->flags & IEEE802154_HW_TX_OMIT_CKSUM)
  70                        max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE -
  71                                        IEEE802154_FCS_LEN;
  72                else
  73                        max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE;
  74
  75                if (skb->len > max_sifs_size)
  76                        hrtimer_start(&local->ifs_timer,
  77                                      hw->phy->lifs_period * NSEC_PER_USEC,
  78                                      HRTIMER_MODE_REL);
  79                else
  80                        hrtimer_start(&local->ifs_timer,
  81                                      hw->phy->sifs_period * NSEC_PER_USEC,
  82                                      HRTIMER_MODE_REL);
  83        } else {
  84                ieee802154_wake_queue(hw);
  85        }
  86
  87        dev_consume_skb_any(skb);
  88}
  89EXPORT_SYMBOL(ieee802154_xmit_complete);
  90
  91void ieee802154_stop_device(struct ieee802154_local *local)
  92{
  93        flush_workqueue(local->workqueue);
  94        hrtimer_cancel(&local->ifs_timer);
  95        drv_stop(local);
  96}
  97