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 */
  14 const void *const mac802154_wpan_phy_privid = &mac802154_wpan_phy_privid;
  15
  16 void 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 }
  30 EXPORT_SYMBOL(ieee802154_wake_queue);
  31
  32 void 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 }
  46 EXPORT_SYMBOL(ieee802154_stop_queue);
  47
  48 enum 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
  58 void 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 }
  89 EXPORT_SYMBOL(ieee802154_xmit_complete);
  90
  91 void ieee802154_stop_device(struct ieee802154_local *local)
  92 {
  93         flush_workqueue(local->workqueue);
  94         hrtimer_cancel(&local->ifs_timer);
  95         drv_stop(local);
  96 }