]>
Commit | Line | Data |
---|---|---|
c2085103 AA |
1 | /* This program is free software; you can redistribute it and/or modify |
2 | * it under the terms of the GNU General Public License version 2 | |
3 | * as published by the Free Software Foundation. | |
4 | * | |
5 | * This program is distributed in the hope that it will be useful, | |
6 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
7 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
8 | * GNU General Public License for more details. | |
9 | * | |
10 | * Authors: | |
11 | * Alexander Aring <aar@pengutronix.de> | |
12 | * | |
13 | * Based on: net/mac80211/util.c | |
14 | */ | |
15 | ||
16 | #include "ieee802154_i.h" | |
c4227c8a | 17 | #include "driver-ops.h" |
c2085103 | 18 | |
6322d50d AA |
19 | /* privid for wpan_phys to determine whether they belong to us or not */ |
20 | const void *const mac802154_wpan_phy_privid = &mac802154_wpan_phy_privid; | |
21 | ||
c2085103 AA |
22 | void ieee802154_wake_queue(struct ieee802154_hw *hw) |
23 | { | |
24 | struct ieee802154_local *local = hw_to_local(hw); | |
25 | struct ieee802154_sub_if_data *sdata; | |
26 | ||
27 | rcu_read_lock(); | |
28 | list_for_each_entry_rcu(sdata, &local->interfaces, list) { | |
29 | if (!sdata->dev) | |
30 | continue; | |
31 | ||
32 | netif_wake_queue(sdata->dev); | |
33 | } | |
34 | rcu_read_unlock(); | |
35 | } | |
36 | EXPORT_SYMBOL(ieee802154_wake_queue); | |
37 | ||
38 | void ieee802154_stop_queue(struct ieee802154_hw *hw) | |
39 | { | |
40 | struct ieee802154_local *local = hw_to_local(hw); | |
41 | struct ieee802154_sub_if_data *sdata; | |
42 | ||
43 | rcu_read_lock(); | |
44 | list_for_each_entry_rcu(sdata, &local->interfaces, list) { | |
45 | if (!sdata->dev) | |
46 | continue; | |
47 | ||
48 | netif_stop_queue(sdata->dev); | |
49 | } | |
50 | rcu_read_unlock(); | |
51 | } | |
52 | EXPORT_SYMBOL(ieee802154_stop_queue); | |
53 | ||
61f2dcba | 54 | enum hrtimer_restart ieee802154_xmit_ifs_timer(struct hrtimer *timer) |
c2085103 | 55 | { |
61f2dcba AA |
56 | struct ieee802154_local *local = |
57 | container_of(timer, struct ieee802154_local, ifs_timer); | |
58 | ||
59 | ieee802154_wake_queue(&local->hw); | |
60 | ||
61 | return HRTIMER_NORESTART; | |
62 | } | |
63 | ||
64 | void ieee802154_xmit_complete(struct ieee802154_hw *hw, struct sk_buff *skb, | |
65 | bool ifs_handling) | |
66 | { | |
67 | if (ifs_handling) { | |
68 | struct ieee802154_local *local = hw_to_local(hw); | |
3f3c4bb5 | 69 | u8 max_sifs_size; |
61f2dcba | 70 | |
3f3c4bb5 AA |
71 | /* If transceiver sets CRC on his own we need to use lifs |
72 | * threshold len above 16 otherwise 18, because it's not | |
73 | * part of skb->len. | |
74 | */ | |
75 | if (hw->flags & IEEE802154_HW_TX_OMIT_CKSUM) | |
76 | max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE - | |
77 | IEEE802154_FCS_LEN; | |
78 | else | |
79 | max_sifs_size = IEEE802154_MAX_SIFS_FRAME_SIZE; | |
80 | ||
81 | if (skb->len > max_sifs_size) | |
61f2dcba | 82 | hrtimer_start(&local->ifs_timer, |
8b0e1953 | 83 | hw->phy->lifs_period * NSEC_PER_USEC, |
61f2dcba AA |
84 | HRTIMER_MODE_REL); |
85 | else | |
86 | hrtimer_start(&local->ifs_timer, | |
8b0e1953 | 87 | hw->phy->sifs_period * NSEC_PER_USEC, |
61f2dcba | 88 | HRTIMER_MODE_REL); |
61f2dcba AA |
89 | } else { |
90 | ieee802154_wake_queue(hw); | |
61f2dcba | 91 | } |
3862eba6 AA |
92 | |
93 | dev_consume_skb_any(skb); | |
c2085103 AA |
94 | } |
95 | EXPORT_SYMBOL(ieee802154_xmit_complete); | |
c4227c8a AA |
96 | |
97 | void ieee802154_stop_device(struct ieee802154_local *local) | |
98 | { | |
99 | flush_workqueue(local->workqueue); | |
100 | hrtimer_cancel(&local->ifs_timer); | |
101 | drv_stop(local); | |
102 | } |