1 /* 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-2010 Johannes Berg <johannes@sipsolutions.net> 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 12 #include <net/mac80211.h> 13 #include "ieee80211_i.h" 14 #include "rate.h" 15 #include "mesh.h" 16 #include "led.h" 17 18 19 void ieee80211_tx_status_irqsafe(struct ieee80211_hw *hw, 20 struct sk_buff *skb) 21 { 22 struct ieee80211_local *local = hw_to_local(hw); 23 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 24 int tmp; 25 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); 34 tmp--; 35 I802_DEBUG_INC(local->tx_status_drop); 36 } 37 tasklet_schedule(&local->tasklet); 38 } 39 EXPORT_SYMBOL(ieee80211_tx_status_irqsafe); 40 41 static void ieee80211_handle_filtered_frame(struct ieee80211_local *local, 42 struct sta_info *sta, 43 struct sk_buff *skb) 44 { 45 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 46 47 /* 48 * This skb 'survived' a round-trip through the driver, and 49 * hopefully the driver didn't mangle it too badly. However, 50 * we can definitely not rely on the control information 51 * being correct. Clear it so we don't get junk there, and 52 * indicate that it needs new processing, but must not be 53 * modified/encrypted again. 54 */ 55 memset(&info->control, 0, sizeof(info->control)); 56 57 info->control.jiffies = jiffies; 58 info->control.vif = &sta->sdata->vif; 59 info->flags |= IEEE80211_TX_INTFL_NEED_TXPROCESSING | 60 IEEE80211_TX_INTFL_RETRANSMISSION; 61 info->flags &= ~IEEE80211_TX_TEMPORARY_FLAGS; 62 63 sta->tx_filtered_count++; 64 65 /* 66 * Clear the TX filter mask for this STA when sending the next 67 * packet. If the STA went to power save mode, this will happen 68 * when it wakes up for the next time. 69 */ 70 set_sta_flags(sta, WLAN_STA_CLEAR_PS_FILT); 71 72 /* 73 * This code races in the following way: 74 * 75 * (1) STA sends frame indicating it will go to sleep and does so 76 * (2) hardware/firmware adds STA to filter list, passes frame up 77 * (3) hardware/firmware processes TX fifo and suppresses a frame 78 * (4) we get TX status before having processed the frame and 79 * knowing that the STA has gone to sleep. 80 * 81 * This is actually quite unlikely even when both those events are 82 * processed from interrupts coming in quickly after one another or 83 * even at the same time because we queue both TX status events and 84 * RX frames to be processed by a tasklet and process them in the 85 * same order that they were received or TX status last. Hence, there 86 * is no race as long as the frame RX is processed before the next TX 87 * status, which drivers can ensure, see below. 88 * 89 * Note that this can only happen if the hardware or firmware can 90 * actually add STAs to the filter list, if this is done by the 91 * driver in response to set_tim() (which will only reduce the race 92 * this whole filtering tries to solve, not completely solve it) 93 * this situation cannot happen. 94 * 95 * To completely solve this race drivers need to make sure that they 96 * (a) don't mix the irq-safe/not irq-safe TX status/RX processing 97 * functions and 98 * (b) always process RX events before TX status events if ordering 99 * can be unknown, for example with different interrupt status 100 * bits. 101 * (c) if PS mode transitions are manual (i.e. the flag 102 * %IEEE80211_HW_AP_LINK_PS is set), always process PS state 103 * changes before calling TX status events if ordering can be 104 * unknown. 105 */ 106 if (test_sta_flags(sta, WLAN_STA_PS_STA) && 107 skb_queue_len(&sta->tx_filtered) < STA_MAX_TX_BUFFER) { 108 skb_queue_tail(&sta->tx_filtered, skb); 109 return; 110 } 111 112 if (!test_sta_flags(sta, WLAN_STA_PS_STA) && 113 !(info->flags & IEEE80211_TX_INTFL_RETRIED)) { 114 /* Software retry the packet once */ 115 info->flags |= IEEE80211_TX_INTFL_RETRIED; 116 ieee80211_add_pending_skb(local, skb); 117 return; 118 } 119 120 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 121 if (net_ratelimit()) 122 wiphy_debug(local->hw.wiphy, 123 "dropped TX filtered frame, queue_len=%d PS=%d @%lu\n", 124 skb_queue_len(&sta->tx_filtered), 125 !!test_sta_flags(sta, WLAN_STA_PS_STA), jiffies); 126 #endif 127 dev_kfree_skb(skb); 128 } 129 130 static void ieee80211_frame_acked(struct sta_info *sta, struct sk_buff *skb) 131 { 132 struct ieee80211_mgmt *mgmt = (void *) skb->data; 133 struct ieee80211_local *local = sta->local; 134 struct ieee80211_sub_if_data *sdata = sta->sdata; 135 136 if (ieee80211_is_action(mgmt->frame_control) && 137 sdata->vif.type == NL80211_IFTYPE_STATION && 138 mgmt->u.action.category == WLAN_CATEGORY_HT && 139 mgmt->u.action.u.ht_smps.action == WLAN_HT_ACTION_SMPS) { 140 /* 141 * This update looks racy, but isn't -- if we come 142 * here we've definitely got a station that we're 143 * talking to, and on a managed interface that can 144 * only be the AP. And the only other place updating 145 * this variable is before we're associated. 146 */ 147 switch (mgmt->u.action.u.ht_smps.smps_control) { 148 case WLAN_HT_SMPS_CONTROL_DYNAMIC: 149 sta->sdata->u.mgd.ap_smps = IEEE80211_SMPS_DYNAMIC; 150 break; 151 case WLAN_HT_SMPS_CONTROL_STATIC: 152 sta->sdata->u.mgd.ap_smps = IEEE80211_SMPS_STATIC; 153 break; 154 case WLAN_HT_SMPS_CONTROL_DISABLED: 155 default: /* shouldn't happen since we don't send that */ 156 sta->sdata->u.mgd.ap_smps = IEEE80211_SMPS_OFF; 157 break; 158 } 159 160 ieee80211_queue_work(&local->hw, &local->recalc_smps); 161 } 162 } 163 164 /* 165 * Use a static threshold for now, best value to be determined 166 * by testing ... 167 * Should it depend on: 168 * - on # of retransmissions 169 * - current throughput (higher value for higher tpt)? 170 */ 171 #define STA_LOST_PKT_THRESHOLD 50 172 173 void ieee80211_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb) 174 { 175 struct sk_buff *skb2; 176 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; 177 struct ieee80211_local *local = hw_to_local(hw); 178 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 179 u16 frag, type; 180 __le16 fc; 181 struct ieee80211_supported_band *sband; 182 struct ieee80211_tx_status_rtap_hdr *rthdr; 183 struct ieee80211_sub_if_data *sdata; 184 struct net_device *prev_dev = NULL; 185 struct sta_info *sta, *tmp; 186 int retry_count = -1, i; 187 int rates_idx = -1; 188 bool send_to_cooked; 189 bool acked; 190 191 for (i = 0; i < IEEE80211_TX_MAX_RATES; i++) { 192 if (info->status.rates[i].idx < 0) { 193 break; 194 } else if (i >= hw->max_report_rates) { 195 /* the HW cannot have attempted that rate */ 196 info->status.rates[i].idx = -1; 197 info->status.rates[i].count = 0; 198 break; 199 } 200 201 retry_count += info->status.rates[i].count; 202 } 203 rates_idx = i - 1; 204 205 if (retry_count < 0) 206 retry_count = 0; 207 208 rcu_read_lock(); 209 210 sband = local->hw.wiphy->bands[info->band]; 211 fc = hdr->frame_control; 212 213 for_each_sta_info(local, hdr->addr1, sta, tmp) { 214 /* skip wrong virtual interface */ 215 if (memcmp(hdr->addr2, sta->sdata->vif.addr, ETH_ALEN)) 216 continue; 217 218 acked = !!(info->flags & IEEE80211_TX_STAT_ACK); 219 if (!acked && test_sta_flags(sta, WLAN_STA_PS_STA)) { 220 /* 221 * The STA is in power save mode, so assume 222 * that this TX packet failed because of that. 223 */ 224 ieee80211_handle_filtered_frame(local, sta, skb); 225 rcu_read_unlock(); 226 return; 227 } 228 229 if ((local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL) && 230 (rates_idx != -1)) 231 sta->last_tx_rate = info->status.rates[rates_idx]; 232 233 if ((info->flags & IEEE80211_TX_STAT_AMPDU_NO_BACK) && 234 (ieee80211_is_data_qos(fc))) { 235 u16 tid, ssn; 236 u8 *qc; 237 238 qc = ieee80211_get_qos_ctl(hdr); 239 tid = qc[0] & 0xf; 240 ssn = ((le16_to_cpu(hdr->seq_ctrl) + 0x10) 241 & IEEE80211_SCTL_SEQ); 242 ieee80211_send_bar(sta->sdata, hdr->addr1, 243 tid, ssn); 244 } 245 246 if (info->flags & IEEE80211_TX_STAT_TX_FILTERED) { 247 ieee80211_handle_filtered_frame(local, sta, skb); 248 rcu_read_unlock(); 249 return; 250 } else { 251 if (!acked) 252 sta->tx_retry_failed++; 253 sta->tx_retry_count += retry_count; 254 } 255 256 rate_control_tx_status(local, sband, sta, skb); 257 if (ieee80211_vif_is_mesh(&sta->sdata->vif)) 258 ieee80211s_update_metric(local, sta, skb); 259 260 if (!(info->flags & IEEE80211_TX_CTL_INJECTED) && acked) 261 ieee80211_frame_acked(sta, skb); 262 263 if ((sta->sdata->vif.type == NL80211_IFTYPE_STATION) && 264 (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)) 265 ieee80211_sta_tx_notify(sta->sdata, (void *) skb->data, acked); 266 267 if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) { 268 if (info->flags & IEEE80211_TX_STAT_ACK) { 269 if (sta->lost_packets) 270 sta->lost_packets = 0; 271 } else if (++sta->lost_packets >= STA_LOST_PKT_THRESHOLD) { 272 cfg80211_cqm_pktloss_notify(sta->sdata->dev, 273 sta->sta.addr, 274 sta->lost_packets, 275 GFP_ATOMIC); 276 sta->lost_packets = 0; 277 } 278 } 279 } 280 281 rcu_read_unlock(); 282 283 ieee80211_led_tx(local, 0); 284 285 /* SNMP counters 286 * Fragments are passed to low-level drivers as separate skbs, so these 287 * are actually fragments, not frames. Update frame counters only for 288 * the first fragment of the frame. */ 289 290 frag = le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG; 291 type = le16_to_cpu(hdr->frame_control) & IEEE80211_FCTL_FTYPE; 292 293 if (info->flags & IEEE80211_TX_STAT_ACK) { 294 if (frag == 0) { 295 local->dot11TransmittedFrameCount++; 296 if (is_multicast_ether_addr(hdr->addr1)) 297 local->dot11MulticastTransmittedFrameCount++; 298 if (retry_count > 0) 299 local->dot11RetryCount++; 300 if (retry_count > 1) 301 local->dot11MultipleRetryCount++; 302 } 303 304 /* This counter shall be incremented for an acknowledged MPDU 305 * with an individual address in the address 1 field or an MPDU 306 * with a multicast address in the address 1 field of type Data 307 * or Management. */ 308 if (!is_multicast_ether_addr(hdr->addr1) || 309 type == IEEE80211_FTYPE_DATA || 310 type == IEEE80211_FTYPE_MGMT) 311 local->dot11TransmittedFragmentCount++; 312 } else { 313 if (frag == 0) 314 local->dot11FailedCount++; 315 } 316 317 if (ieee80211_is_nullfunc(fc) && ieee80211_has_pm(fc) && 318 (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) && 319 !(info->flags & IEEE80211_TX_CTL_INJECTED) && 320 local->ps_sdata && !(local->scanning)) { 321 if (info->flags & IEEE80211_TX_STAT_ACK) { 322 local->ps_sdata->u.mgd.flags |= 323 IEEE80211_STA_NULLFUNC_ACKED; 324 } else 325 mod_timer(&local->dynamic_ps_timer, jiffies + 326 msecs_to_jiffies(10)); 327 } 328 329 if (info->flags & IEEE80211_TX_INTFL_NL80211_FRAME_TX) { 330 struct ieee80211_work *wk; 331 u64 cookie = (unsigned long)skb; 332 333 rcu_read_lock(); 334 list_for_each_entry_rcu(wk, &local->work_list, list) { 335 if (wk->type != IEEE80211_WORK_OFFCHANNEL_TX) 336 continue; 337 if (wk->offchan_tx.frame != skb) 338 continue; 339 wk->offchan_tx.frame = NULL; 340 break; 341 } 342 rcu_read_unlock(); 343 if (local->hw_roc_skb_for_status == skb) { 344 cookie = local->hw_roc_cookie ^ 2; 345 local->hw_roc_skb_for_status = NULL; 346 } 347 348 if (cookie == local->hw_offchan_tx_cookie) 349 local->hw_offchan_tx_cookie = 0; 350 351 cfg80211_mgmt_tx_status( 352 skb->dev, cookie, skb->data, skb->len, 353 !!(info->flags & IEEE80211_TX_STAT_ACK), GFP_ATOMIC); 354 } 355 356 /* this was a transmitted frame, but now we want to reuse it */ 357 skb_orphan(skb); 358 359 /* Need to make a copy before skb->cb gets cleared */ 360 send_to_cooked = !!(info->flags & IEEE80211_TX_CTL_INJECTED) || 361 (type != IEEE80211_FTYPE_DATA); 362 363 /* 364 * This is a bit racy but we can avoid a lot of work 365 * with this test... 366 */ 367 if (!local->monitors && (!send_to_cooked || !local->cooked_mntrs)) { 368 dev_kfree_skb(skb); 369 return; 370 } 371 372 /* send frame to monitor interfaces now */ 373 374 if (skb_headroom(skb) < sizeof(*rthdr)) { 375 printk(KERN_ERR "ieee80211_tx_status: headroom too small\n"); 376 dev_kfree_skb(skb); 377 return; 378 } 379 380 rthdr = (struct ieee80211_tx_status_rtap_hdr *) 381 skb_push(skb, sizeof(*rthdr)); 382 383 memset(rthdr, 0, sizeof(*rthdr)); 384 rthdr->hdr.it_len = cpu_to_le16(sizeof(*rthdr)); 385 rthdr->hdr.it_present = 386 cpu_to_le32((1 << IEEE80211_RADIOTAP_TX_FLAGS) | 387 (1 << IEEE80211_RADIOTAP_DATA_RETRIES) | 388 (1 << IEEE80211_RADIOTAP_RATE)); 389 390 if (!(info->flags & IEEE80211_TX_STAT_ACK) && 391 !is_multicast_ether_addr(hdr->addr1)) 392 rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_FAIL); 393 394 /* 395 * XXX: Once radiotap gets the bitmap reset thing the vendor 396 * extensions proposal contains, we can actually report 397 * the whole set of tries we did. 398 */ 399 if ((info->status.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS) || 400 (info->status.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT)) 401 rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_CTS); 402 else if (info->status.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS) 403 rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_RTS); 404 if (info->status.rates[0].idx >= 0 && 405 !(info->status.rates[0].flags & IEEE80211_TX_RC_MCS)) 406 rthdr->rate = sband->bitrates[ 407 info->status.rates[0].idx].bitrate / 5; 408 409 /* for now report the total retry_count */ 410 rthdr->data_retries = retry_count; 411 412 /* XXX: is this sufficient for BPF? */ 413 skb_set_mac_header(skb, 0); 414 skb->ip_summed = CHECKSUM_UNNECESSARY; 415 skb->pkt_type = PACKET_OTHERHOST; 416 skb->protocol = htons(ETH_P_802_2); 417 memset(skb->cb, 0, sizeof(skb->cb)); 418 419 rcu_read_lock(); 420 list_for_each_entry_rcu(sdata, &local->interfaces, list) { 421 if (sdata->vif.type == NL80211_IFTYPE_MONITOR) { 422 if (!ieee80211_sdata_running(sdata)) 423 continue; 424 425 if ((sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) && 426 !send_to_cooked) 427 continue; 428 429 if (prev_dev) { 430 skb2 = skb_clone(skb, GFP_ATOMIC); 431 if (skb2) { 432 skb2->dev = prev_dev; 433 netif_rx(skb2); 434 } 435 } 436 437 prev_dev = sdata->dev; 438 } 439 } 440 if (prev_dev) { 441 skb->dev = prev_dev; 442 netif_rx(skb); 443 skb = NULL; 444 } 445 rcu_read_unlock(); 446 dev_kfree_skb(skb); 447 } 448 EXPORT_SYMBOL(ieee80211_tx_status); 449 450 void ieee80211_report_low_ack(struct ieee80211_sta *pubsta, u32 num_packets) 451 { 452 struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 453 cfg80211_cqm_pktloss_notify(sta->sdata->dev, sta->sta.addr, 454 num_packets, GFP_ATOMIC); 455 } 456 EXPORT_SYMBOL(ieee80211_report_low_ack); 457