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