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