| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 1 | /* | 
|  | 2 | * Copyright 2002-2005, Instant802 Networks, Inc. | 
|  | 3 | * Copyright 2005-2006, Devicescape Software, Inc. | 
|  | 4 | * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz> | 
| Jouni Malinen | 026331c | 2010-02-15 12:53:10 +0200 | [diff] [blame] | 5 | * Copyright 2008-2010	Johannes Berg <johannes@sipsolutions.net> | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 6 | * | 
|  | 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. | 
|  | 10 | */ | 
|  | 11 |  | 
| Paul Gortmaker | bc3b2d7 | 2011-07-15 11:47:34 -0400 | [diff] [blame] | 12 | #include <linux/export.h> | 
| Felix Fietkau | 888d04d | 2012-03-01 15:22:09 +0100 | [diff] [blame] | 13 | #include <linux/etherdevice.h> | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 14 | #include <net/mac80211.h> | 
| Johannes Berg | d26ad37 | 2012-02-20 11:38:41 +0100 | [diff] [blame] | 15 | #include <asm/unaligned.h> | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 16 | #include "ieee80211_i.h" | 
|  | 17 | #include "rate.h" | 
|  | 18 | #include "mesh.h" | 
|  | 19 | #include "led.h" | 
| Johannes Berg | 948d887 | 2011-09-29 16:04:29 +0200 | [diff] [blame] | 20 | #include "wme.h" | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 21 |  | 
|  | 22 |  | 
|  | 23 | void ieee80211_tx_status_irqsafe(struct ieee80211_hw *hw, | 
|  | 24 | struct sk_buff *skb) | 
|  | 25 | { | 
|  | 26 | struct ieee80211_local *local = hw_to_local(hw); | 
|  | 27 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); | 
|  | 28 | int tmp; | 
|  | 29 |  | 
|  | 30 | skb->pkt_type = IEEE80211_TX_STATUS_MSG; | 
|  | 31 | skb_queue_tail(info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS ? | 
|  | 32 | &local->skb_queue : &local->skb_queue_unreliable, skb); | 
|  | 33 | tmp = skb_queue_len(&local->skb_queue) + | 
|  | 34 | skb_queue_len(&local->skb_queue_unreliable); | 
|  | 35 | while (tmp > IEEE80211_IRQSAFE_QUEUE_LIMIT && | 
|  | 36 | (skb = skb_dequeue(&local->skb_queue_unreliable))) { | 
|  | 37 | dev_kfree_skb_irq(skb); | 
|  | 38 | tmp--; | 
|  | 39 | I802_DEBUG_INC(local->tx_status_drop); | 
|  | 40 | } | 
|  | 41 | tasklet_schedule(&local->tasklet); | 
|  | 42 | } | 
|  | 43 | EXPORT_SYMBOL(ieee80211_tx_status_irqsafe); | 
|  | 44 |  | 
|  | 45 | static void ieee80211_handle_filtered_frame(struct ieee80211_local *local, | 
|  | 46 | struct sta_info *sta, | 
|  | 47 | struct sk_buff *skb) | 
|  | 48 | { | 
|  | 49 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); | 
| Johannes Berg | 948d887 | 2011-09-29 16:04:29 +0200 | [diff] [blame] | 50 | struct ieee80211_hdr *hdr = (void *)skb->data; | 
|  | 51 | int ac; | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 52 |  | 
|  | 53 | /* | 
| Johannes Berg | 697e6a0 | 2010-01-17 01:47:56 +0100 | [diff] [blame] | 54 | * This skb 'survived' a round-trip through the driver, and | 
|  | 55 | * hopefully the driver didn't mangle it too badly. However, | 
| Walter Goldens | 77c2061 | 2010-05-18 04:44:54 -0700 | [diff] [blame] | 56 | * we can definitely not rely on the control information | 
| Johannes Berg | c6fcf6b | 2010-01-17 01:47:59 +0100 | [diff] [blame] | 57 | * being correct. Clear it so we don't get junk there, and | 
|  | 58 | * indicate that it needs new processing, but must not be | 
|  | 59 | * modified/encrypted again. | 
| Johannes Berg | 697e6a0 | 2010-01-17 01:47:56 +0100 | [diff] [blame] | 60 | */ | 
|  | 61 | memset(&info->control, 0, sizeof(info->control)); | 
| Johannes Berg | 18c9490 | 2010-01-25 19:07:39 +0100 | [diff] [blame] | 62 |  | 
|  | 63 | info->control.jiffies = jiffies; | 
|  | 64 | info->control.vif = &sta->sdata->vif; | 
| Johannes Berg | c6fcf6b | 2010-01-17 01:47:59 +0100 | [diff] [blame] | 65 | info->flags |= IEEE80211_TX_INTFL_NEED_TXPROCESSING | | 
|  | 66 | IEEE80211_TX_INTFL_RETRANSMISSION; | 
| Christian Lamparter | eb7d306 | 2010-09-21 21:36:18 +0200 | [diff] [blame] | 67 | info->flags &= ~IEEE80211_TX_TEMPORARY_FLAGS; | 
| Johannes Berg | 697e6a0 | 2010-01-17 01:47:56 +0100 | [diff] [blame] | 68 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 69 | sta->tx_filtered_count++; | 
|  | 70 |  | 
| Johannes Berg | 8a8656f | 2011-09-29 16:04:31 +0200 | [diff] [blame] | 71 | /* | 
|  | 72 | * Clear more-data bit on filtered frames, it might be set | 
|  | 73 | * but later frames might time out so it might have to be | 
|  | 74 | * clear again ... It's all rather unlikely (this frame | 
|  | 75 | * should time out first, right?) but let's not confuse | 
|  | 76 | * peers unnecessarily. | 
|  | 77 | */ | 
|  | 78 | if (hdr->frame_control & cpu_to_le16(IEEE80211_FCTL_MOREDATA)) | 
|  | 79 | hdr->frame_control &= ~cpu_to_le16(IEEE80211_FCTL_MOREDATA); | 
|  | 80 |  | 
| Johannes Berg | 948d887 | 2011-09-29 16:04:29 +0200 | [diff] [blame] | 81 | if (ieee80211_is_data_qos(hdr->frame_control)) { | 
| Johannes Berg | 47086fc | 2011-09-29 16:04:33 +0200 | [diff] [blame] | 82 | u8 *p = ieee80211_get_qos_ctl(hdr); | 
|  | 83 | int tid = *p & IEEE80211_QOS_CTL_TID_MASK; | 
|  | 84 |  | 
|  | 85 | /* | 
|  | 86 | * Clear EOSP if set, this could happen e.g. | 
|  | 87 | * if an absence period (us being a P2P GO) | 
|  | 88 | * shortens the SP. | 
|  | 89 | */ | 
|  | 90 | if (*p & IEEE80211_QOS_CTL_EOSP) | 
|  | 91 | *p &= ~IEEE80211_QOS_CTL_EOSP; | 
| Johannes Berg | 948d887 | 2011-09-29 16:04:29 +0200 | [diff] [blame] | 92 | ac = ieee802_1d_to_ac[tid & 7]; | 
|  | 93 | } else { | 
|  | 94 | ac = IEEE80211_AC_BE; | 
|  | 95 | } | 
|  | 96 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 97 | /* | 
|  | 98 | * Clear the TX filter mask for this STA when sending the next | 
|  | 99 | * packet. If the STA went to power save mode, this will happen | 
|  | 100 | * when it wakes up for the next time. | 
|  | 101 | */ | 
| Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 102 | set_sta_flag(sta, WLAN_STA_CLEAR_PS_FILT); | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 103 |  | 
|  | 104 | /* | 
|  | 105 | * This code races in the following way: | 
|  | 106 | * | 
|  | 107 | *  (1) STA sends frame indicating it will go to sleep and does so | 
|  | 108 | *  (2) hardware/firmware adds STA to filter list, passes frame up | 
|  | 109 | *  (3) hardware/firmware processes TX fifo and suppresses a frame | 
|  | 110 | *  (4) we get TX status before having processed the frame and | 
|  | 111 | *	knowing that the STA has gone to sleep. | 
|  | 112 | * | 
|  | 113 | * This is actually quite unlikely even when both those events are | 
|  | 114 | * processed from interrupts coming in quickly after one another or | 
|  | 115 | * even at the same time because we queue both TX status events and | 
|  | 116 | * RX frames to be processed by a tasklet and process them in the | 
|  | 117 | * same order that they were received or TX status last. Hence, there | 
|  | 118 | * is no race as long as the frame RX is processed before the next TX | 
|  | 119 | * status, which drivers can ensure, see below. | 
|  | 120 | * | 
|  | 121 | * Note that this can only happen if the hardware or firmware can | 
|  | 122 | * actually add STAs to the filter list, if this is done by the | 
|  | 123 | * driver in response to set_tim() (which will only reduce the race | 
|  | 124 | * this whole filtering tries to solve, not completely solve it) | 
|  | 125 | * this situation cannot happen. | 
|  | 126 | * | 
|  | 127 | * To completely solve this race drivers need to make sure that they | 
|  | 128 | *  (a) don't mix the irq-safe/not irq-safe TX status/RX processing | 
|  | 129 | *	functions and | 
|  | 130 | *  (b) always process RX events before TX status events if ordering | 
|  | 131 | *      can be unknown, for example with different interrupt status | 
|  | 132 | *	bits. | 
| Arik Nemtsov | d057e5a | 2011-01-31 22:29:13 +0200 | [diff] [blame] | 133 | *  (c) if PS mode transitions are manual (i.e. the flag | 
|  | 134 | *      %IEEE80211_HW_AP_LINK_PS is set), always process PS state | 
|  | 135 | *      changes before calling TX status events if ordering can be | 
|  | 136 | *	unknown. | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 137 | */ | 
| Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 138 | if (test_sta_flag(sta, WLAN_STA_PS_STA) && | 
| Johannes Berg | 948d887 | 2011-09-29 16:04:29 +0200 | [diff] [blame] | 139 | skb_queue_len(&sta->tx_filtered[ac]) < STA_MAX_TX_BUFFER) { | 
|  | 140 | skb_queue_tail(&sta->tx_filtered[ac], skb); | 
| Johannes Berg | c868cb3 | 2011-09-29 16:04:27 +0200 | [diff] [blame] | 141 | sta_info_recalc_tim(sta); | 
| Johannes Berg | 6075039 | 2011-09-29 16:04:28 +0200 | [diff] [blame] | 142 |  | 
|  | 143 | if (!timer_pending(&local->sta_cleanup)) | 
|  | 144 | mod_timer(&local->sta_cleanup, | 
|  | 145 | round_jiffies(jiffies + | 
|  | 146 | STA_INFO_CLEANUP_INTERVAL)); | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 147 | return; | 
|  | 148 | } | 
|  | 149 |  | 
| Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 150 | if (!test_sta_flag(sta, WLAN_STA_PS_STA) && | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 151 | !(info->flags & IEEE80211_TX_INTFL_RETRIED)) { | 
|  | 152 | /* Software retry the packet once */ | 
|  | 153 | info->flags |= IEEE80211_TX_INTFL_RETRIED; | 
|  | 154 | ieee80211_add_pending_skb(local, skb); | 
|  | 155 | return; | 
|  | 156 | } | 
|  | 157 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 158 | #ifdef CONFIG_MAC80211_VERBOSE_DEBUG | 
|  | 159 | if (net_ratelimit()) | 
| Joe Perches | 0fb9a9e | 2010-08-20 16:25:38 -0700 | [diff] [blame] | 160 | wiphy_debug(local->hw.wiphy, | 
|  | 161 | "dropped TX filtered frame, queue_len=%d PS=%d @%lu\n", | 
| Johannes Berg | 948d887 | 2011-09-29 16:04:29 +0200 | [diff] [blame] | 162 | skb_queue_len(&sta->tx_filtered[ac]), | 
| Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 163 | !!test_sta_flag(sta, WLAN_STA_PS_STA), jiffies); | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 164 | #endif | 
|  | 165 | dev_kfree_skb(skb); | 
|  | 166 | } | 
|  | 167 |  | 
| Felix Fietkau | f0425be | 2011-08-28 21:11:01 +0200 | [diff] [blame] | 168 | static void ieee80211_check_pending_bar(struct sta_info *sta, u8 *addr, u8 tid) | 
|  | 169 | { | 
|  | 170 | struct tid_ampdu_tx *tid_tx; | 
|  | 171 |  | 
|  | 172 | tid_tx = rcu_dereference(sta->ampdu_mlme.tid_tx[tid]); | 
|  | 173 | if (!tid_tx || !tid_tx->bar_pending) | 
|  | 174 | return; | 
|  | 175 |  | 
|  | 176 | tid_tx->bar_pending = false; | 
| Felix Fietkau | 8c77124 | 2011-08-20 15:53:55 +0200 | [diff] [blame] | 177 | ieee80211_send_bar(&sta->sdata->vif, addr, tid, tid_tx->failed_bar_ssn); | 
| Felix Fietkau | f0425be | 2011-08-28 21:11:01 +0200 | [diff] [blame] | 178 | } | 
|  | 179 |  | 
| Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 180 | static void ieee80211_frame_acked(struct sta_info *sta, struct sk_buff *skb) | 
|  | 181 | { | 
|  | 182 | struct ieee80211_mgmt *mgmt = (void *) skb->data; | 
|  | 183 | struct ieee80211_local *local = sta->local; | 
|  | 184 | struct ieee80211_sub_if_data *sdata = sta->sdata; | 
|  | 185 |  | 
| Felix Fietkau | f0425be | 2011-08-28 21:11:01 +0200 | [diff] [blame] | 186 | if (ieee80211_is_data_qos(mgmt->frame_control)) { | 
|  | 187 | struct ieee80211_hdr *hdr = (void *) skb->data; | 
|  | 188 | u8 *qc = ieee80211_get_qos_ctl(hdr); | 
|  | 189 | u16 tid = qc[0] & 0xf; | 
|  | 190 |  | 
|  | 191 | ieee80211_check_pending_bar(sta, hdr->addr1, tid); | 
|  | 192 | } | 
|  | 193 |  | 
| Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 194 | if (ieee80211_is_action(mgmt->frame_control) && | 
|  | 195 | sdata->vif.type == NL80211_IFTYPE_STATION && | 
|  | 196 | mgmt->u.action.category == WLAN_CATEGORY_HT && | 
|  | 197 | mgmt->u.action.u.ht_smps.action == WLAN_HT_ACTION_SMPS) { | 
|  | 198 | /* | 
|  | 199 | * This update looks racy, but isn't -- if we come | 
|  | 200 | * here we've definitely got a station that we're | 
|  | 201 | * talking to, and on a managed interface that can | 
|  | 202 | * only be the AP. And the only other place updating | 
|  | 203 | * this variable is before we're associated. | 
|  | 204 | */ | 
|  | 205 | switch (mgmt->u.action.u.ht_smps.smps_control) { | 
|  | 206 | case WLAN_HT_SMPS_CONTROL_DYNAMIC: | 
|  | 207 | sta->sdata->u.mgd.ap_smps = IEEE80211_SMPS_DYNAMIC; | 
|  | 208 | break; | 
|  | 209 | case WLAN_HT_SMPS_CONTROL_STATIC: | 
|  | 210 | sta->sdata->u.mgd.ap_smps = IEEE80211_SMPS_STATIC; | 
|  | 211 | break; | 
|  | 212 | case WLAN_HT_SMPS_CONTROL_DISABLED: | 
|  | 213 | default: /* shouldn't happen since we don't send that */ | 
|  | 214 | sta->sdata->u.mgd.ap_smps = IEEE80211_SMPS_OFF; | 
|  | 215 | break; | 
|  | 216 | } | 
|  | 217 |  | 
|  | 218 | ieee80211_queue_work(&local->hw, &local->recalc_smps); | 
|  | 219 | } | 
|  | 220 | } | 
|  | 221 |  | 
| Felix Fietkau | f0425be | 2011-08-28 21:11:01 +0200 | [diff] [blame] | 222 | static void ieee80211_set_bar_pending(struct sta_info *sta, u8 tid, u16 ssn) | 
|  | 223 | { | 
|  | 224 | struct tid_ampdu_tx *tid_tx; | 
|  | 225 |  | 
|  | 226 | tid_tx = rcu_dereference(sta->ampdu_mlme.tid_tx[tid]); | 
|  | 227 | if (!tid_tx) | 
|  | 228 | return; | 
|  | 229 |  | 
|  | 230 | tid_tx->failed_bar_ssn = ssn; | 
|  | 231 | tid_tx->bar_pending = true; | 
|  | 232 | } | 
|  | 233 |  | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 234 | static int ieee80211_tx_radiotap_len(struct ieee80211_tx_info *info) | 
|  | 235 | { | 
|  | 236 | int len = sizeof(struct ieee80211_radiotap_header); | 
|  | 237 |  | 
|  | 238 | /* IEEE80211_RADIOTAP_RATE rate */ | 
|  | 239 | if (info->status.rates[0].idx >= 0 && | 
|  | 240 | !(info->status.rates[0].flags & IEEE80211_TX_RC_MCS)) | 
|  | 241 | len += 2; | 
|  | 242 |  | 
|  | 243 | /* IEEE80211_RADIOTAP_TX_FLAGS */ | 
|  | 244 | len += 2; | 
|  | 245 |  | 
|  | 246 | /* IEEE80211_RADIOTAP_DATA_RETRIES */ | 
|  | 247 | len += 1; | 
|  | 248 |  | 
| Helmut Schaa | 7f2a5e2 | 2011-10-11 18:08:55 +0200 | [diff] [blame] | 249 | /* IEEE80211_TX_RC_MCS */ | 
|  | 250 | if (info->status.rates[0].idx >= 0 && | 
|  | 251 | info->status.rates[0].flags & IEEE80211_TX_RC_MCS) | 
|  | 252 | len += 3; | 
|  | 253 |  | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 254 | return len; | 
|  | 255 | } | 
|  | 256 |  | 
|  | 257 | static void ieee80211_add_tx_radiotap_header(struct ieee80211_supported_band | 
|  | 258 | *sband, struct sk_buff *skb, | 
|  | 259 | int retry_count, int rtap_len) | 
|  | 260 | { | 
|  | 261 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); | 
|  | 262 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; | 
|  | 263 | struct ieee80211_radiotap_header *rthdr; | 
|  | 264 | unsigned char *pos; | 
| Helmut Schaa | 9c8f2c4 | 2011-11-18 17:02:16 +0100 | [diff] [blame] | 265 | u16 txflags; | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 266 |  | 
|  | 267 | rthdr = (struct ieee80211_radiotap_header *) skb_push(skb, rtap_len); | 
|  | 268 |  | 
|  | 269 | memset(rthdr, 0, rtap_len); | 
|  | 270 | rthdr->it_len = cpu_to_le16(rtap_len); | 
|  | 271 | rthdr->it_present = | 
|  | 272 | cpu_to_le32((1 << IEEE80211_RADIOTAP_TX_FLAGS) | | 
|  | 273 | (1 << IEEE80211_RADIOTAP_DATA_RETRIES)); | 
|  | 274 | pos = (unsigned char *)(rthdr + 1); | 
|  | 275 |  | 
|  | 276 | /* | 
|  | 277 | * XXX: Once radiotap gets the bitmap reset thing the vendor | 
|  | 278 | *	extensions proposal contains, we can actually report | 
|  | 279 | *	the whole set of tries we did. | 
|  | 280 | */ | 
|  | 281 |  | 
|  | 282 | /* IEEE80211_RADIOTAP_RATE */ | 
|  | 283 | if (info->status.rates[0].idx >= 0 && | 
|  | 284 | !(info->status.rates[0].flags & IEEE80211_TX_RC_MCS)) { | 
|  | 285 | rthdr->it_present |= cpu_to_le32(1 << IEEE80211_RADIOTAP_RATE); | 
|  | 286 | *pos = sband->bitrates[info->status.rates[0].idx].bitrate / 5; | 
|  | 287 | /* padding for tx flags */ | 
|  | 288 | pos += 2; | 
|  | 289 | } | 
|  | 290 |  | 
|  | 291 | /* IEEE80211_RADIOTAP_TX_FLAGS */ | 
|  | 292 | txflags = 0; | 
|  | 293 | if (!(info->flags & IEEE80211_TX_STAT_ACK) && | 
|  | 294 | !is_multicast_ether_addr(hdr->addr1)) | 
| Helmut Schaa | 9c8f2c4 | 2011-11-18 17:02:16 +0100 | [diff] [blame] | 295 | txflags |= IEEE80211_RADIOTAP_F_TX_FAIL; | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 296 |  | 
|  | 297 | if ((info->status.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS) || | 
|  | 298 | (info->status.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT)) | 
| Helmut Schaa | 9c8f2c4 | 2011-11-18 17:02:16 +0100 | [diff] [blame] | 299 | txflags |= IEEE80211_RADIOTAP_F_TX_CTS; | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 300 | else if (info->status.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS) | 
| Helmut Schaa | 9c8f2c4 | 2011-11-18 17:02:16 +0100 | [diff] [blame] | 301 | txflags |= IEEE80211_RADIOTAP_F_TX_RTS; | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 302 |  | 
|  | 303 | put_unaligned_le16(txflags, pos); | 
|  | 304 | pos += 2; | 
|  | 305 |  | 
|  | 306 | /* IEEE80211_RADIOTAP_DATA_RETRIES */ | 
|  | 307 | /* for now report the total retry_count */ | 
|  | 308 | *pos = retry_count; | 
|  | 309 | pos++; | 
| Helmut Schaa | 7f2a5e2 | 2011-10-11 18:08:55 +0200 | [diff] [blame] | 310 |  | 
|  | 311 | /* IEEE80211_TX_RC_MCS */ | 
|  | 312 | if (info->status.rates[0].idx >= 0 && | 
|  | 313 | info->status.rates[0].flags & IEEE80211_TX_RC_MCS) { | 
|  | 314 | rthdr->it_present |= cpu_to_le32(1 << IEEE80211_RADIOTAP_MCS); | 
|  | 315 | pos[0] = IEEE80211_RADIOTAP_MCS_HAVE_MCS | | 
|  | 316 | IEEE80211_RADIOTAP_MCS_HAVE_GI | | 
|  | 317 | IEEE80211_RADIOTAP_MCS_HAVE_BW; | 
|  | 318 | if (info->status.rates[0].flags & IEEE80211_TX_RC_SHORT_GI) | 
|  | 319 | pos[1] |= IEEE80211_RADIOTAP_MCS_SGI; | 
|  | 320 | if (info->status.rates[0].flags & IEEE80211_TX_RC_40_MHZ_WIDTH) | 
|  | 321 | pos[1] |= IEEE80211_RADIOTAP_MCS_BW_40; | 
|  | 322 | if (info->status.rates[0].flags & IEEE80211_TX_RC_GREEN_FIELD) | 
|  | 323 | pos[1] |= IEEE80211_RADIOTAP_MCS_FMT_GF; | 
|  | 324 | pos[2] = info->status.rates[0].idx; | 
|  | 325 | pos += 3; | 
|  | 326 | } | 
|  | 327 |  | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 328 | } | 
|  | 329 |  | 
| Johannes Berg | 99ba2a1 | 2010-11-24 08:10:06 +0100 | [diff] [blame] | 330 | /* | 
|  | 331 | * Use a static threshold for now, best value to be determined | 
|  | 332 | * by testing ... | 
|  | 333 | * Should it depend on: | 
|  | 334 | *  - on # of retransmissions | 
|  | 335 | *  - current throughput (higher value for higher tpt)? | 
|  | 336 | */ | 
|  | 337 | #define STA_LOST_PKT_THRESHOLD	50 | 
|  | 338 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 339 | void ieee80211_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb) | 
|  | 340 | { | 
|  | 341 | struct sk_buff *skb2; | 
|  | 342 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; | 
|  | 343 | struct ieee80211_local *local = hw_to_local(hw); | 
|  | 344 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 345 | __le16 fc; | 
|  | 346 | struct ieee80211_supported_band *sband; | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 347 | struct ieee80211_sub_if_data *sdata; | 
|  | 348 | struct net_device *prev_dev = NULL; | 
| Johannes Berg | abe6063 | 2009-11-25 17:46:18 +0100 | [diff] [blame] | 349 | struct sta_info *sta, *tmp; | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 350 | int retry_count = -1, i; | 
| Juuso Oikarinen | 0c86980 | 2010-04-22 10:27:48 +0300 | [diff] [blame] | 351 | int rates_idx = -1; | 
| Felix Fietkau | eaf5553 | 2010-03-11 16:28:24 +0100 | [diff] [blame] | 352 | bool send_to_cooked; | 
| Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 353 | bool acked; | 
| Helmut Schaa | e69dede | 2011-08-11 16:17:42 +0200 | [diff] [blame] | 354 | struct ieee80211_bar *bar; | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 355 | int rtap_len; | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 356 |  | 
|  | 357 | for (i = 0; i < IEEE80211_TX_MAX_RATES; i++) { | 
| Helmut Schaa | be7974a | 2011-03-21 15:07:55 +0100 | [diff] [blame] | 358 | if (info->status.rates[i].idx < 0) { | 
|  | 359 | break; | 
|  | 360 | } else if (i >= hw->max_report_rates) { | 
|  | 361 | /* the HW cannot have attempted that rate */ | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 362 | info->status.rates[i].idx = -1; | 
|  | 363 | info->status.rates[i].count = 0; | 
| Helmut Schaa | be7974a | 2011-03-21 15:07:55 +0100 | [diff] [blame] | 364 | break; | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 365 | } | 
|  | 366 |  | 
|  | 367 | retry_count += info->status.rates[i].count; | 
|  | 368 | } | 
| Helmut Schaa | be7974a | 2011-03-21 15:07:55 +0100 | [diff] [blame] | 369 | rates_idx = i - 1; | 
|  | 370 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 371 | if (retry_count < 0) | 
|  | 372 | retry_count = 0; | 
|  | 373 |  | 
|  | 374 | rcu_read_lock(); | 
|  | 375 |  | 
|  | 376 | sband = local->hw.wiphy->bands[info->band]; | 
| Vivek Natarajan | 375177b | 2010-02-09 14:50:28 +0530 | [diff] [blame] | 377 | fc = hdr->frame_control; | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 378 |  | 
| Johannes Berg | abe6063 | 2009-11-25 17:46:18 +0100 | [diff] [blame] | 379 | for_each_sta_info(local, hdr->addr1, sta, tmp) { | 
|  | 380 | /* skip wrong virtual interface */ | 
| Felix Fietkau | 888d04d | 2012-03-01 15:22:09 +0100 | [diff] [blame] | 381 | if (compare_ether_addr(hdr->addr2, sta->sdata->vif.addr)) | 
| Johannes Berg | abe6063 | 2009-11-25 17:46:18 +0100 | [diff] [blame] | 382 | continue; | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 383 |  | 
| Johannes Berg | 47086fc | 2011-09-29 16:04:33 +0200 | [diff] [blame] | 384 | if (info->flags & IEEE80211_TX_STATUS_EOSP) | 
| Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 385 | clear_sta_flag(sta, WLAN_STA_SP); | 
| Johannes Berg | 47086fc | 2011-09-29 16:04:33 +0200 | [diff] [blame] | 386 |  | 
| Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 387 | acked = !!(info->flags & IEEE80211_TX_STAT_ACK); | 
| Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 388 | if (!acked && test_sta_flag(sta, WLAN_STA_PS_STA)) { | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 389 | /* | 
|  | 390 | * The STA is in power save mode, so assume | 
|  | 391 | * that this TX packet failed because of that. | 
|  | 392 | */ | 
|  | 393 | ieee80211_handle_filtered_frame(local, sta, skb); | 
|  | 394 | rcu_read_unlock(); | 
|  | 395 | return; | 
|  | 396 | } | 
|  | 397 |  | 
| Juuso Oikarinen | 0c86980 | 2010-04-22 10:27:48 +0300 | [diff] [blame] | 398 | if ((local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL) && | 
|  | 399 | (rates_idx != -1)) | 
|  | 400 | sta->last_tx_rate = info->status.rates[rates_idx]; | 
|  | 401 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 402 | if ((info->flags & IEEE80211_TX_STAT_AMPDU_NO_BACK) && | 
|  | 403 | (ieee80211_is_data_qos(fc))) { | 
|  | 404 | u16 tid, ssn; | 
|  | 405 | u8 *qc; | 
|  | 406 |  | 
|  | 407 | qc = ieee80211_get_qos_ctl(hdr); | 
|  | 408 | tid = qc[0] & 0xf; | 
|  | 409 | ssn = ((le16_to_cpu(hdr->seq_ctrl) + 0x10) | 
|  | 410 | & IEEE80211_SCTL_SEQ); | 
| Felix Fietkau | 8c77124 | 2011-08-20 15:53:55 +0200 | [diff] [blame] | 411 | ieee80211_send_bar(&sta->sdata->vif, hdr->addr1, | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 412 | tid, ssn); | 
|  | 413 | } | 
|  | 414 |  | 
| Helmut Schaa | e69dede | 2011-08-11 16:17:42 +0200 | [diff] [blame] | 415 | if (!acked && ieee80211_is_back_req(fc)) { | 
| Johannes Berg | 8e7c4e4 | 2012-01-20 13:52:36 +0100 | [diff] [blame] | 416 | u16 tid, control; | 
| Felix Fietkau | 7107676 | 2011-09-15 09:37:46 +0200 | [diff] [blame] | 417 |  | 
| Helmut Schaa | e69dede | 2011-08-11 16:17:42 +0200 | [diff] [blame] | 418 | /* | 
| Felix Fietkau | 7107676 | 2011-09-15 09:37:46 +0200 | [diff] [blame] | 419 | * BAR failed, store the last SSN and retry sending | 
|  | 420 | * the BAR when the next unicast transmission on the | 
|  | 421 | * same TID succeeds. | 
| Helmut Schaa | e69dede | 2011-08-11 16:17:42 +0200 | [diff] [blame] | 422 | */ | 
|  | 423 | bar = (struct ieee80211_bar *) skb->data; | 
| Felix Fietkau | 7107676 | 2011-09-15 09:37:46 +0200 | [diff] [blame] | 424 | control = le16_to_cpu(bar->control); | 
|  | 425 | if (!(control & IEEE80211_BAR_CTRL_MULTI_TID)) { | 
| Felix Fietkau | f0425be | 2011-08-28 21:11:01 +0200 | [diff] [blame] | 426 | u16 ssn = le16_to_cpu(bar->start_seq_num); | 
|  | 427 |  | 
| Felix Fietkau | 7107676 | 2011-09-15 09:37:46 +0200 | [diff] [blame] | 428 | tid = (control & | 
| Helmut Schaa | e69dede | 2011-08-11 16:17:42 +0200 | [diff] [blame] | 429 | IEEE80211_BAR_CTRL_TID_INFO_MASK) >> | 
|  | 430 | IEEE80211_BAR_CTRL_TID_INFO_SHIFT; | 
| Felix Fietkau | f0425be | 2011-08-28 21:11:01 +0200 | [diff] [blame] | 431 |  | 
|  | 432 | ieee80211_set_bar_pending(sta, tid, ssn); | 
| Helmut Schaa | e69dede | 2011-08-11 16:17:42 +0200 | [diff] [blame] | 433 | } | 
|  | 434 | } | 
|  | 435 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 436 | if (info->flags & IEEE80211_TX_STAT_TX_FILTERED) { | 
|  | 437 | ieee80211_handle_filtered_frame(local, sta, skb); | 
|  | 438 | rcu_read_unlock(); | 
|  | 439 | return; | 
|  | 440 | } else { | 
| Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 441 | if (!acked) | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 442 | sta->tx_retry_failed++; | 
|  | 443 | sta->tx_retry_count += retry_count; | 
|  | 444 | } | 
|  | 445 |  | 
|  | 446 | rate_control_tx_status(local, sband, sta, skb); | 
|  | 447 | if (ieee80211_vif_is_mesh(&sta->sdata->vif)) | 
|  | 448 | ieee80211s_update_metric(local, sta, skb); | 
| Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 449 |  | 
| Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 450 | if (!(info->flags & IEEE80211_TX_CTL_INJECTED) && acked) | 
| Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 451 | ieee80211_frame_acked(sta, skb); | 
| Johannes Berg | 99ba2a1 | 2010-11-24 08:10:06 +0100 | [diff] [blame] | 452 |  | 
| Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 453 | if ((sta->sdata->vif.type == NL80211_IFTYPE_STATION) && | 
|  | 454 | (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)) | 
|  | 455 | ieee80211_sta_tx_notify(sta->sdata, (void *) skb->data, acked); | 
|  | 456 |  | 
| Johannes Berg | 99ba2a1 | 2010-11-24 08:10:06 +0100 | [diff] [blame] | 457 | if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) { | 
|  | 458 | if (info->flags & IEEE80211_TX_STAT_ACK) { | 
|  | 459 | if (sta->lost_packets) | 
|  | 460 | sta->lost_packets = 0; | 
|  | 461 | } else if (++sta->lost_packets >= STA_LOST_PKT_THRESHOLD) { | 
|  | 462 | cfg80211_cqm_pktloss_notify(sta->sdata->dev, | 
|  | 463 | sta->sta.addr, | 
|  | 464 | sta->lost_packets, | 
|  | 465 | GFP_ATOMIC); | 
|  | 466 | sta->lost_packets = 0; | 
|  | 467 | } | 
|  | 468 | } | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 469 | } | 
|  | 470 |  | 
|  | 471 | rcu_read_unlock(); | 
|  | 472 |  | 
|  | 473 | ieee80211_led_tx(local, 0); | 
|  | 474 |  | 
|  | 475 | /* SNMP counters | 
|  | 476 | * Fragments are passed to low-level drivers as separate skbs, so these | 
|  | 477 | * are actually fragments, not frames. Update frame counters only for | 
|  | 478 | * the first fragment of the frame. */ | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 479 | if (info->flags & IEEE80211_TX_STAT_ACK) { | 
| Helmut Schaa | adf5ace | 2011-12-08 13:11:55 +0100 | [diff] [blame] | 480 | if (ieee80211_is_first_frag(hdr->seq_ctrl)) { | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 481 | local->dot11TransmittedFrameCount++; | 
|  | 482 | if (is_multicast_ether_addr(hdr->addr1)) | 
|  | 483 | local->dot11MulticastTransmittedFrameCount++; | 
|  | 484 | if (retry_count > 0) | 
|  | 485 | local->dot11RetryCount++; | 
|  | 486 | if (retry_count > 1) | 
|  | 487 | local->dot11MultipleRetryCount++; | 
|  | 488 | } | 
|  | 489 |  | 
|  | 490 | /* This counter shall be incremented for an acknowledged MPDU | 
|  | 491 | * with an individual address in the address 1 field or an MPDU | 
|  | 492 | * with a multicast address in the address 1 field of type Data | 
|  | 493 | * or Management. */ | 
|  | 494 | if (!is_multicast_ether_addr(hdr->addr1) || | 
| Helmut Schaa | adf5ace | 2011-12-08 13:11:55 +0100 | [diff] [blame] | 495 | ieee80211_is_data(fc) || | 
|  | 496 | ieee80211_is_mgmt(fc)) | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 497 | local->dot11TransmittedFragmentCount++; | 
|  | 498 | } else { | 
| Helmut Schaa | adf5ace | 2011-12-08 13:11:55 +0100 | [diff] [blame] | 499 | if (ieee80211_is_first_frag(hdr->seq_ctrl)) | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 500 | local->dot11FailedCount++; | 
|  | 501 | } | 
|  | 502 |  | 
| Vivek Natarajan | 375177b | 2010-02-09 14:50:28 +0530 | [diff] [blame] | 503 | if (ieee80211_is_nullfunc(fc) && ieee80211_has_pm(fc) && | 
|  | 504 | (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) && | 
|  | 505 | !(info->flags & IEEE80211_TX_CTL_INJECTED) && | 
|  | 506 | local->ps_sdata && !(local->scanning)) { | 
|  | 507 | if (info->flags & IEEE80211_TX_STAT_ACK) { | 
|  | 508 | local->ps_sdata->u.mgd.flags |= | 
|  | 509 | IEEE80211_STA_NULLFUNC_ACKED; | 
| Vivek Natarajan | 375177b | 2010-02-09 14:50:28 +0530 | [diff] [blame] | 510 | } else | 
|  | 511 | mod_timer(&local->dynamic_ps_timer, jiffies + | 
|  | 512 | msecs_to_jiffies(10)); | 
|  | 513 | } | 
|  | 514 |  | 
| Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 515 | if (info->flags & IEEE80211_TX_INTFL_NL80211_FRAME_TX) { | 
| Johannes Berg | 4334ec8 | 2011-02-02 16:58:06 +0100 | [diff] [blame] | 516 | u64 cookie = (unsigned long)skb; | 
| Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 517 |  | 
| Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 518 | if (ieee80211_is_nullfunc(hdr->frame_control) || | 
|  | 519 | ieee80211_is_qos_nullfunc(hdr->frame_control)) { | 
| Johannes Berg | 8e7c4e4 | 2012-01-20 13:52:36 +0100 | [diff] [blame] | 520 | acked = info->flags & IEEE80211_TX_STAT_ACK; | 
|  | 521 |  | 
| Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 522 | cfg80211_probe_status(skb->dev, hdr->addr1, | 
|  | 523 | cookie, acked, GFP_ATOMIC); | 
|  | 524 | } else { | 
|  | 525 | struct ieee80211_work *wk; | 
| Johannes Berg | 5f16a43 | 2011-02-25 15:36:57 +0100 | [diff] [blame] | 526 |  | 
| Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 527 | rcu_read_lock(); | 
|  | 528 | list_for_each_entry_rcu(wk, &local->work_list, list) { | 
|  | 529 | if (wk->type != IEEE80211_WORK_OFFCHANNEL_TX) | 
|  | 530 | continue; | 
|  | 531 | if (wk->offchan_tx.frame != skb) | 
|  | 532 | continue; | 
|  | 533 | wk->offchan_tx.status = true; | 
|  | 534 | break; | 
|  | 535 | } | 
|  | 536 | rcu_read_unlock(); | 
|  | 537 | if (local->hw_roc_skb_for_status == skb) { | 
|  | 538 | cookie = local->hw_roc_cookie ^ 2; | 
|  | 539 | local->hw_roc_skb_for_status = NULL; | 
|  | 540 | } | 
|  | 541 |  | 
|  | 542 | cfg80211_mgmt_tx_status( | 
|  | 543 | skb->dev, cookie, skb->data, skb->len, | 
|  | 544 | !!(info->flags & IEEE80211_TX_STAT_ACK), | 
|  | 545 | GFP_ATOMIC); | 
|  | 546 | } | 
| Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 547 | } | 
| Jouni Malinen | 026331c | 2010-02-15 12:53:10 +0200 | [diff] [blame] | 548 |  | 
| Johannes Berg | a729cff | 2011-11-06 14:13:34 +0100 | [diff] [blame] | 549 | if (unlikely(info->ack_frame_id)) { | 
|  | 550 | struct sk_buff *ack_skb; | 
|  | 551 | unsigned long flags; | 
|  | 552 |  | 
|  | 553 | spin_lock_irqsave(&local->ack_status_lock, flags); | 
|  | 554 | ack_skb = idr_find(&local->ack_status_frames, | 
|  | 555 | info->ack_frame_id); | 
|  | 556 | if (ack_skb) | 
|  | 557 | idr_remove(&local->ack_status_frames, | 
|  | 558 | info->ack_frame_id); | 
|  | 559 | spin_unlock_irqrestore(&local->ack_status_lock, flags); | 
|  | 560 |  | 
|  | 561 | /* consumes ack_skb */ | 
|  | 562 | if (ack_skb) | 
|  | 563 | skb_complete_wifi_ack(ack_skb, | 
|  | 564 | info->flags & IEEE80211_TX_STAT_ACK); | 
|  | 565 | } | 
|  | 566 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 567 | /* this was a transmitted frame, but now we want to reuse it */ | 
|  | 568 | skb_orphan(skb); | 
|  | 569 |  | 
| Felix Fietkau | eaf5553 | 2010-03-11 16:28:24 +0100 | [diff] [blame] | 570 | /* Need to make a copy before skb->cb gets cleared */ | 
|  | 571 | send_to_cooked = !!(info->flags & IEEE80211_TX_CTL_INJECTED) || | 
| Helmut Schaa | adf5ace | 2011-12-08 13:11:55 +0100 | [diff] [blame] | 572 | !(ieee80211_is_data(fc)); | 
| Felix Fietkau | eaf5553 | 2010-03-11 16:28:24 +0100 | [diff] [blame] | 573 |  | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 574 | /* | 
|  | 575 | * This is a bit racy but we can avoid a lot of work | 
|  | 576 | * with this test... | 
|  | 577 | */ | 
| Felix Fietkau | eaf5553 | 2010-03-11 16:28:24 +0100 | [diff] [blame] | 578 | if (!local->monitors && (!send_to_cooked || !local->cooked_mntrs)) { | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 579 | dev_kfree_skb(skb); | 
|  | 580 | return; | 
|  | 581 | } | 
|  | 582 |  | 
|  | 583 | /* send frame to monitor interfaces now */ | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 584 | rtap_len = ieee80211_tx_radiotap_len(info); | 
|  | 585 | if (WARN_ON_ONCE(skb_headroom(skb) < rtap_len)) { | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 586 | printk(KERN_ERR "ieee80211_tx_status: headroom too small\n"); | 
|  | 587 | dev_kfree_skb(skb); | 
|  | 588 | return; | 
|  | 589 | } | 
| Helmut Schaa | a2fe816 | 2011-10-11 18:08:54 +0200 | [diff] [blame] | 590 | ieee80211_add_tx_radiotap_header(sband, skb, retry_count, rtap_len); | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 591 |  | 
|  | 592 | /* XXX: is this sufficient for BPF? */ | 
|  | 593 | skb_set_mac_header(skb, 0); | 
|  | 594 | skb->ip_summed = CHECKSUM_UNNECESSARY; | 
|  | 595 | skb->pkt_type = PACKET_OTHERHOST; | 
|  | 596 | skb->protocol = htons(ETH_P_802_2); | 
|  | 597 | memset(skb->cb, 0, sizeof(skb->cb)); | 
|  | 598 |  | 
|  | 599 | rcu_read_lock(); | 
|  | 600 | list_for_each_entry_rcu(sdata, &local->interfaces, list) { | 
|  | 601 | if (sdata->vif.type == NL80211_IFTYPE_MONITOR) { | 
| Johannes Berg | 9607e6b | 2009-12-23 13:15:31 +0100 | [diff] [blame] | 602 | if (!ieee80211_sdata_running(sdata)) | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 603 | continue; | 
|  | 604 |  | 
|  | 605 | if ((sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) && | 
| Felix Fietkau | eaf5553 | 2010-03-11 16:28:24 +0100 | [diff] [blame] | 606 | !send_to_cooked) | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 607 | continue; | 
|  | 608 |  | 
|  | 609 | if (prev_dev) { | 
|  | 610 | skb2 = skb_clone(skb, GFP_ATOMIC); | 
|  | 611 | if (skb2) { | 
|  | 612 | skb2->dev = prev_dev; | 
| John W. Linville | 4efe7f5 | 2010-10-07 11:35:40 -0400 | [diff] [blame] | 613 | netif_rx(skb2); | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 614 | } | 
|  | 615 | } | 
|  | 616 |  | 
|  | 617 | prev_dev = sdata->dev; | 
|  | 618 | } | 
|  | 619 | } | 
|  | 620 | if (prev_dev) { | 
|  | 621 | skb->dev = prev_dev; | 
| John W. Linville | 4efe7f5 | 2010-10-07 11:35:40 -0400 | [diff] [blame] | 622 | netif_rx(skb); | 
| Johannes Berg | fe7a5d5 | 2009-11-18 18:42:47 +0100 | [diff] [blame] | 623 | skb = NULL; | 
|  | 624 | } | 
|  | 625 | rcu_read_unlock(); | 
|  | 626 | dev_kfree_skb(skb); | 
|  | 627 | } | 
|  | 628 | EXPORT_SYMBOL(ieee80211_tx_status); | 
| Arik Nemtsov | 8178d38 | 2011-04-18 14:22:28 +0300 | [diff] [blame] | 629 |  | 
|  | 630 | void ieee80211_report_low_ack(struct ieee80211_sta *pubsta, u32 num_packets) | 
|  | 631 | { | 
|  | 632 | struct sta_info *sta = container_of(pubsta, struct sta_info, sta); | 
|  | 633 | cfg80211_cqm_pktloss_notify(sta->sdata->dev, sta->sta.addr, | 
|  | 634 | num_packets, GFP_ATOMIC); | 
|  | 635 | } | 
|  | 636 | EXPORT_SYMBOL(ieee80211_report_low_ack); | 
| Johannes Berg | 6096de7 | 2011-11-04 11:18:10 +0100 | [diff] [blame] | 637 |  | 
|  | 638 | void ieee80211_free_txskb(struct ieee80211_hw *hw, struct sk_buff *skb) | 
|  | 639 | { | 
| Johannes Berg | a729cff | 2011-11-06 14:13:34 +0100 | [diff] [blame] | 640 | struct ieee80211_local *local = hw_to_local(hw); | 
|  | 641 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); | 
|  | 642 |  | 
|  | 643 | if (unlikely(info->ack_frame_id)) { | 
|  | 644 | struct sk_buff *ack_skb; | 
|  | 645 | unsigned long flags; | 
|  | 646 |  | 
|  | 647 | spin_lock_irqsave(&local->ack_status_lock, flags); | 
|  | 648 | ack_skb = idr_find(&local->ack_status_frames, | 
|  | 649 | info->ack_frame_id); | 
|  | 650 | if (ack_skb) | 
|  | 651 | idr_remove(&local->ack_status_frames, | 
|  | 652 | info->ack_frame_id); | 
|  | 653 | spin_unlock_irqrestore(&local->ack_status_lock, flags); | 
|  | 654 |  | 
|  | 655 | /* consumes ack_skb */ | 
|  | 656 | if (ack_skb) | 
|  | 657 | dev_kfree_skb_any(ack_skb); | 
|  | 658 | } | 
|  | 659 |  | 
| Johannes Berg | 6096de7 | 2011-11-04 11:18:10 +0100 | [diff] [blame] | 660 | dev_kfree_skb_any(skb); | 
|  | 661 | } | 
|  | 662 | EXPORT_SYMBOL(ieee80211_free_txskb); |