[linux-2.6-block.git] / net / mac802154 / util.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 *
 * Authors:
 * Alexander Aring <aar@pengutronix.de>
 *
 * Based on: net/mac80211/util.c
 */

#include "ieee802154_i.h"
#include "driver-ops.h"

/* privid for wpan_phys to determine whether they belong to us or not */
const void *const mac802154_wpan_phy_privid = &mac802154_wpan_phy_privid;

void ieee802154_wake_queue(struct ieee802154_hw *hw)
{
	struct ieee802154_local *local = hw_to_local(hw);
	struct ieee802154_sub_if_data *sdata;

	rcu_read_lock();
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
		if (!sdata->dev)
			continue;

		netif_wake_queue(sdata->dev);
	}
	rcu_read_unlock();
}
EXPORT_SYMBOL(ieee802154_wake_queue);

void ieee802154_stop_queue(struct ieee802154_hw *hw)
{
	struct ieee802154_local *local = hw_to_local(hw);
	struct ieee802154_sub_if_data *sdata;

	rcu_read_lock();
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
		if (!sdata->dev)
			continue;

		netif_stop_queue(sdata->dev);
	}
	rcu_read_unlock();
}
EXPORT_SYMBOL(ieee802154_stop_queue);

enum hrtimer_restart ieee802154_xmit_ifs_timer(struct hrtimer *timer)
{
	struct ieee802154_local *local =
		container_of(timer, struct ieee802154_local, ifs_timer);

	ieee802154_wake_queue(&local->hw);

	return HRTIMER_NORESTART;
}

void ieee802154_xmit_complete(struct ieee802154_hw *hw, struct sk_buff *skb,
			      bool ifs_handling)
{
	if (ifs_handling) {
		struct ieee802154_local *local = hw_to_local(hw);
		u8 max_sifs_size;

		/* If transceiver sets CRC on his own we need to use lifs
		 * threshold len above 16 otherwise 18, because it's not
		 * part of skb->len.
		 */
		if (hw->flags & IEEE802154_HW_TX_OMIT_CKSUM)
			max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE -
					IEEE802154_FCS_LEN;
		else
			max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE;

		if (skb->len > max_sifs_size)
			hrtimer_start(&local->ifs_timer,
				      hw->phy->lifs_period * NSEC_PER_USEC,
				      HRTIMER_MODE_REL);
		else
			hrtimer_start(&local->ifs_timer,
				      hw->phy->sifs_period * NSEC_PER_USEC,
				      HRTIMER_MODE_REL);
	} else {
		ieee802154_wake_queue(hw);
	}

	dev_consume_skb_any(skb);
}
EXPORT_SYMBOL(ieee802154_xmit_complete);

void ieee802154_stop_device(struct ieee802154_local *local)
{
	flush_workqueue(local->workqueue);
	hrtimer_cancel(&local->ifs_timer);
	drv_stop(local);
}
Commit	Line	Data
1802d0be TG	1	// SPDX-License-Identifier: GPL-2.0-only
1802d0be TG	2	/*
c2085103 AA	3	*
	4	* Authors:
	5	* Alexander Aring <aar@pengutronix.de>
	6	*
	7	* Based on: net/mac80211/util.c
	8	*/
	9
	10	#include "ieee802154_i.h"
c4227c8a	11	#include "driver-ops.h"
c2085103	12
6322d50d AA	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
c2085103 AA	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
61f2dcba	48	enum hrtimer_restart ieee802154_xmit_ifs_timer(struct hrtimer *timer)
c2085103	49	{
61f2dcba AA	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);
3f3c4bb5	63	u8 max_sifs_size;
61f2dcba	64
3f3c4bb5 AA	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)
61f2dcba	76	hrtimer_start(&local->ifs_timer,
8b0e1953	77	hw->phy->lifs_period * NSEC_PER_USEC,
61f2dcba AA	78	HRTIMER_MODE_REL);
	79	else
	80	hrtimer_start(&local->ifs_timer,
8b0e1953	81	hw->phy->sifs_period * NSEC_PER_USEC,
61f2dcba	82	HRTIMER_MODE_REL);
61f2dcba AA	83	} else {
61f2dcba AA	84	ieee802154_wake_queue(hw);
61f2dcba	85	}
3862eba6 AA	86
3862eba6 AA	87	dev_consume_skb_any(skb);
c2085103 AA	88	}
c2085103 AA	89	EXPORT_SYMBOL(ieee802154_xmit_complete);
c4227c8a AA	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	}