2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
5 * Copyright 2008-2009 Johannes Berg <johannes@sipsolutions.net>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
12 #include <net/mac80211.h>
13 #include "ieee80211_i.h"
19 void ieee80211_tx_status_irqsafe(struct ieee80211_hw
*hw
,
22 struct ieee80211_local
*local
= hw_to_local(hw
);
23 struct ieee80211_tx_info
*info
= IEEE80211_SKB_CB(skb
);
26 skb
->pkt_type
= IEEE80211_TX_STATUS_MSG
;
27 skb_queue_tail(info
->flags
& IEEE80211_TX_CTL_REQ_TX_STATUS
?
28 &local
->skb_queue
: &local
->skb_queue_unreliable
, skb
);
29 tmp
= skb_queue_len(&local
->skb_queue
) +
30 skb_queue_len(&local
->skb_queue_unreliable
);
31 while (tmp
> IEEE80211_IRQSAFE_QUEUE_LIMIT
&&
32 (skb
= skb_dequeue(&local
->skb_queue_unreliable
))) {
33 dev_kfree_skb_irq(skb
);
35 I802_DEBUG_INC(local
->tx_status_drop
);
37 tasklet_schedule(&local
->tasklet
);
39 EXPORT_SYMBOL(ieee80211_tx_status_irqsafe
);
41 static void ieee80211_handle_filtered_frame(struct ieee80211_local
*local
,
45 struct ieee80211_tx_info
*info
= IEEE80211_SKB_CB(skb
);
48 * XXX: This is temporary!
50 * The problem here is that when we get here, the driver will
51 * quite likely have pretty much overwritten info->control by
52 * using info->driver_data or info->rate_driver_data. Thus,
53 * when passing out the frame to the driver again, we would be
54 * passing completely bogus data since the driver would then
55 * expect a properly filled info->control. In mac80211 itself
56 * the same problem occurs, since we need info->control.vif
59 * To fix this, we should send the frame through TX processing
60 * again. However, it's not that simple, since the frame will
61 * have been software-encrypted (if applicable) already, and
62 * encrypting it again doesn't do much good. So to properly do
63 * that, we not only have to skip the actual 'raw' encryption
64 * (key selection etc. still has to be done!) but also the
65 * sequence number assignment since that impacts the crypto
66 * encapsulation, of course.
68 * Hence, for now, fix the bug by just dropping the frame.
72 sta
->tx_filtered_count
++;
75 * Clear the TX filter mask for this STA when sending the next
76 * packet. If the STA went to power save mode, this will happen
77 * when it wakes up for the next time.
79 set_sta_flags(sta
, WLAN_STA_CLEAR_PS_FILT
);
82 * This code races in the following way:
84 * (1) STA sends frame indicating it will go to sleep and does so
85 * (2) hardware/firmware adds STA to filter list, passes frame up
86 * (3) hardware/firmware processes TX fifo and suppresses a frame
87 * (4) we get TX status before having processed the frame and
88 * knowing that the STA has gone to sleep.
90 * This is actually quite unlikely even when both those events are
91 * processed from interrupts coming in quickly after one another or
92 * even at the same time because we queue both TX status events and
93 * RX frames to be processed by a tasklet and process them in the
94 * same order that they were received or TX status last. Hence, there
95 * is no race as long as the frame RX is processed before the next TX
96 * status, which drivers can ensure, see below.
98 * Note that this can only happen if the hardware or firmware can
99 * actually add STAs to the filter list, if this is done by the
100 * driver in response to set_tim() (which will only reduce the race
101 * this whole filtering tries to solve, not completely solve it)
102 * this situation cannot happen.
104 * To completely solve this race drivers need to make sure that they
105 * (a) don't mix the irq-safe/not irq-safe TX status/RX processing
107 * (b) always process RX events before TX status events if ordering
108 * can be unknown, for example with different interrupt status
111 if (test_sta_flags(sta
, WLAN_STA_PS_STA
) &&
112 skb_queue_len(&sta
->tx_filtered
) < STA_MAX_TX_BUFFER
) {
113 skb_queue_tail(&sta
->tx_filtered
, skb
);
117 if (!test_sta_flags(sta
, WLAN_STA_PS_STA
) &&
118 !(info
->flags
& IEEE80211_TX_INTFL_RETRIED
)) {
119 /* Software retry the packet once */
120 info
->flags
|= IEEE80211_TX_INTFL_RETRIED
;
121 ieee80211_add_pending_skb(local
, skb
);
126 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
128 printk(KERN_DEBUG
"%s: dropped TX filtered frame, "
129 "queue_len=%d PS=%d @%lu\n",
130 wiphy_name(local
->hw
.wiphy
),
131 skb_queue_len(&sta
->tx_filtered
),
132 !!test_sta_flags(sta
, WLAN_STA_PS_STA
), jiffies
);
137 static void ieee80211_frame_acked(struct sta_info
*sta
, struct sk_buff
*skb
)
139 struct ieee80211_mgmt
*mgmt
= (void *) skb
->data
;
140 struct ieee80211_local
*local
= sta
->local
;
141 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
143 if (ieee80211_is_action(mgmt
->frame_control
) &&
144 sdata
->vif
.type
== NL80211_IFTYPE_STATION
&&
145 mgmt
->u
.action
.category
== WLAN_CATEGORY_HT
&&
146 mgmt
->u
.action
.u
.ht_smps
.action
== WLAN_HT_ACTION_SMPS
) {
148 * This update looks racy, but isn't -- if we come
149 * here we've definitely got a station that we're
150 * talking to, and on a managed interface that can
151 * only be the AP. And the only other place updating
152 * this variable is before we're associated.
154 switch (mgmt
->u
.action
.u
.ht_smps
.smps_control
) {
155 case WLAN_HT_SMPS_CONTROL_DYNAMIC
:
156 sta
->sdata
->u
.mgd
.ap_smps
= IEEE80211_SMPS_DYNAMIC
;
158 case WLAN_HT_SMPS_CONTROL_STATIC
:
159 sta
->sdata
->u
.mgd
.ap_smps
= IEEE80211_SMPS_STATIC
;
161 case WLAN_HT_SMPS_CONTROL_DISABLED
:
162 default: /* shouldn't happen since we don't send that */
163 sta
->sdata
->u
.mgd
.ap_smps
= IEEE80211_SMPS_OFF
;
167 ieee80211_queue_work(&local
->hw
, &local
->recalc_smps
);
171 void ieee80211_tx_status(struct ieee80211_hw
*hw
, struct sk_buff
*skb
)
173 struct sk_buff
*skb2
;
174 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*) skb
->data
;
175 struct ieee80211_local
*local
= hw_to_local(hw
);
176 struct ieee80211_tx_info
*info
= IEEE80211_SKB_CB(skb
);
179 struct ieee80211_supported_band
*sband
;
180 struct ieee80211_tx_status_rtap_hdr
*rthdr
;
181 struct ieee80211_sub_if_data
*sdata
;
182 struct net_device
*prev_dev
= NULL
;
183 struct sta_info
*sta
, *tmp
;
184 int retry_count
= -1, i
;
187 for (i
= 0; i
< IEEE80211_TX_MAX_RATES
; i
++) {
188 /* the HW cannot have attempted that rate */
189 if (i
>= hw
->max_rates
) {
190 info
->status
.rates
[i
].idx
= -1;
191 info
->status
.rates
[i
].count
= 0;
194 retry_count
+= info
->status
.rates
[i
].count
;
201 sband
= local
->hw
.wiphy
->bands
[info
->band
];
203 for_each_sta_info(local
, hdr
->addr1
, sta
, tmp
) {
204 /* skip wrong virtual interface */
205 if (memcmp(hdr
->addr2
, sta
->sdata
->vif
.addr
, ETH_ALEN
))
208 if (!(info
->flags
& IEEE80211_TX_STAT_ACK
) &&
209 test_sta_flags(sta
, WLAN_STA_PS_STA
)) {
211 * The STA is in power save mode, so assume
212 * that this TX packet failed because of that.
214 ieee80211_handle_filtered_frame(local
, sta
, skb
);
219 fc
= hdr
->frame_control
;
221 if ((info
->flags
& IEEE80211_TX_STAT_AMPDU_NO_BACK
) &&
222 (ieee80211_is_data_qos(fc
))) {
226 qc
= ieee80211_get_qos_ctl(hdr
);
228 ssn
= ((le16_to_cpu(hdr
->seq_ctrl
) + 0x10)
229 & IEEE80211_SCTL_SEQ
);
230 ieee80211_send_bar(sta
->sdata
, hdr
->addr1
,
234 if (info
->flags
& IEEE80211_TX_STAT_TX_FILTERED
) {
235 ieee80211_handle_filtered_frame(local
, sta
, skb
);
239 if (!(info
->flags
& IEEE80211_TX_STAT_ACK
))
240 sta
->tx_retry_failed
++;
241 sta
->tx_retry_count
+= retry_count
;
244 rate_control_tx_status(local
, sband
, sta
, skb
);
245 if (ieee80211_vif_is_mesh(&sta
->sdata
->vif
))
246 ieee80211s_update_metric(local
, sta
, skb
);
248 if (!(info
->flags
& IEEE80211_TX_CTL_INJECTED
) &&
249 (info
->flags
& IEEE80211_TX_STAT_ACK
))
250 ieee80211_frame_acked(sta
, skb
);
255 ieee80211_led_tx(local
, 0);
258 * Fragments are passed to low-level drivers as separate skbs, so these
259 * are actually fragments, not frames. Update frame counters only for
260 * the first fragment of the frame. */
262 frag
= le16_to_cpu(hdr
->seq_ctrl
) & IEEE80211_SCTL_FRAG
;
263 type
= le16_to_cpu(hdr
->frame_control
) & IEEE80211_FCTL_FTYPE
;
265 if (info
->flags
& IEEE80211_TX_STAT_ACK
) {
267 local
->dot11TransmittedFrameCount
++;
268 if (is_multicast_ether_addr(hdr
->addr1
))
269 local
->dot11MulticastTransmittedFrameCount
++;
271 local
->dot11RetryCount
++;
273 local
->dot11MultipleRetryCount
++;
276 /* This counter shall be incremented for an acknowledged MPDU
277 * with an individual address in the address 1 field or an MPDU
278 * with a multicast address in the address 1 field of type Data
280 if (!is_multicast_ether_addr(hdr
->addr1
) ||
281 type
== IEEE80211_FTYPE_DATA
||
282 type
== IEEE80211_FTYPE_MGMT
)
283 local
->dot11TransmittedFragmentCount
++;
286 local
->dot11FailedCount
++;
289 /* this was a transmitted frame, but now we want to reuse it */
293 * This is a bit racy but we can avoid a lot of work
296 if (!local
->monitors
&& !local
->cooked_mntrs
) {
301 /* send frame to monitor interfaces now */
303 if (skb_headroom(skb
) < sizeof(*rthdr
)) {
304 printk(KERN_ERR
"ieee80211_tx_status: headroom too small\n");
309 rthdr
= (struct ieee80211_tx_status_rtap_hdr
*)
310 skb_push(skb
, sizeof(*rthdr
));
312 memset(rthdr
, 0, sizeof(*rthdr
));
313 rthdr
->hdr
.it_len
= cpu_to_le16(sizeof(*rthdr
));
314 rthdr
->hdr
.it_present
=
315 cpu_to_le32((1 << IEEE80211_RADIOTAP_TX_FLAGS
) |
316 (1 << IEEE80211_RADIOTAP_DATA_RETRIES
) |
317 (1 << IEEE80211_RADIOTAP_RATE
));
319 if (!(info
->flags
& IEEE80211_TX_STAT_ACK
) &&
320 !is_multicast_ether_addr(hdr
->addr1
))
321 rthdr
->tx_flags
|= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_FAIL
);
324 * XXX: Once radiotap gets the bitmap reset thing the vendor
325 * extensions proposal contains, we can actually report
326 * the whole set of tries we did.
328 if ((info
->status
.rates
[0].flags
& IEEE80211_TX_RC_USE_RTS_CTS
) ||
329 (info
->status
.rates
[0].flags
& IEEE80211_TX_RC_USE_CTS_PROTECT
))
330 rthdr
->tx_flags
|= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_CTS
);
331 else if (info
->status
.rates
[0].flags
& IEEE80211_TX_RC_USE_RTS_CTS
)
332 rthdr
->tx_flags
|= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_RTS
);
333 if (info
->status
.rates
[0].idx
>= 0 &&
334 !(info
->status
.rates
[0].flags
& IEEE80211_TX_RC_MCS
))
335 rthdr
->rate
= sband
->bitrates
[
336 info
->status
.rates
[0].idx
].bitrate
/ 5;
338 /* for now report the total retry_count */
339 rthdr
->data_retries
= retry_count
;
341 /* Need to make a copy before skb->cb gets cleared */
342 injected
= !!(info
->flags
& IEEE80211_TX_CTL_INJECTED
);
344 /* XXX: is this sufficient for BPF? */
345 skb_set_mac_header(skb
, 0);
346 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
347 skb
->pkt_type
= PACKET_OTHERHOST
;
348 skb
->protocol
= htons(ETH_P_802_2
);
349 memset(skb
->cb
, 0, sizeof(skb
->cb
));
352 list_for_each_entry_rcu(sdata
, &local
->interfaces
, list
) {
353 if (sdata
->vif
.type
== NL80211_IFTYPE_MONITOR
) {
354 if (!ieee80211_sdata_running(sdata
))
357 if ((sdata
->u
.mntr_flags
& MONITOR_FLAG_COOK_FRAMES
) &&
359 (type
== IEEE80211_FTYPE_DATA
))
363 skb2
= skb_clone(skb
, GFP_ATOMIC
);
365 skb2
->dev
= prev_dev
;
370 prev_dev
= sdata
->dev
;
381 EXPORT_SYMBOL(ieee80211_tx_status
);