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}

 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}