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         struct ieee802154_local *local = hw_to_local(hw);
  62
  63         local->tx_result = IEEE802154_SUCCESS;
  64
  65         if (ifs_handling) {
  66                 u8 max_sifs_size;
  67
  68                 /* If transceiver sets CRC on his own we need to use lifs
  69                  * threshold len above 16 otherwise 18, because it's not
  70                  * part of skb->len.
  71                  */
  72                 if (hw->flags & IEEE802154_HW_TX_OMIT_CKSUM)
  73                         max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE -
  74                                         IEEE802154_FCS_LEN;
  75                 else
  76                         max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE;
  77
  78                 if (skb->len > max_sifs_size)
  79                         hrtimer_start(&local->ifs_timer,
  80                                       hw->phy->lifs_period * NSEC_PER_USEC,
  81                                       HRTIMER_MODE_REL);
  82                 else
  83                         hrtimer_start(&local->ifs_timer,
  84                                       hw->phy->sifs_period * NSEC_PER_USEC,
  85                                       HRTIMER_MODE_REL);
  86         } else {
  87                 ieee802154_wake_queue(hw);
  88         }
  89
  90         dev_consume_skb_any(skb);
  91 }
  92 EXPORT_SYMBOL(ieee802154_xmit_complete);
  93
  94 void ieee802154_xmit_error(struct ieee802154_hw *hw, struct sk_buff *skb,
  95                            int reason)
  96 {
  97         struct ieee802154_local *local = hw_to_local(hw);
  98
  99         local->tx_result = reason;
 100         ieee802154_wake_queue(hw);
 101         dev_kfree_skb_any(skb);
 102 }
 103 EXPORT_SYMBOL(ieee802154_xmit_error);
 104
 105 void ieee802154_xmit_hw_error(struct ieee802154_hw *hw, struct sk_buff *skb)
 106 {
 107         ieee802154_xmit_error(hw, skb, IEEE802154_SYSTEM_ERROR);
 108 }
 109 EXPORT_SYMBOL(ieee802154_xmit_hw_error);
 110
 111 void ieee802154_stop_device(struct ieee802154_local *local)
 112 {
 113         flush_workqueue(local->workqueue);
 114         hrtimer_cancel(&local->ifs_timer);
 115         drv_stop(local);
 116 }