diff options
Diffstat (limited to 'net/mac80211/main.c')
-rw-r--r-- | net/mac80211/main.c | 1889 |
1 files changed, 1889 insertions, 0 deletions
diff --git a/net/mac80211/main.c b/net/mac80211/main.c new file mode 100644 index 000000000000..bfcbcf5353ad --- /dev/null +++ b/net/mac80211/main.c | |||
@@ -0,0 +1,1889 @@ | |||
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 | * | ||
6 | * This program is free software; you can redistribute it and/or modify | ||
7 | * it under the terms of the GNU General Public License version 2 as | ||
8 | * published by the Free Software Foundation. | ||
9 | */ | ||
10 | |||
11 | #include <net/mac80211.h> | ||
12 | #include <net/ieee80211_radiotap.h> | ||
13 | #include <linux/module.h> | ||
14 | #include <linux/init.h> | ||
15 | #include <linux/netdevice.h> | ||
16 | #include <linux/types.h> | ||
17 | #include <linux/slab.h> | ||
18 | #include <linux/skbuff.h> | ||
19 | #include <linux/etherdevice.h> | ||
20 | #include <linux/if_arp.h> | ||
21 | #include <linux/wireless.h> | ||
22 | #include <linux/rtnetlink.h> | ||
23 | #include <linux/bitmap.h> | ||
24 | #include <net/net_namespace.h> | ||
25 | #include <net/cfg80211.h> | ||
26 | |||
27 | #include "ieee80211_i.h" | ||
28 | #include "rate.h" | ||
29 | #include "mesh.h" | ||
30 | #include "wep.h" | ||
31 | #include "wme.h" | ||
32 | #include "aes_ccm.h" | ||
33 | #include "led.h" | ||
34 | #include "cfg.h" | ||
35 | #include "debugfs.h" | ||
36 | #include "debugfs_netdev.h" | ||
37 | |||
38 | #define SUPP_MCS_SET_LEN 16 | ||
39 | |||
40 | /* | ||
41 | * For seeing transmitted packets on monitor interfaces | ||
42 | * we have a radiotap header too. | ||
43 | */ | ||
44 | struct ieee80211_tx_status_rtap_hdr { | ||
45 | struct ieee80211_radiotap_header hdr; | ||
46 | __le16 tx_flags; | ||
47 | u8 data_retries; | ||
48 | } __attribute__ ((packed)); | ||
49 | |||
50 | /* common interface routines */ | ||
51 | |||
52 | static int header_parse_80211(const struct sk_buff *skb, unsigned char *haddr) | ||
53 | { | ||
54 | memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN); /* addr2 */ | ||
55 | return ETH_ALEN; | ||
56 | } | ||
57 | |||
58 | /* must be called under mdev tx lock */ | ||
59 | static void ieee80211_configure_filter(struct ieee80211_local *local) | ||
60 | { | ||
61 | unsigned int changed_flags; | ||
62 | unsigned int new_flags = 0; | ||
63 | |||
64 | if (atomic_read(&local->iff_promiscs)) | ||
65 | new_flags |= FIF_PROMISC_IN_BSS; | ||
66 | |||
67 | if (atomic_read(&local->iff_allmultis)) | ||
68 | new_flags |= FIF_ALLMULTI; | ||
69 | |||
70 | if (local->monitors) | ||
71 | new_flags |= FIF_BCN_PRBRESP_PROMISC; | ||
72 | |||
73 | if (local->fif_fcsfail) | ||
74 | new_flags |= FIF_FCSFAIL; | ||
75 | |||
76 | if (local->fif_plcpfail) | ||
77 | new_flags |= FIF_PLCPFAIL; | ||
78 | |||
79 | if (local->fif_control) | ||
80 | new_flags |= FIF_CONTROL; | ||
81 | |||
82 | if (local->fif_other_bss) | ||
83 | new_flags |= FIF_OTHER_BSS; | ||
84 | |||
85 | changed_flags = local->filter_flags ^ new_flags; | ||
86 | |||
87 | /* be a bit nasty */ | ||
88 | new_flags |= (1<<31); | ||
89 | |||
90 | local->ops->configure_filter(local_to_hw(local), | ||
91 | changed_flags, &new_flags, | ||
92 | local->mdev->mc_count, | ||
93 | local->mdev->mc_list); | ||
94 | |||
95 | WARN_ON(new_flags & (1<<31)); | ||
96 | |||
97 | local->filter_flags = new_flags & ~(1<<31); | ||
98 | } | ||
99 | |||
100 | /* master interface */ | ||
101 | |||
102 | static int ieee80211_master_open(struct net_device *dev) | ||
103 | { | ||
104 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
105 | struct ieee80211_sub_if_data *sdata; | ||
106 | int res = -EOPNOTSUPP; | ||
107 | |||
108 | /* we hold the RTNL here so can safely walk the list */ | ||
109 | list_for_each_entry(sdata, &local->interfaces, list) { | ||
110 | if (sdata->dev != dev && netif_running(sdata->dev)) { | ||
111 | res = 0; | ||
112 | break; | ||
113 | } | ||
114 | } | ||
115 | return res; | ||
116 | } | ||
117 | |||
118 | static int ieee80211_master_stop(struct net_device *dev) | ||
119 | { | ||
120 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
121 | struct ieee80211_sub_if_data *sdata; | ||
122 | |||
123 | /* we hold the RTNL here so can safely walk the list */ | ||
124 | list_for_each_entry(sdata, &local->interfaces, list) | ||
125 | if (sdata->dev != dev && netif_running(sdata->dev)) | ||
126 | dev_close(sdata->dev); | ||
127 | |||
128 | return 0; | ||
129 | } | ||
130 | |||
131 | static void ieee80211_master_set_multicast_list(struct net_device *dev) | ||
132 | { | ||
133 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
134 | |||
135 | ieee80211_configure_filter(local); | ||
136 | } | ||
137 | |||
138 | /* regular interfaces */ | ||
139 | |||
140 | static int ieee80211_change_mtu(struct net_device *dev, int new_mtu) | ||
141 | { | ||
142 | int meshhdrlen; | ||
143 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
144 | |||
145 | meshhdrlen = (sdata->vif.type == IEEE80211_IF_TYPE_MESH_POINT) ? 5 : 0; | ||
146 | |||
147 | /* FIX: what would be proper limits for MTU? | ||
148 | * This interface uses 802.3 frames. */ | ||
149 | if (new_mtu < 256 || | ||
150 | new_mtu > IEEE80211_MAX_DATA_LEN - 24 - 6 - meshhdrlen) { | ||
151 | printk(KERN_WARNING "%s: invalid MTU %d\n", | ||
152 | dev->name, new_mtu); | ||
153 | return -EINVAL; | ||
154 | } | ||
155 | |||
156 | #ifdef CONFIG_MAC80211_VERBOSE_DEBUG | ||
157 | printk(KERN_DEBUG "%s: setting MTU %d\n", dev->name, new_mtu); | ||
158 | #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ | ||
159 | dev->mtu = new_mtu; | ||
160 | return 0; | ||
161 | } | ||
162 | |||
163 | static inline int identical_mac_addr_allowed(int type1, int type2) | ||
164 | { | ||
165 | return (type1 == IEEE80211_IF_TYPE_MNTR || | ||
166 | type2 == IEEE80211_IF_TYPE_MNTR || | ||
167 | (type1 == IEEE80211_IF_TYPE_AP && | ||
168 | type2 == IEEE80211_IF_TYPE_WDS) || | ||
169 | (type1 == IEEE80211_IF_TYPE_WDS && | ||
170 | (type2 == IEEE80211_IF_TYPE_WDS || | ||
171 | type2 == IEEE80211_IF_TYPE_AP)) || | ||
172 | (type1 == IEEE80211_IF_TYPE_AP && | ||
173 | type2 == IEEE80211_IF_TYPE_VLAN) || | ||
174 | (type1 == IEEE80211_IF_TYPE_VLAN && | ||
175 | (type2 == IEEE80211_IF_TYPE_AP || | ||
176 | type2 == IEEE80211_IF_TYPE_VLAN))); | ||
177 | } | ||
178 | |||
179 | static int ieee80211_open(struct net_device *dev) | ||
180 | { | ||
181 | struct ieee80211_sub_if_data *sdata, *nsdata; | ||
182 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
183 | struct ieee80211_if_init_conf conf; | ||
184 | int res; | ||
185 | bool need_hw_reconfig = 0; | ||
186 | struct sta_info *sta; | ||
187 | |||
188 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
189 | |||
190 | /* we hold the RTNL here so can safely walk the list */ | ||
191 | list_for_each_entry(nsdata, &local->interfaces, list) { | ||
192 | struct net_device *ndev = nsdata->dev; | ||
193 | |||
194 | if (ndev != dev && ndev != local->mdev && netif_running(ndev)) { | ||
195 | /* | ||
196 | * Allow only a single IBSS interface to be up at any | ||
197 | * time. This is restricted because beacon distribution | ||
198 | * cannot work properly if both are in the same IBSS. | ||
199 | * | ||
200 | * To remove this restriction we'd have to disallow them | ||
201 | * from setting the same SSID on different IBSS interfaces | ||
202 | * belonging to the same hardware. Then, however, we're | ||
203 | * faced with having to adopt two different TSF timers... | ||
204 | */ | ||
205 | if (sdata->vif.type == IEEE80211_IF_TYPE_IBSS && | ||
206 | nsdata->vif.type == IEEE80211_IF_TYPE_IBSS) | ||
207 | return -EBUSY; | ||
208 | |||
209 | /* | ||
210 | * Disallow multiple IBSS/STA mode interfaces. | ||
211 | * | ||
212 | * This is a technical restriction, it is possible although | ||
213 | * most likely not IEEE 802.11 compliant to have multiple | ||
214 | * STAs with just a single hardware (the TSF timer will not | ||
215 | * be adjusted properly.) | ||
216 | * | ||
217 | * However, because mac80211 uses the master device's BSS | ||
218 | * information for each STA/IBSS interface, doing this will | ||
219 | * currently corrupt that BSS information completely, unless, | ||
220 | * a not very useful case, both STAs are associated to the | ||
221 | * same BSS. | ||
222 | * | ||
223 | * To remove this restriction, the BSS information needs to | ||
224 | * be embedded in the STA/IBSS mode sdata instead of using | ||
225 | * the master device's BSS structure. | ||
226 | */ | ||
227 | if ((sdata->vif.type == IEEE80211_IF_TYPE_STA || | ||
228 | sdata->vif.type == IEEE80211_IF_TYPE_IBSS) && | ||
229 | (nsdata->vif.type == IEEE80211_IF_TYPE_STA || | ||
230 | nsdata->vif.type == IEEE80211_IF_TYPE_IBSS)) | ||
231 | return -EBUSY; | ||
232 | |||
233 | /* | ||
234 | * The remaining checks are only performed for interfaces | ||
235 | * with the same MAC address. | ||
236 | */ | ||
237 | if (compare_ether_addr(dev->dev_addr, ndev->dev_addr)) | ||
238 | continue; | ||
239 | |||
240 | /* | ||
241 | * check whether it may have the same address | ||
242 | */ | ||
243 | if (!identical_mac_addr_allowed(sdata->vif.type, | ||
244 | nsdata->vif.type)) | ||
245 | return -ENOTUNIQ; | ||
246 | |||
247 | /* | ||
248 | * can only add VLANs to enabled APs | ||
249 | */ | ||
250 | if (sdata->vif.type == IEEE80211_IF_TYPE_VLAN && | ||
251 | nsdata->vif.type == IEEE80211_IF_TYPE_AP) | ||
252 | sdata->u.vlan.ap = nsdata; | ||
253 | } | ||
254 | } | ||
255 | |||
256 | switch (sdata->vif.type) { | ||
257 | case IEEE80211_IF_TYPE_WDS: | ||
258 | if (is_zero_ether_addr(sdata->u.wds.remote_addr)) | ||
259 | return -ENOLINK; | ||
260 | |||
261 | /* Create STA entry for the WDS peer */ | ||
262 | sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr, | ||
263 | GFP_KERNEL); | ||
264 | if (!sta) | ||
265 | return -ENOMEM; | ||
266 | |||
267 | sta->flags |= WLAN_STA_AUTHORIZED; | ||
268 | |||
269 | res = sta_info_insert(sta); | ||
270 | if (res) { | ||
271 | /* STA has been freed */ | ||
272 | return res; | ||
273 | } | ||
274 | break; | ||
275 | case IEEE80211_IF_TYPE_VLAN: | ||
276 | if (!sdata->u.vlan.ap) | ||
277 | return -ENOLINK; | ||
278 | break; | ||
279 | case IEEE80211_IF_TYPE_AP: | ||
280 | case IEEE80211_IF_TYPE_STA: | ||
281 | case IEEE80211_IF_TYPE_MNTR: | ||
282 | case IEEE80211_IF_TYPE_IBSS: | ||
283 | case IEEE80211_IF_TYPE_MESH_POINT: | ||
284 | /* no special treatment */ | ||
285 | break; | ||
286 | case IEEE80211_IF_TYPE_INVALID: | ||
287 | /* cannot happen */ | ||
288 | WARN_ON(1); | ||
289 | break; | ||
290 | } | ||
291 | |||
292 | if (local->open_count == 0) { | ||
293 | res = 0; | ||
294 | if (local->ops->start) | ||
295 | res = local->ops->start(local_to_hw(local)); | ||
296 | if (res) | ||
297 | return res; | ||
298 | need_hw_reconfig = 1; | ||
299 | ieee80211_led_radio(local, local->hw.conf.radio_enabled); | ||
300 | } | ||
301 | |||
302 | switch (sdata->vif.type) { | ||
303 | case IEEE80211_IF_TYPE_VLAN: | ||
304 | list_add(&sdata->u.vlan.list, &sdata->u.vlan.ap->u.ap.vlans); | ||
305 | /* no need to tell driver */ | ||
306 | break; | ||
307 | case IEEE80211_IF_TYPE_MNTR: | ||
308 | if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) { | ||
309 | local->cooked_mntrs++; | ||
310 | break; | ||
311 | } | ||
312 | |||
313 | /* must be before the call to ieee80211_configure_filter */ | ||
314 | local->monitors++; | ||
315 | if (local->monitors == 1) | ||
316 | local->hw.conf.flags |= IEEE80211_CONF_RADIOTAP; | ||
317 | |||
318 | if (sdata->u.mntr_flags & MONITOR_FLAG_FCSFAIL) | ||
319 | local->fif_fcsfail++; | ||
320 | if (sdata->u.mntr_flags & MONITOR_FLAG_PLCPFAIL) | ||
321 | local->fif_plcpfail++; | ||
322 | if (sdata->u.mntr_flags & MONITOR_FLAG_CONTROL) | ||
323 | local->fif_control++; | ||
324 | if (sdata->u.mntr_flags & MONITOR_FLAG_OTHER_BSS) | ||
325 | local->fif_other_bss++; | ||
326 | |||
327 | netif_tx_lock_bh(local->mdev); | ||
328 | ieee80211_configure_filter(local); | ||
329 | netif_tx_unlock_bh(local->mdev); | ||
330 | break; | ||
331 | case IEEE80211_IF_TYPE_STA: | ||
332 | case IEEE80211_IF_TYPE_IBSS: | ||
333 | sdata->u.sta.flags &= ~IEEE80211_STA_PREV_BSSID_SET; | ||
334 | /* fall through */ | ||
335 | default: | ||
336 | conf.vif = &sdata->vif; | ||
337 | conf.type = sdata->vif.type; | ||
338 | conf.mac_addr = dev->dev_addr; | ||
339 | res = local->ops->add_interface(local_to_hw(local), &conf); | ||
340 | if (res && !local->open_count && local->ops->stop) | ||
341 | local->ops->stop(local_to_hw(local)); | ||
342 | if (res) | ||
343 | return res; | ||
344 | |||
345 | ieee80211_if_config(dev); | ||
346 | ieee80211_reset_erp_info(dev); | ||
347 | ieee80211_enable_keys(sdata); | ||
348 | |||
349 | if (sdata->vif.type == IEEE80211_IF_TYPE_STA && | ||
350 | !(sdata->flags & IEEE80211_SDATA_USERSPACE_MLME)) | ||
351 | netif_carrier_off(dev); | ||
352 | else | ||
353 | netif_carrier_on(dev); | ||
354 | } | ||
355 | |||
356 | if (local->open_count == 0) { | ||
357 | res = dev_open(local->mdev); | ||
358 | WARN_ON(res); | ||
359 | tasklet_enable(&local->tx_pending_tasklet); | ||
360 | tasklet_enable(&local->tasklet); | ||
361 | } | ||
362 | |||
363 | /* | ||
364 | * set_multicast_list will be invoked by the networking core | ||
365 | * which will check whether any increments here were done in | ||
366 | * error and sync them down to the hardware as filter flags. | ||
367 | */ | ||
368 | if (sdata->flags & IEEE80211_SDATA_ALLMULTI) | ||
369 | atomic_inc(&local->iff_allmultis); | ||
370 | |||
371 | if (sdata->flags & IEEE80211_SDATA_PROMISC) | ||
372 | atomic_inc(&local->iff_promiscs); | ||
373 | |||
374 | local->open_count++; | ||
375 | if (need_hw_reconfig) | ||
376 | ieee80211_hw_config(local); | ||
377 | |||
378 | /* | ||
379 | * ieee80211_sta_work is disabled while network interface | ||
380 | * is down. Therefore, some configuration changes may not | ||
381 | * yet be effective. Trigger execution of ieee80211_sta_work | ||
382 | * to fix this. | ||
383 | */ | ||
384 | if(sdata->vif.type == IEEE80211_IF_TYPE_STA || | ||
385 | sdata->vif.type == IEEE80211_IF_TYPE_IBSS) { | ||
386 | struct ieee80211_if_sta *ifsta = &sdata->u.sta; | ||
387 | queue_work(local->hw.workqueue, &ifsta->work); | ||
388 | } | ||
389 | |||
390 | netif_start_queue(dev); | ||
391 | |||
392 | return 0; | ||
393 | } | ||
394 | |||
395 | static int ieee80211_stop(struct net_device *dev) | ||
396 | { | ||
397 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
398 | struct ieee80211_local *local = sdata->local; | ||
399 | struct ieee80211_if_init_conf conf; | ||
400 | struct sta_info *sta; | ||
401 | |||
402 | /* | ||
403 | * Stop TX on this interface first. | ||
404 | */ | ||
405 | netif_stop_queue(dev); | ||
406 | |||
407 | /* | ||
408 | * Now delete all active aggregation sessions. | ||
409 | */ | ||
410 | rcu_read_lock(); | ||
411 | |||
412 | list_for_each_entry_rcu(sta, &local->sta_list, list) { | ||
413 | if (sta->sdata == sdata) | ||
414 | ieee80211_sta_tear_down_BA_sessions(dev, sta->addr); | ||
415 | } | ||
416 | |||
417 | rcu_read_unlock(); | ||
418 | |||
419 | /* | ||
420 | * Remove all stations associated with this interface. | ||
421 | * | ||
422 | * This must be done before calling ops->remove_interface() | ||
423 | * because otherwise we can later invoke ops->sta_notify() | ||
424 | * whenever the STAs are removed, and that invalidates driver | ||
425 | * assumptions about always getting a vif pointer that is valid | ||
426 | * (because if we remove a STA after ops->remove_interface() | ||
427 | * the driver will have removed the vif info already!) | ||
428 | * | ||
429 | * We could relax this and only unlink the stations from the | ||
430 | * hash table and list but keep them on a per-sdata list that | ||
431 | * will be inserted back again when the interface is brought | ||
432 | * up again, but I don't currently see a use case for that, | ||
433 | * except with WDS which gets a STA entry created when it is | ||
434 | * brought up. | ||
435 | */ | ||
436 | sta_info_flush(local, sdata); | ||
437 | |||
438 | /* | ||
439 | * Don't count this interface for promisc/allmulti while it | ||
440 | * is down. dev_mc_unsync() will invoke set_multicast_list | ||
441 | * on the master interface which will sync these down to the | ||
442 | * hardware as filter flags. | ||
443 | */ | ||
444 | if (sdata->flags & IEEE80211_SDATA_ALLMULTI) | ||
445 | atomic_dec(&local->iff_allmultis); | ||
446 | |||
447 | if (sdata->flags & IEEE80211_SDATA_PROMISC) | ||
448 | atomic_dec(&local->iff_promiscs); | ||
449 | |||
450 | dev_mc_unsync(local->mdev, dev); | ||
451 | |||
452 | /* APs need special treatment */ | ||
453 | if (sdata->vif.type == IEEE80211_IF_TYPE_AP) { | ||
454 | struct ieee80211_sub_if_data *vlan, *tmp; | ||
455 | struct beacon_data *old_beacon = sdata->u.ap.beacon; | ||
456 | |||
457 | /* remove beacon */ | ||
458 | rcu_assign_pointer(sdata->u.ap.beacon, NULL); | ||
459 | synchronize_rcu(); | ||
460 | kfree(old_beacon); | ||
461 | |||
462 | /* down all dependent devices, that is VLANs */ | ||
463 | list_for_each_entry_safe(vlan, tmp, &sdata->u.ap.vlans, | ||
464 | u.vlan.list) | ||
465 | dev_close(vlan->dev); | ||
466 | WARN_ON(!list_empty(&sdata->u.ap.vlans)); | ||
467 | } | ||
468 | |||
469 | local->open_count--; | ||
470 | |||
471 | switch (sdata->vif.type) { | ||
472 | case IEEE80211_IF_TYPE_VLAN: | ||
473 | list_del(&sdata->u.vlan.list); | ||
474 | sdata->u.vlan.ap = NULL; | ||
475 | /* no need to tell driver */ | ||
476 | break; | ||
477 | case IEEE80211_IF_TYPE_MNTR: | ||
478 | if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) { | ||
479 | local->cooked_mntrs--; | ||
480 | break; | ||
481 | } | ||
482 | |||
483 | local->monitors--; | ||
484 | if (local->monitors == 0) | ||
485 | local->hw.conf.flags &= ~IEEE80211_CONF_RADIOTAP; | ||
486 | |||
487 | if (sdata->u.mntr_flags & MONITOR_FLAG_FCSFAIL) | ||
488 | local->fif_fcsfail--; | ||
489 | if (sdata->u.mntr_flags & MONITOR_FLAG_PLCPFAIL) | ||
490 | local->fif_plcpfail--; | ||
491 | if (sdata->u.mntr_flags & MONITOR_FLAG_CONTROL) | ||
492 | local->fif_control--; | ||
493 | if (sdata->u.mntr_flags & MONITOR_FLAG_OTHER_BSS) | ||
494 | local->fif_other_bss--; | ||
495 | |||
496 | netif_tx_lock_bh(local->mdev); | ||
497 | ieee80211_configure_filter(local); | ||
498 | netif_tx_unlock_bh(local->mdev); | ||
499 | break; | ||
500 | case IEEE80211_IF_TYPE_MESH_POINT: | ||
501 | case IEEE80211_IF_TYPE_STA: | ||
502 | case IEEE80211_IF_TYPE_IBSS: | ||
503 | sdata->u.sta.state = IEEE80211_DISABLED; | ||
504 | del_timer_sync(&sdata->u.sta.timer); | ||
505 | /* | ||
506 | * When we get here, the interface is marked down. | ||
507 | * Call synchronize_rcu() to wait for the RX path | ||
508 | * should it be using the interface and enqueuing | ||
509 | * frames at this very time on another CPU. | ||
510 | */ | ||
511 | synchronize_rcu(); | ||
512 | skb_queue_purge(&sdata->u.sta.skb_queue); | ||
513 | |||
514 | if (local->scan_dev == sdata->dev) { | ||
515 | if (!local->ops->hw_scan) { | ||
516 | local->sta_sw_scanning = 0; | ||
517 | cancel_delayed_work(&local->scan_work); | ||
518 | } else | ||
519 | local->sta_hw_scanning = 0; | ||
520 | } | ||
521 | |||
522 | flush_workqueue(local->hw.workqueue); | ||
523 | |||
524 | sdata->u.sta.flags &= ~IEEE80211_STA_PRIVACY_INVOKED; | ||
525 | kfree(sdata->u.sta.extra_ie); | ||
526 | sdata->u.sta.extra_ie = NULL; | ||
527 | sdata->u.sta.extra_ie_len = 0; | ||
528 | /* fall through */ | ||
529 | default: | ||
530 | conf.vif = &sdata->vif; | ||
531 | conf.type = sdata->vif.type; | ||
532 | conf.mac_addr = dev->dev_addr; | ||
533 | /* disable all keys for as long as this netdev is down */ | ||
534 | ieee80211_disable_keys(sdata); | ||
535 | local->ops->remove_interface(local_to_hw(local), &conf); | ||
536 | } | ||
537 | |||
538 | if (local->open_count == 0) { | ||
539 | if (netif_running(local->mdev)) | ||
540 | dev_close(local->mdev); | ||
541 | |||
542 | if (local->ops->stop) | ||
543 | local->ops->stop(local_to_hw(local)); | ||
544 | |||
545 | ieee80211_led_radio(local, 0); | ||
546 | |||
547 | tasklet_disable(&local->tx_pending_tasklet); | ||
548 | tasklet_disable(&local->tasklet); | ||
549 | } | ||
550 | |||
551 | return 0; | ||
552 | } | ||
553 | |||
554 | int ieee80211_start_tx_ba_session(struct ieee80211_hw *hw, u8 *ra, u16 tid) | ||
555 | { | ||
556 | struct ieee80211_local *local = hw_to_local(hw); | ||
557 | struct sta_info *sta; | ||
558 | struct ieee80211_sub_if_data *sdata; | ||
559 | u16 start_seq_num = 0; | ||
560 | u8 *state; | ||
561 | int ret; | ||
562 | DECLARE_MAC_BUF(mac); | ||
563 | |||
564 | if (tid >= STA_TID_NUM) | ||
565 | return -EINVAL; | ||
566 | |||
567 | #ifdef CONFIG_MAC80211_HT_DEBUG | ||
568 | printk(KERN_DEBUG "Open BA session requested for %s tid %u\n", | ||
569 | print_mac(mac, ra), tid); | ||
570 | #endif /* CONFIG_MAC80211_HT_DEBUG */ | ||
571 | |||
572 | rcu_read_lock(); | ||
573 | |||
574 | sta = sta_info_get(local, ra); | ||
575 | if (!sta) { | ||
576 | printk(KERN_DEBUG "Could not find the station\n"); | ||
577 | rcu_read_unlock(); | ||
578 | return -ENOENT; | ||
579 | } | ||
580 | |||
581 | spin_lock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
582 | |||
583 | /* we have tried too many times, receiver does not want A-MPDU */ | ||
584 | if (sta->ampdu_mlme.addba_req_num[tid] > HT_AGG_MAX_RETRIES) { | ||
585 | ret = -EBUSY; | ||
586 | goto start_ba_exit; | ||
587 | } | ||
588 | |||
589 | state = &sta->ampdu_mlme.tid_state_tx[tid]; | ||
590 | /* check if the TID is not in aggregation flow already */ | ||
591 | if (*state != HT_AGG_STATE_IDLE) { | ||
592 | #ifdef CONFIG_MAC80211_HT_DEBUG | ||
593 | printk(KERN_DEBUG "BA request denied - session is not " | ||
594 | "idle on tid %u\n", tid); | ||
595 | #endif /* CONFIG_MAC80211_HT_DEBUG */ | ||
596 | ret = -EAGAIN; | ||
597 | goto start_ba_exit; | ||
598 | } | ||
599 | |||
600 | /* prepare A-MPDU MLME for Tx aggregation */ | ||
601 | sta->ampdu_mlme.tid_tx[tid] = | ||
602 | kmalloc(sizeof(struct tid_ampdu_tx), GFP_ATOMIC); | ||
603 | if (!sta->ampdu_mlme.tid_tx[tid]) { | ||
604 | if (net_ratelimit()) | ||
605 | printk(KERN_ERR "allocate tx mlme to tid %d failed\n", | ||
606 | tid); | ||
607 | ret = -ENOMEM; | ||
608 | goto start_ba_exit; | ||
609 | } | ||
610 | /* Tx timer */ | ||
611 | sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.function = | ||
612 | sta_addba_resp_timer_expired; | ||
613 | sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.data = | ||
614 | (unsigned long)&sta->timer_to_tid[tid]; | ||
615 | init_timer(&sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer); | ||
616 | |||
617 | /* ensure that TX flow won't interrupt us | ||
618 | * until the end of the call to requeue function */ | ||
619 | spin_lock_bh(&local->mdev->queue_lock); | ||
620 | |||
621 | /* create a new queue for this aggregation */ | ||
622 | ret = ieee80211_ht_agg_queue_add(local, sta, tid); | ||
623 | |||
624 | /* case no queue is available to aggregation | ||
625 | * don't switch to aggregation */ | ||
626 | if (ret) { | ||
627 | #ifdef CONFIG_MAC80211_HT_DEBUG | ||
628 | printk(KERN_DEBUG "BA request denied - queue unavailable for" | ||
629 | " tid %d\n", tid); | ||
630 | #endif /* CONFIG_MAC80211_HT_DEBUG */ | ||
631 | goto start_ba_err; | ||
632 | } | ||
633 | sdata = sta->sdata; | ||
634 | |||
635 | /* Ok, the Addba frame hasn't been sent yet, but if the driver calls the | ||
636 | * call back right away, it must see that the flow has begun */ | ||
637 | *state |= HT_ADDBA_REQUESTED_MSK; | ||
638 | |||
639 | if (local->ops->ampdu_action) | ||
640 | ret = local->ops->ampdu_action(hw, IEEE80211_AMPDU_TX_START, | ||
641 | ra, tid, &start_seq_num); | ||
642 | |||
643 | if (ret) { | ||
644 | /* No need to requeue the packets in the agg queue, since we | ||
645 | * held the tx lock: no packet could be enqueued to the newly | ||
646 | * allocated queue */ | ||
647 | ieee80211_ht_agg_queue_remove(local, sta, tid, 0); | ||
648 | #ifdef CONFIG_MAC80211_HT_DEBUG | ||
649 | printk(KERN_DEBUG "BA request denied - HW unavailable for" | ||
650 | " tid %d\n", tid); | ||
651 | #endif /* CONFIG_MAC80211_HT_DEBUG */ | ||
652 | *state = HT_AGG_STATE_IDLE; | ||
653 | goto start_ba_err; | ||
654 | } | ||
655 | |||
656 | /* Will put all the packets in the new SW queue */ | ||
657 | ieee80211_requeue(local, ieee802_1d_to_ac[tid]); | ||
658 | spin_unlock_bh(&local->mdev->queue_lock); | ||
659 | |||
660 | /* send an addBA request */ | ||
661 | sta->ampdu_mlme.dialog_token_allocator++; | ||
662 | sta->ampdu_mlme.tid_tx[tid]->dialog_token = | ||
663 | sta->ampdu_mlme.dialog_token_allocator; | ||
664 | sta->ampdu_mlme.tid_tx[tid]->ssn = start_seq_num; | ||
665 | |||
666 | ieee80211_send_addba_request(sta->sdata->dev, ra, tid, | ||
667 | sta->ampdu_mlme.tid_tx[tid]->dialog_token, | ||
668 | sta->ampdu_mlme.tid_tx[tid]->ssn, | ||
669 | 0x40, 5000); | ||
670 | |||
671 | /* activate the timer for the recipient's addBA response */ | ||
672 | sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.expires = | ||
673 | jiffies + ADDBA_RESP_INTERVAL; | ||
674 | add_timer(&sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer); | ||
675 | printk(KERN_DEBUG "activated addBA response timer on tid %d\n", tid); | ||
676 | goto start_ba_exit; | ||
677 | |||
678 | start_ba_err: | ||
679 | kfree(sta->ampdu_mlme.tid_tx[tid]); | ||
680 | sta->ampdu_mlme.tid_tx[tid] = NULL; | ||
681 | spin_unlock_bh(&local->mdev->queue_lock); | ||
682 | ret = -EBUSY; | ||
683 | start_ba_exit: | ||
684 | spin_unlock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
685 | rcu_read_unlock(); | ||
686 | return ret; | ||
687 | } | ||
688 | EXPORT_SYMBOL(ieee80211_start_tx_ba_session); | ||
689 | |||
690 | int ieee80211_stop_tx_ba_session(struct ieee80211_hw *hw, | ||
691 | u8 *ra, u16 tid, | ||
692 | enum ieee80211_back_parties initiator) | ||
693 | { | ||
694 | struct ieee80211_local *local = hw_to_local(hw); | ||
695 | struct sta_info *sta; | ||
696 | u8 *state; | ||
697 | int ret = 0; | ||
698 | DECLARE_MAC_BUF(mac); | ||
699 | |||
700 | if (tid >= STA_TID_NUM) | ||
701 | return -EINVAL; | ||
702 | |||
703 | rcu_read_lock(); | ||
704 | sta = sta_info_get(local, ra); | ||
705 | if (!sta) { | ||
706 | rcu_read_unlock(); | ||
707 | return -ENOENT; | ||
708 | } | ||
709 | |||
710 | /* check if the TID is in aggregation */ | ||
711 | state = &sta->ampdu_mlme.tid_state_tx[tid]; | ||
712 | spin_lock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
713 | |||
714 | if (*state != HT_AGG_STATE_OPERATIONAL) { | ||
715 | ret = -ENOENT; | ||
716 | goto stop_BA_exit; | ||
717 | } | ||
718 | |||
719 | #ifdef CONFIG_MAC80211_HT_DEBUG | ||
720 | printk(KERN_DEBUG "Tx BA session stop requested for %s tid %u\n", | ||
721 | print_mac(mac, ra), tid); | ||
722 | #endif /* CONFIG_MAC80211_HT_DEBUG */ | ||
723 | |||
724 | ieee80211_stop_queue(hw, sta->tid_to_tx_q[tid]); | ||
725 | |||
726 | *state = HT_AGG_STATE_REQ_STOP_BA_MSK | | ||
727 | (initiator << HT_AGG_STATE_INITIATOR_SHIFT); | ||
728 | |||
729 | if (local->ops->ampdu_action) | ||
730 | ret = local->ops->ampdu_action(hw, IEEE80211_AMPDU_TX_STOP, | ||
731 | ra, tid, NULL); | ||
732 | |||
733 | /* case HW denied going back to legacy */ | ||
734 | if (ret) { | ||
735 | WARN_ON(ret != -EBUSY); | ||
736 | *state = HT_AGG_STATE_OPERATIONAL; | ||
737 | ieee80211_wake_queue(hw, sta->tid_to_tx_q[tid]); | ||
738 | goto stop_BA_exit; | ||
739 | } | ||
740 | |||
741 | stop_BA_exit: | ||
742 | spin_unlock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
743 | rcu_read_unlock(); | ||
744 | return ret; | ||
745 | } | ||
746 | EXPORT_SYMBOL(ieee80211_stop_tx_ba_session); | ||
747 | |||
748 | void ieee80211_start_tx_ba_cb(struct ieee80211_hw *hw, u8 *ra, u16 tid) | ||
749 | { | ||
750 | struct ieee80211_local *local = hw_to_local(hw); | ||
751 | struct sta_info *sta; | ||
752 | u8 *state; | ||
753 | DECLARE_MAC_BUF(mac); | ||
754 | |||
755 | if (tid >= STA_TID_NUM) { | ||
756 | printk(KERN_DEBUG "Bad TID value: tid = %d (>= %d)\n", | ||
757 | tid, STA_TID_NUM); | ||
758 | return; | ||
759 | } | ||
760 | |||
761 | rcu_read_lock(); | ||
762 | sta = sta_info_get(local, ra); | ||
763 | if (!sta) { | ||
764 | rcu_read_unlock(); | ||
765 | printk(KERN_DEBUG "Could not find station: %s\n", | ||
766 | print_mac(mac, ra)); | ||
767 | return; | ||
768 | } | ||
769 | |||
770 | state = &sta->ampdu_mlme.tid_state_tx[tid]; | ||
771 | spin_lock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
772 | |||
773 | if (!(*state & HT_ADDBA_REQUESTED_MSK)) { | ||
774 | printk(KERN_DEBUG "addBA was not requested yet, state is %d\n", | ||
775 | *state); | ||
776 | spin_unlock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
777 | rcu_read_unlock(); | ||
778 | return; | ||
779 | } | ||
780 | |||
781 | WARN_ON_ONCE(*state & HT_ADDBA_DRV_READY_MSK); | ||
782 | |||
783 | *state |= HT_ADDBA_DRV_READY_MSK; | ||
784 | |||
785 | if (*state == HT_AGG_STATE_OPERATIONAL) { | ||
786 | printk(KERN_DEBUG "Aggregation is on for tid %d \n", tid); | ||
787 | ieee80211_wake_queue(hw, sta->tid_to_tx_q[tid]); | ||
788 | } | ||
789 | spin_unlock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
790 | rcu_read_unlock(); | ||
791 | } | ||
792 | EXPORT_SYMBOL(ieee80211_start_tx_ba_cb); | ||
793 | |||
794 | void ieee80211_stop_tx_ba_cb(struct ieee80211_hw *hw, u8 *ra, u8 tid) | ||
795 | { | ||
796 | struct ieee80211_local *local = hw_to_local(hw); | ||
797 | struct sta_info *sta; | ||
798 | u8 *state; | ||
799 | int agg_queue; | ||
800 | DECLARE_MAC_BUF(mac); | ||
801 | |||
802 | if (tid >= STA_TID_NUM) { | ||
803 | printk(KERN_DEBUG "Bad TID value: tid = %d (>= %d)\n", | ||
804 | tid, STA_TID_NUM); | ||
805 | return; | ||
806 | } | ||
807 | |||
808 | #ifdef CONFIG_MAC80211_HT_DEBUG | ||
809 | printk(KERN_DEBUG "Stopping Tx BA session for %s tid %d\n", | ||
810 | print_mac(mac, ra), tid); | ||
811 | #endif /* CONFIG_MAC80211_HT_DEBUG */ | ||
812 | |||
813 | rcu_read_lock(); | ||
814 | sta = sta_info_get(local, ra); | ||
815 | if (!sta) { | ||
816 | printk(KERN_DEBUG "Could not find station: %s\n", | ||
817 | print_mac(mac, ra)); | ||
818 | rcu_read_unlock(); | ||
819 | return; | ||
820 | } | ||
821 | state = &sta->ampdu_mlme.tid_state_tx[tid]; | ||
822 | |||
823 | spin_lock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
824 | if ((*state & HT_AGG_STATE_REQ_STOP_BA_MSK) == 0) { | ||
825 | printk(KERN_DEBUG "unexpected callback to A-MPDU stop\n"); | ||
826 | spin_unlock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
827 | rcu_read_unlock(); | ||
828 | return; | ||
829 | } | ||
830 | |||
831 | if (*state & HT_AGG_STATE_INITIATOR_MSK) | ||
832 | ieee80211_send_delba(sta->sdata->dev, ra, tid, | ||
833 | WLAN_BACK_INITIATOR, WLAN_REASON_QSTA_NOT_USE); | ||
834 | |||
835 | agg_queue = sta->tid_to_tx_q[tid]; | ||
836 | |||
837 | /* avoid ordering issues: we are the only one that can modify | ||
838 | * the content of the qdiscs */ | ||
839 | spin_lock_bh(&local->mdev->queue_lock); | ||
840 | /* remove the queue for this aggregation */ | ||
841 | ieee80211_ht_agg_queue_remove(local, sta, tid, 1); | ||
842 | spin_unlock_bh(&local->mdev->queue_lock); | ||
843 | |||
844 | /* we just requeued the all the frames that were in the removed | ||
845 | * queue, and since we might miss a softirq we do netif_schedule. | ||
846 | * ieee80211_wake_queue is not used here as this queue is not | ||
847 | * necessarily stopped */ | ||
848 | netif_schedule(local->mdev); | ||
849 | *state = HT_AGG_STATE_IDLE; | ||
850 | sta->ampdu_mlme.addba_req_num[tid] = 0; | ||
851 | kfree(sta->ampdu_mlme.tid_tx[tid]); | ||
852 | sta->ampdu_mlme.tid_tx[tid] = NULL; | ||
853 | spin_unlock_bh(&sta->ampdu_mlme.ampdu_tx); | ||
854 | |||
855 | rcu_read_unlock(); | ||
856 | } | ||
857 | EXPORT_SYMBOL(ieee80211_stop_tx_ba_cb); | ||
858 | |||
859 | void ieee80211_start_tx_ba_cb_irqsafe(struct ieee80211_hw *hw, | ||
860 | const u8 *ra, u16 tid) | ||
861 | { | ||
862 | struct ieee80211_local *local = hw_to_local(hw); | ||
863 | struct ieee80211_ra_tid *ra_tid; | ||
864 | struct sk_buff *skb = dev_alloc_skb(0); | ||
865 | |||
866 | if (unlikely(!skb)) { | ||
867 | if (net_ratelimit()) | ||
868 | printk(KERN_WARNING "%s: Not enough memory, " | ||
869 | "dropping start BA session", skb->dev->name); | ||
870 | return; | ||
871 | } | ||
872 | ra_tid = (struct ieee80211_ra_tid *) &skb->cb; | ||
873 | memcpy(&ra_tid->ra, ra, ETH_ALEN); | ||
874 | ra_tid->tid = tid; | ||
875 | |||
876 | skb->pkt_type = IEEE80211_ADDBA_MSG; | ||
877 | skb_queue_tail(&local->skb_queue, skb); | ||
878 | tasklet_schedule(&local->tasklet); | ||
879 | } | ||
880 | EXPORT_SYMBOL(ieee80211_start_tx_ba_cb_irqsafe); | ||
881 | |||
882 | void ieee80211_stop_tx_ba_cb_irqsafe(struct ieee80211_hw *hw, | ||
883 | const u8 *ra, u16 tid) | ||
884 | { | ||
885 | struct ieee80211_local *local = hw_to_local(hw); | ||
886 | struct ieee80211_ra_tid *ra_tid; | ||
887 | struct sk_buff *skb = dev_alloc_skb(0); | ||
888 | |||
889 | if (unlikely(!skb)) { | ||
890 | if (net_ratelimit()) | ||
891 | printk(KERN_WARNING "%s: Not enough memory, " | ||
892 | "dropping stop BA session", skb->dev->name); | ||
893 | return; | ||
894 | } | ||
895 | ra_tid = (struct ieee80211_ra_tid *) &skb->cb; | ||
896 | memcpy(&ra_tid->ra, ra, ETH_ALEN); | ||
897 | ra_tid->tid = tid; | ||
898 | |||
899 | skb->pkt_type = IEEE80211_DELBA_MSG; | ||
900 | skb_queue_tail(&local->skb_queue, skb); | ||
901 | tasklet_schedule(&local->tasklet); | ||
902 | } | ||
903 | EXPORT_SYMBOL(ieee80211_stop_tx_ba_cb_irqsafe); | ||
904 | |||
905 | static void ieee80211_set_multicast_list(struct net_device *dev) | ||
906 | { | ||
907 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
908 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
909 | int allmulti, promisc, sdata_allmulti, sdata_promisc; | ||
910 | |||
911 | allmulti = !!(dev->flags & IFF_ALLMULTI); | ||
912 | promisc = !!(dev->flags & IFF_PROMISC); | ||
913 | sdata_allmulti = !!(sdata->flags & IEEE80211_SDATA_ALLMULTI); | ||
914 | sdata_promisc = !!(sdata->flags & IEEE80211_SDATA_PROMISC); | ||
915 | |||
916 | if (allmulti != sdata_allmulti) { | ||
917 | if (dev->flags & IFF_ALLMULTI) | ||
918 | atomic_inc(&local->iff_allmultis); | ||
919 | else | ||
920 | atomic_dec(&local->iff_allmultis); | ||
921 | sdata->flags ^= IEEE80211_SDATA_ALLMULTI; | ||
922 | } | ||
923 | |||
924 | if (promisc != sdata_promisc) { | ||
925 | if (dev->flags & IFF_PROMISC) | ||
926 | atomic_inc(&local->iff_promiscs); | ||
927 | else | ||
928 | atomic_dec(&local->iff_promiscs); | ||
929 | sdata->flags ^= IEEE80211_SDATA_PROMISC; | ||
930 | } | ||
931 | |||
932 | dev_mc_sync(local->mdev, dev); | ||
933 | } | ||
934 | |||
935 | static const struct header_ops ieee80211_header_ops = { | ||
936 | .create = eth_header, | ||
937 | .parse = header_parse_80211, | ||
938 | .rebuild = eth_rebuild_header, | ||
939 | .cache = eth_header_cache, | ||
940 | .cache_update = eth_header_cache_update, | ||
941 | }; | ||
942 | |||
943 | /* Must not be called for mdev */ | ||
944 | void ieee80211_if_setup(struct net_device *dev) | ||
945 | { | ||
946 | ether_setup(dev); | ||
947 | dev->hard_start_xmit = ieee80211_subif_start_xmit; | ||
948 | dev->wireless_handlers = &ieee80211_iw_handler_def; | ||
949 | dev->set_multicast_list = ieee80211_set_multicast_list; | ||
950 | dev->change_mtu = ieee80211_change_mtu; | ||
951 | dev->open = ieee80211_open; | ||
952 | dev->stop = ieee80211_stop; | ||
953 | dev->destructor = ieee80211_if_free; | ||
954 | } | ||
955 | |||
956 | /* everything else */ | ||
957 | |||
958 | static int __ieee80211_if_config(struct net_device *dev, | ||
959 | struct sk_buff *beacon, | ||
960 | struct ieee80211_tx_control *control) | ||
961 | { | ||
962 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
963 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
964 | struct ieee80211_if_conf conf; | ||
965 | |||
966 | if (!local->ops->config_interface || !netif_running(dev)) | ||
967 | return 0; | ||
968 | |||
969 | memset(&conf, 0, sizeof(conf)); | ||
970 | conf.type = sdata->vif.type; | ||
971 | if (sdata->vif.type == IEEE80211_IF_TYPE_STA || | ||
972 | sdata->vif.type == IEEE80211_IF_TYPE_IBSS) { | ||
973 | conf.bssid = sdata->u.sta.bssid; | ||
974 | conf.ssid = sdata->u.sta.ssid; | ||
975 | conf.ssid_len = sdata->u.sta.ssid_len; | ||
976 | } else if (ieee80211_vif_is_mesh(&sdata->vif)) { | ||
977 | conf.beacon = beacon; | ||
978 | ieee80211_start_mesh(dev); | ||
979 | } else if (sdata->vif.type == IEEE80211_IF_TYPE_AP) { | ||
980 | conf.ssid = sdata->u.ap.ssid; | ||
981 | conf.ssid_len = sdata->u.ap.ssid_len; | ||
982 | conf.beacon = beacon; | ||
983 | conf.beacon_control = control; | ||
984 | } | ||
985 | return local->ops->config_interface(local_to_hw(local), | ||
986 | &sdata->vif, &conf); | ||
987 | } | ||
988 | |||
989 | int ieee80211_if_config(struct net_device *dev) | ||
990 | { | ||
991 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
992 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
993 | if (sdata->vif.type == IEEE80211_IF_TYPE_MESH_POINT && | ||
994 | (local->hw.flags & IEEE80211_HW_HOST_GEN_BEACON_TEMPLATE)) | ||
995 | return ieee80211_if_config_beacon(dev); | ||
996 | return __ieee80211_if_config(dev, NULL, NULL); | ||
997 | } | ||
998 | |||
999 | int ieee80211_if_config_beacon(struct net_device *dev) | ||
1000 | { | ||
1001 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); | ||
1002 | struct ieee80211_tx_control control; | ||
1003 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
1004 | struct sk_buff *skb; | ||
1005 | |||
1006 | if (!(local->hw.flags & IEEE80211_HW_HOST_GEN_BEACON_TEMPLATE)) | ||
1007 | return 0; | ||
1008 | skb = ieee80211_beacon_get(local_to_hw(local), &sdata->vif, | ||
1009 | &control); | ||
1010 | if (!skb) | ||
1011 | return -ENOMEM; | ||
1012 | return __ieee80211_if_config(dev, skb, &control); | ||
1013 | } | ||
1014 | |||
1015 | int ieee80211_hw_config(struct ieee80211_local *local) | ||
1016 | { | ||
1017 | struct ieee80211_channel *chan; | ||
1018 | int ret = 0; | ||
1019 | |||
1020 | if (local->sta_sw_scanning) | ||
1021 | chan = local->scan_channel; | ||
1022 | else | ||
1023 | chan = local->oper_channel; | ||
1024 | |||
1025 | local->hw.conf.channel = chan; | ||
1026 | |||
1027 | if (!local->hw.conf.power_level) | ||
1028 | local->hw.conf.power_level = chan->max_power; | ||
1029 | else | ||
1030 | local->hw.conf.power_level = min(chan->max_power, | ||
1031 | local->hw.conf.power_level); | ||
1032 | |||
1033 | local->hw.conf.max_antenna_gain = chan->max_antenna_gain; | ||
1034 | |||
1035 | #ifdef CONFIG_MAC80211_VERBOSE_DEBUG | ||
1036 | printk(KERN_DEBUG "%s: HW CONFIG: freq=%d\n", | ||
1037 | wiphy_name(local->hw.wiphy), chan->center_freq); | ||
1038 | #endif | ||
1039 | |||
1040 | if (local->open_count) | ||
1041 | ret = local->ops->config(local_to_hw(local), &local->hw.conf); | ||
1042 | |||
1043 | return ret; | ||
1044 | } | ||
1045 | |||
1046 | /** | ||
1047 | * ieee80211_handle_ht should be used only after legacy configuration | ||
1048 | * has been determined namely band, as ht configuration depends upon | ||
1049 | * the hardware's HT abilities for a _specific_ band. | ||
1050 | */ | ||
1051 | u32 ieee80211_handle_ht(struct ieee80211_local *local, int enable_ht, | ||
1052 | struct ieee80211_ht_info *req_ht_cap, | ||
1053 | struct ieee80211_ht_bss_info *req_bss_cap) | ||
1054 | { | ||
1055 | struct ieee80211_conf *conf = &local->hw.conf; | ||
1056 | struct ieee80211_supported_band *sband; | ||
1057 | struct ieee80211_ht_info ht_conf; | ||
1058 | struct ieee80211_ht_bss_info ht_bss_conf; | ||
1059 | int i; | ||
1060 | u32 changed = 0; | ||
1061 | |||
1062 | sband = local->hw.wiphy->bands[conf->channel->band]; | ||
1063 | |||
1064 | /* HT is not supported */ | ||
1065 | if (!sband->ht_info.ht_supported) { | ||
1066 | conf->flags &= ~IEEE80211_CONF_SUPPORT_HT_MODE; | ||
1067 | return 0; | ||
1068 | } | ||
1069 | |||
1070 | memset(&ht_conf, 0, sizeof(struct ieee80211_ht_info)); | ||
1071 | memset(&ht_bss_conf, 0, sizeof(struct ieee80211_ht_bss_info)); | ||
1072 | |||
1073 | if (enable_ht) { | ||
1074 | if (!(conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE)) | ||
1075 | changed |= BSS_CHANGED_HT; | ||
1076 | |||
1077 | conf->flags |= IEEE80211_CONF_SUPPORT_HT_MODE; | ||
1078 | ht_conf.ht_supported = 1; | ||
1079 | |||
1080 | ht_conf.cap = req_ht_cap->cap & sband->ht_info.cap; | ||
1081 | ht_conf.cap &= ~(IEEE80211_HT_CAP_MIMO_PS); | ||
1082 | ht_conf.cap |= sband->ht_info.cap & IEEE80211_HT_CAP_MIMO_PS; | ||
1083 | |||
1084 | for (i = 0; i < SUPP_MCS_SET_LEN; i++) | ||
1085 | ht_conf.supp_mcs_set[i] = | ||
1086 | sband->ht_info.supp_mcs_set[i] & | ||
1087 | req_ht_cap->supp_mcs_set[i]; | ||
1088 | |||
1089 | ht_bss_conf.primary_channel = req_bss_cap->primary_channel; | ||
1090 | ht_bss_conf.bss_cap = req_bss_cap->bss_cap; | ||
1091 | ht_bss_conf.bss_op_mode = req_bss_cap->bss_op_mode; | ||
1092 | |||
1093 | ht_conf.ampdu_factor = req_ht_cap->ampdu_factor; | ||
1094 | ht_conf.ampdu_density = req_ht_cap->ampdu_density; | ||
1095 | |||
1096 | /* if bss configuration changed store the new one */ | ||
1097 | if (memcmp(&conf->ht_conf, &ht_conf, sizeof(ht_conf)) || | ||
1098 | memcmp(&conf->ht_bss_conf, &ht_bss_conf, sizeof(ht_bss_conf))) { | ||
1099 | changed |= BSS_CHANGED_HT; | ||
1100 | memcpy(&conf->ht_conf, &ht_conf, sizeof(ht_conf)); | ||
1101 | memcpy(&conf->ht_bss_conf, &ht_bss_conf, sizeof(ht_bss_conf)); | ||
1102 | } | ||
1103 | } else { | ||
1104 | if (conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE) | ||
1105 | changed |= BSS_CHANGED_HT; | ||
1106 | conf->flags &= ~IEEE80211_CONF_SUPPORT_HT_MODE; | ||
1107 | } | ||
1108 | |||
1109 | return changed; | ||
1110 | } | ||
1111 | |||
1112 | void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata, | ||
1113 | u32 changed) | ||
1114 | { | ||
1115 | struct ieee80211_local *local = sdata->local; | ||
1116 | |||
1117 | if (!changed) | ||
1118 | return; | ||
1119 | |||
1120 | if (local->ops->bss_info_changed) | ||
1121 | local->ops->bss_info_changed(local_to_hw(local), | ||
1122 | &sdata->vif, | ||
1123 | &sdata->bss_conf, | ||
1124 | changed); | ||
1125 | } | ||
1126 | |||
1127 | void ieee80211_reset_erp_info(struct net_device *dev) | ||
1128 | { | ||
1129 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | ||
1130 | |||
1131 | sdata->bss_conf.use_cts_prot = 0; | ||
1132 | sdata->bss_conf.use_short_preamble = 0; | ||
1133 | ieee80211_bss_info_change_notify(sdata, | ||
1134 | BSS_CHANGED_ERP_CTS_PROT | | ||
1135 | BSS_CHANGED_ERP_PREAMBLE); | ||
1136 | } | ||
1137 | |||
1138 | void ieee80211_tx_status_irqsafe(struct ieee80211_hw *hw, | ||
1139 | struct sk_buff *skb, | ||
1140 | struct ieee80211_tx_status *status) | ||
1141 | { | ||
1142 | struct ieee80211_local *local = hw_to_local(hw); | ||
1143 | struct ieee80211_tx_status *saved; | ||
1144 | int tmp; | ||
1145 | |||
1146 | skb->dev = local->mdev; | ||
1147 | saved = kmalloc(sizeof(struct ieee80211_tx_status), GFP_ATOMIC); | ||
1148 | if (unlikely(!saved)) { | ||
1149 | if (net_ratelimit()) | ||
1150 | printk(KERN_WARNING "%s: Not enough memory, " | ||
1151 | "dropping tx status", skb->dev->name); | ||
1152 | /* should be dev_kfree_skb_irq, but due to this function being | ||
1153 | * named _irqsafe instead of just _irq we can't be sure that | ||
1154 | * people won't call it from non-irq contexts */ | ||
1155 | dev_kfree_skb_any(skb); | ||
1156 | return; | ||
1157 | } | ||
1158 | memcpy(saved, status, sizeof(struct ieee80211_tx_status)); | ||
1159 | /* copy pointer to saved status into skb->cb for use by tasklet */ | ||
1160 | memcpy(skb->cb, &saved, sizeof(saved)); | ||
1161 | |||
1162 | skb->pkt_type = IEEE80211_TX_STATUS_MSG; | ||
1163 | skb_queue_tail(status->control.flags & IEEE80211_TXCTL_REQ_TX_STATUS ? | ||
1164 | &local->skb_queue : &local->skb_queue_unreliable, skb); | ||
1165 | tmp = skb_queue_len(&local->skb_queue) + | ||
1166 | skb_queue_len(&local->skb_queue_unreliable); | ||
1167 | while (tmp > IEEE80211_IRQSAFE_QUEUE_LIMIT && | ||
1168 | (skb = skb_dequeue(&local->skb_queue_unreliable))) { | ||
1169 | memcpy(&saved, skb->cb, sizeof(saved)); | ||
1170 | kfree(saved); | ||
1171 | dev_kfree_skb_irq(skb); | ||
1172 | tmp--; | ||
1173 | I802_DEBUG_INC(local->tx_status_drop); | ||
1174 | } | ||
1175 | tasklet_schedule(&local->tasklet); | ||
1176 | } | ||
1177 | EXPORT_SYMBOL(ieee80211_tx_status_irqsafe); | ||
1178 | |||
1179 | static void ieee80211_tasklet_handler(unsigned long data) | ||
1180 | { | ||
1181 | struct ieee80211_local *local = (struct ieee80211_local *) data; | ||
1182 | struct sk_buff *skb; | ||
1183 | struct ieee80211_rx_status rx_status; | ||
1184 | struct ieee80211_tx_status *tx_status; | ||
1185 | struct ieee80211_ra_tid *ra_tid; | ||
1186 | |||
1187 | while ((skb = skb_dequeue(&local->skb_queue)) || | ||
1188 | (skb = skb_dequeue(&local->skb_queue_unreliable))) { | ||
1189 | switch (skb->pkt_type) { | ||
1190 | case IEEE80211_RX_MSG: | ||
1191 | /* status is in skb->cb */ | ||
1192 | memcpy(&rx_status, skb->cb, sizeof(rx_status)); | ||
1193 | /* Clear skb->pkt_type in order to not confuse kernel | ||
1194 | * netstack. */ | ||
1195 | skb->pkt_type = 0; | ||
1196 | __ieee80211_rx(local_to_hw(local), skb, &rx_status); | ||
1197 | break; | ||
1198 | case IEEE80211_TX_STATUS_MSG: | ||
1199 | /* get pointer to saved status out of skb->cb */ | ||
1200 | memcpy(&tx_status, skb->cb, sizeof(tx_status)); | ||
1201 | skb->pkt_type = 0; | ||
1202 | ieee80211_tx_status(local_to_hw(local), | ||
1203 | skb, tx_status); | ||
1204 | kfree(tx_status); | ||
1205 | break; | ||
1206 | case IEEE80211_DELBA_MSG: | ||
1207 | ra_tid = (struct ieee80211_ra_tid *) &skb->cb; | ||
1208 | ieee80211_stop_tx_ba_cb(local_to_hw(local), | ||
1209 | ra_tid->ra, ra_tid->tid); | ||
1210 | dev_kfree_skb(skb); | ||
1211 | break; | ||
1212 | case IEEE80211_ADDBA_MSG: | ||
1213 | ra_tid = (struct ieee80211_ra_tid *) &skb->cb; | ||
1214 | ieee80211_start_tx_ba_cb(local_to_hw(local), | ||
1215 | ra_tid->ra, ra_tid->tid); | ||
1216 | dev_kfree_skb(skb); | ||
1217 | break ; | ||
1218 | default: /* should never get here! */ | ||
1219 | printk(KERN_ERR "%s: Unknown message type (%d)\n", | ||
1220 | wiphy_name(local->hw.wiphy), skb->pkt_type); | ||
1221 | dev_kfree_skb(skb); | ||
1222 | break; | ||
1223 | } | ||
1224 | } | ||
1225 | } | ||
1226 | |||
1227 | /* Remove added headers (e.g., QoS control), encryption header/MIC, etc. to | ||
1228 | * make a prepared TX frame (one that has been given to hw) to look like brand | ||
1229 | * new IEEE 802.11 frame that is ready to go through TX processing again. | ||
1230 | * Also, tx_packet_data in cb is restored from tx_control. */ | ||
1231 | static void ieee80211_remove_tx_extra(struct ieee80211_local *local, | ||
1232 | struct ieee80211_key *key, | ||
1233 | struct sk_buff *skb, | ||
1234 | struct ieee80211_tx_control *control) | ||
1235 | { | ||
1236 | int hdrlen, iv_len, mic_len; | ||
1237 | struct ieee80211_tx_packet_data *pkt_data; | ||
1238 | |||
1239 | pkt_data = (struct ieee80211_tx_packet_data *)skb->cb; | ||
1240 | pkt_data->ifindex = vif_to_sdata(control->vif)->dev->ifindex; | ||
1241 | pkt_data->flags = 0; | ||
1242 | if (control->flags & IEEE80211_TXCTL_REQ_TX_STATUS) | ||
1243 | pkt_data->flags |= IEEE80211_TXPD_REQ_TX_STATUS; | ||
1244 | if (control->flags & IEEE80211_TXCTL_DO_NOT_ENCRYPT) | ||
1245 | pkt_data->flags |= IEEE80211_TXPD_DO_NOT_ENCRYPT; | ||
1246 | if (control->flags & IEEE80211_TXCTL_REQUEUE) | ||
1247 | pkt_data->flags |= IEEE80211_TXPD_REQUEUE; | ||
1248 | if (control->flags & IEEE80211_TXCTL_EAPOL_FRAME) | ||
1249 | pkt_data->flags |= IEEE80211_TXPD_EAPOL_FRAME; | ||
1250 | pkt_data->queue = control->queue; | ||
1251 | |||
1252 | hdrlen = ieee80211_get_hdrlen_from_skb(skb); | ||
1253 | |||
1254 | if (!key) | ||
1255 | goto no_key; | ||
1256 | |||
1257 | switch (key->conf.alg) { | ||
1258 | case ALG_WEP: | ||
1259 | iv_len = WEP_IV_LEN; | ||
1260 | mic_len = WEP_ICV_LEN; | ||
1261 | break; | ||
1262 | case ALG_TKIP: | ||
1263 | iv_len = TKIP_IV_LEN; | ||
1264 | mic_len = TKIP_ICV_LEN; | ||
1265 | break; | ||
1266 | case ALG_CCMP: | ||
1267 | iv_len = CCMP_HDR_LEN; | ||
1268 | mic_len = CCMP_MIC_LEN; | ||
1269 | break; | ||
1270 | default: | ||
1271 | goto no_key; | ||
1272 | } | ||
1273 | |||
1274 | if (skb->len >= mic_len && | ||
1275 | !(key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)) | ||
1276 | skb_trim(skb, skb->len - mic_len); | ||
1277 | if (skb->len >= iv_len && skb->len > hdrlen) { | ||
1278 | memmove(skb->data + iv_len, skb->data, hdrlen); | ||
1279 | skb_pull(skb, iv_len); | ||
1280 | } | ||
1281 | |||
1282 | no_key: | ||
1283 | { | ||
1284 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; | ||
1285 | u16 fc = le16_to_cpu(hdr->frame_control); | ||
1286 | if ((fc & 0x8C) == 0x88) /* QoS Control Field */ { | ||
1287 | fc &= ~IEEE80211_STYPE_QOS_DATA; | ||
1288 | hdr->frame_control = cpu_to_le16(fc); | ||
1289 | memmove(skb->data + 2, skb->data, hdrlen - 2); | ||
1290 | skb_pull(skb, 2); | ||
1291 | } | ||
1292 | } | ||
1293 | } | ||
1294 | |||
1295 | static void ieee80211_handle_filtered_frame(struct ieee80211_local *local, | ||
1296 | struct sta_info *sta, | ||
1297 | struct sk_buff *skb, | ||
1298 | struct ieee80211_tx_status *status) | ||
1299 | { | ||
1300 | sta->tx_filtered_count++; | ||
1301 | |||
1302 | /* | ||
1303 | * Clear the TX filter mask for this STA when sending the next | ||
1304 | * packet. If the STA went to power save mode, this will happen | ||
1305 | * happen when it wakes up for the next time. | ||
1306 | */ | ||
1307 | sta->flags |= WLAN_STA_CLEAR_PS_FILT; | ||
1308 | |||
1309 | /* | ||
1310 | * This code races in the following way: | ||
1311 | * | ||
1312 | * (1) STA sends frame indicating it will go to sleep and does so | ||
1313 | * (2) hardware/firmware adds STA to filter list, passes frame up | ||
1314 | * (3) hardware/firmware processes TX fifo and suppresses a frame | ||
1315 | * (4) we get TX status before having processed the frame and | ||
1316 | * knowing that the STA has gone to sleep. | ||
1317 | * | ||
1318 | * This is actually quite unlikely even when both those events are | ||
1319 | * processed from interrupts coming in quickly after one another or | ||
1320 | * even at the same time because we queue both TX status events and | ||
1321 | * RX frames to be processed by a tasklet and process them in the | ||
1322 | * same order that they were received or TX status last. Hence, there | ||
1323 | * is no race as long as the frame RX is processed before the next TX | ||
1324 | * status, which drivers can ensure, see below. | ||
1325 | * | ||
1326 | * Note that this can only happen if the hardware or firmware can | ||
1327 | * actually add STAs to the filter list, if this is done by the | ||
1328 | * driver in response to set_tim() (which will only reduce the race | ||
1329 | * this whole filtering tries to solve, not completely solve it) | ||
1330 | * this situation cannot happen. | ||
1331 | * | ||
1332 | * To completely solve this race drivers need to make sure that they | ||
1333 | * (a) don't mix the irq-safe/not irq-safe TX status/RX processing | ||
1334 | * functions and | ||
1335 | * (b) always process RX events before TX status events if ordering | ||
1336 | * can be unknown, for example with different interrupt status | ||
1337 | * bits. | ||
1338 | */ | ||
1339 | if (sta->flags & WLAN_STA_PS && | ||
1340 | skb_queue_len(&sta->tx_filtered) < STA_MAX_TX_BUFFER) { | ||
1341 | ieee80211_remove_tx_extra(local, sta->key, skb, | ||
1342 | &status->control); | ||
1343 | skb_queue_tail(&sta->tx_filtered, skb); | ||
1344 | return; | ||
1345 | } | ||
1346 | |||
1347 | if (!(sta->flags & WLAN_STA_PS) && | ||
1348 | !(status->control.flags & IEEE80211_TXCTL_REQUEUE)) { | ||
1349 | /* Software retry the packet once */ | ||
1350 | status->control.flags |= IEEE80211_TXCTL_REQUEUE; | ||
1351 | ieee80211_remove_tx_extra(local, sta->key, skb, | ||
1352 | &status->control); | ||
1353 | dev_queue_xmit(skb); | ||
1354 | return; | ||
1355 | } | ||
1356 | |||
1357 | if (net_ratelimit()) | ||
1358 | printk(KERN_DEBUG "%s: dropped TX filtered frame, " | ||
1359 | "queue_len=%d PS=%d @%lu\n", | ||
1360 | wiphy_name(local->hw.wiphy), | ||
1361 | skb_queue_len(&sta->tx_filtered), | ||
1362 | !!(sta->flags & WLAN_STA_PS), jiffies); | ||
1363 | dev_kfree_skb(skb); | ||
1364 | } | ||
1365 | |||
1366 | void ieee80211_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb, | ||
1367 | struct ieee80211_tx_status *status) | ||
1368 | { | ||
1369 | struct sk_buff *skb2; | ||
1370 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; | ||
1371 | struct ieee80211_local *local = hw_to_local(hw); | ||
1372 | u16 frag, type; | ||
1373 | struct ieee80211_tx_status_rtap_hdr *rthdr; | ||
1374 | struct ieee80211_sub_if_data *sdata; | ||
1375 | struct net_device *prev_dev = NULL; | ||
1376 | |||
1377 | if (!status) { | ||
1378 | printk(KERN_ERR | ||
1379 | "%s: ieee80211_tx_status called with NULL status\n", | ||
1380 | wiphy_name(local->hw.wiphy)); | ||
1381 | dev_kfree_skb(skb); | ||
1382 | return; | ||
1383 | } | ||
1384 | |||
1385 | rcu_read_lock(); | ||
1386 | |||
1387 | if (status->excessive_retries) { | ||
1388 | struct sta_info *sta; | ||
1389 | sta = sta_info_get(local, hdr->addr1); | ||
1390 | if (sta) { | ||
1391 | if (sta->flags & WLAN_STA_PS) { | ||
1392 | /* | ||
1393 | * The STA is in power save mode, so assume | ||
1394 | * that this TX packet failed because of that. | ||
1395 | */ | ||
1396 | status->excessive_retries = 0; | ||
1397 | status->flags |= IEEE80211_TX_STATUS_TX_FILTERED; | ||
1398 | ieee80211_handle_filtered_frame(local, sta, | ||
1399 | skb, status); | ||
1400 | rcu_read_unlock(); | ||
1401 | return; | ||
1402 | } | ||
1403 | } | ||
1404 | } | ||
1405 | |||
1406 | if (status->flags & IEEE80211_TX_STATUS_TX_FILTERED) { | ||
1407 | struct sta_info *sta; | ||
1408 | sta = sta_info_get(local, hdr->addr1); | ||
1409 | if (sta) { | ||
1410 | ieee80211_handle_filtered_frame(local, sta, skb, | ||
1411 | status); | ||
1412 | rcu_read_unlock(); | ||
1413 | return; | ||
1414 | } | ||
1415 | } else | ||
1416 | rate_control_tx_status(local->mdev, skb, status); | ||
1417 | |||
1418 | rcu_read_unlock(); | ||
1419 | |||
1420 | ieee80211_led_tx(local, 0); | ||
1421 | |||
1422 | /* SNMP counters | ||
1423 | * Fragments are passed to low-level drivers as separate skbs, so these | ||
1424 | * are actually fragments, not frames. Update frame counters only for | ||
1425 | * the first fragment of the frame. */ | ||
1426 | |||
1427 | frag = le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG; | ||
1428 | type = le16_to_cpu(hdr->frame_control) & IEEE80211_FCTL_FTYPE; | ||
1429 | |||
1430 | if (status->flags & IEEE80211_TX_STATUS_ACK) { | ||
1431 | if (frag == 0) { | ||
1432 | local->dot11TransmittedFrameCount++; | ||
1433 | if (is_multicast_ether_addr(hdr->addr1)) | ||
1434 | local->dot11MulticastTransmittedFrameCount++; | ||
1435 | if (status->retry_count > 0) | ||
1436 | local->dot11RetryCount++; | ||
1437 | if (status->retry_count > 1) | ||
1438 | local->dot11MultipleRetryCount++; | ||
1439 | } | ||
1440 | |||
1441 | /* This counter shall be incremented for an acknowledged MPDU | ||
1442 | * with an individual address in the address 1 field or an MPDU | ||
1443 | * with a multicast address in the address 1 field of type Data | ||
1444 | * or Management. */ | ||
1445 | if (!is_multicast_ether_addr(hdr->addr1) || | ||
1446 | type == IEEE80211_FTYPE_DATA || | ||
1447 | type == IEEE80211_FTYPE_MGMT) | ||
1448 | local->dot11TransmittedFragmentCount++; | ||
1449 | } else { | ||
1450 | if (frag == 0) | ||
1451 | local->dot11FailedCount++; | ||
1452 | } | ||
1453 | |||
1454 | /* this was a transmitted frame, but now we want to reuse it */ | ||
1455 | skb_orphan(skb); | ||
1456 | |||
1457 | /* | ||
1458 | * This is a bit racy but we can avoid a lot of work | ||
1459 | * with this test... | ||
1460 | */ | ||
1461 | if (!local->monitors && !local->cooked_mntrs) { | ||
1462 | dev_kfree_skb(skb); | ||
1463 | return; | ||
1464 | } | ||
1465 | |||
1466 | /* send frame to monitor interfaces now */ | ||
1467 | |||
1468 | if (skb_headroom(skb) < sizeof(*rthdr)) { | ||
1469 | printk(KERN_ERR "ieee80211_tx_status: headroom too small\n"); | ||
1470 | dev_kfree_skb(skb); | ||
1471 | return; | ||
1472 | } | ||
1473 | |||
1474 | rthdr = (struct ieee80211_tx_status_rtap_hdr*) | ||
1475 | skb_push(skb, sizeof(*rthdr)); | ||
1476 | |||
1477 | memset(rthdr, 0, sizeof(*rthdr)); | ||
1478 | rthdr->hdr.it_len = cpu_to_le16(sizeof(*rthdr)); | ||
1479 | rthdr->hdr.it_present = | ||
1480 | cpu_to_le32((1 << IEEE80211_RADIOTAP_TX_FLAGS) | | ||
1481 | (1 << IEEE80211_RADIOTAP_DATA_RETRIES)); | ||
1482 | |||
1483 | if (!(status->flags & IEEE80211_TX_STATUS_ACK) && | ||
1484 | !is_multicast_ether_addr(hdr->addr1)) | ||
1485 | rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_FAIL); | ||
1486 | |||
1487 | if ((status->control.flags & IEEE80211_TXCTL_USE_RTS_CTS) && | ||
1488 | (status->control.flags & IEEE80211_TXCTL_USE_CTS_PROTECT)) | ||
1489 | rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_CTS); | ||
1490 | else if (status->control.flags & IEEE80211_TXCTL_USE_RTS_CTS) | ||
1491 | rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_RTS); | ||
1492 | |||
1493 | rthdr->data_retries = status->retry_count; | ||
1494 | |||
1495 | /* XXX: is this sufficient for BPF? */ | ||
1496 | skb_set_mac_header(skb, 0); | ||
1497 | skb->ip_summed = CHECKSUM_UNNECESSARY; | ||
1498 | skb->pkt_type = PACKET_OTHERHOST; | ||
1499 | skb->protocol = htons(ETH_P_802_2); | ||
1500 | memset(skb->cb, 0, sizeof(skb->cb)); | ||
1501 | |||
1502 | rcu_read_lock(); | ||
1503 | list_for_each_entry_rcu(sdata, &local->interfaces, list) { | ||
1504 | if (sdata->vif.type == IEEE80211_IF_TYPE_MNTR) { | ||
1505 | if (!netif_running(sdata->dev)) | ||
1506 | continue; | ||
1507 | |||
1508 | if (prev_dev) { | ||
1509 | skb2 = skb_clone(skb, GFP_ATOMIC); | ||
1510 | if (skb2) { | ||
1511 | skb2->dev = prev_dev; | ||
1512 | netif_rx(skb2); | ||
1513 | } | ||
1514 | } | ||
1515 | |||
1516 | prev_dev = sdata->dev; | ||
1517 | } | ||
1518 | } | ||
1519 | if (prev_dev) { | ||
1520 | skb->dev = prev_dev; | ||
1521 | netif_rx(skb); | ||
1522 | skb = NULL; | ||
1523 | } | ||
1524 | rcu_read_unlock(); | ||
1525 | dev_kfree_skb(skb); | ||
1526 | } | ||
1527 | EXPORT_SYMBOL(ieee80211_tx_status); | ||
1528 | |||
1529 | struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len, | ||
1530 | const struct ieee80211_ops *ops) | ||
1531 | { | ||
1532 | struct ieee80211_local *local; | ||
1533 | int priv_size; | ||
1534 | struct wiphy *wiphy; | ||
1535 | |||
1536 | /* Ensure 32-byte alignment of our private data and hw private data. | ||
1537 | * We use the wiphy priv data for both our ieee80211_local and for | ||
1538 | * the driver's private data | ||
1539 | * | ||
1540 | * In memory it'll be like this: | ||
1541 | * | ||
1542 | * +-------------------------+ | ||
1543 | * | struct wiphy | | ||
1544 | * +-------------------------+ | ||
1545 | * | struct ieee80211_local | | ||
1546 | * +-------------------------+ | ||
1547 | * | driver's private data | | ||
1548 | * +-------------------------+ | ||
1549 | * | ||
1550 | */ | ||
1551 | priv_size = ((sizeof(struct ieee80211_local) + | ||
1552 | NETDEV_ALIGN_CONST) & ~NETDEV_ALIGN_CONST) + | ||
1553 | priv_data_len; | ||
1554 | |||
1555 | wiphy = wiphy_new(&mac80211_config_ops, priv_size); | ||
1556 | |||
1557 | if (!wiphy) | ||
1558 | return NULL; | ||
1559 | |||
1560 | wiphy->privid = mac80211_wiphy_privid; | ||
1561 | |||
1562 | local = wiphy_priv(wiphy); | ||
1563 | local->hw.wiphy = wiphy; | ||
1564 | |||
1565 | local->hw.priv = (char *)local + | ||
1566 | ((sizeof(struct ieee80211_local) + | ||
1567 | NETDEV_ALIGN_CONST) & ~NETDEV_ALIGN_CONST); | ||
1568 | |||
1569 | BUG_ON(!ops->tx); | ||
1570 | BUG_ON(!ops->start); | ||
1571 | BUG_ON(!ops->stop); | ||
1572 | BUG_ON(!ops->config); | ||
1573 | BUG_ON(!ops->add_interface); | ||
1574 | BUG_ON(!ops->remove_interface); | ||
1575 | BUG_ON(!ops->configure_filter); | ||
1576 | local->ops = ops; | ||
1577 | |||
1578 | local->hw.queues = 1; /* default */ | ||
1579 | |||
1580 | local->bridge_packets = 1; | ||
1581 | |||
1582 | local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD; | ||
1583 | local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD; | ||
1584 | local->short_retry_limit = 7; | ||
1585 | local->long_retry_limit = 4; | ||
1586 | local->hw.conf.radio_enabled = 1; | ||
1587 | |||
1588 | INIT_LIST_HEAD(&local->interfaces); | ||
1589 | |||
1590 | INIT_DELAYED_WORK(&local->scan_work, ieee80211_sta_scan_work); | ||
1591 | |||
1592 | sta_info_init(local); | ||
1593 | |||
1594 | tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending, | ||
1595 | (unsigned long)local); | ||
1596 | tasklet_disable(&local->tx_pending_tasklet); | ||
1597 | |||
1598 | tasklet_init(&local->tasklet, | ||
1599 | ieee80211_tasklet_handler, | ||
1600 | (unsigned long) local); | ||
1601 | tasklet_disable(&local->tasklet); | ||
1602 | |||
1603 | skb_queue_head_init(&local->skb_queue); | ||
1604 | skb_queue_head_init(&local->skb_queue_unreliable); | ||
1605 | |||
1606 | return local_to_hw(local); | ||
1607 | } | ||
1608 | EXPORT_SYMBOL(ieee80211_alloc_hw); | ||
1609 | |||
1610 | int ieee80211_register_hw(struct ieee80211_hw *hw) | ||
1611 | { | ||
1612 | struct ieee80211_local *local = hw_to_local(hw); | ||
1613 | const char *name; | ||
1614 | int result; | ||
1615 | enum ieee80211_band band; | ||
1616 | struct net_device *mdev; | ||
1617 | struct ieee80211_sub_if_data *sdata; | ||
1618 | |||
1619 | /* | ||
1620 | * generic code guarantees at least one band, | ||
1621 | * set this very early because much code assumes | ||
1622 | * that hw.conf.channel is assigned | ||
1623 | */ | ||
1624 | for (band = 0; band < IEEE80211_NUM_BANDS; band++) { | ||
1625 | struct ieee80211_supported_band *sband; | ||
1626 | |||
1627 | sband = local->hw.wiphy->bands[band]; | ||
1628 | if (sband) { | ||
1629 | /* init channel we're on */ | ||
1630 | local->hw.conf.channel = | ||
1631 | local->oper_channel = | ||
1632 | local->scan_channel = &sband->channels[0]; | ||
1633 | break; | ||
1634 | } | ||
1635 | } | ||
1636 | |||
1637 | result = wiphy_register(local->hw.wiphy); | ||
1638 | if (result < 0) | ||
1639 | return result; | ||
1640 | |||
1641 | /* for now, mdev needs sub_if_data :/ */ | ||
1642 | mdev = alloc_netdev(sizeof(struct ieee80211_sub_if_data), | ||
1643 | "wmaster%d", ether_setup); | ||
1644 | if (!mdev) | ||
1645 | goto fail_mdev_alloc; | ||
1646 | |||
1647 | sdata = IEEE80211_DEV_TO_SUB_IF(mdev); | ||
1648 | mdev->ieee80211_ptr = &sdata->wdev; | ||
1649 | sdata->wdev.wiphy = local->hw.wiphy; | ||
1650 | |||
1651 | local->mdev = mdev; | ||
1652 | |||
1653 | ieee80211_rx_bss_list_init(mdev); | ||
1654 | |||
1655 | mdev->hard_start_xmit = ieee80211_master_start_xmit; | ||
1656 | mdev->open = ieee80211_master_open; | ||
1657 | mdev->stop = ieee80211_master_stop; | ||
1658 | mdev->type = ARPHRD_IEEE80211; | ||
1659 | mdev->header_ops = &ieee80211_header_ops; | ||
1660 | mdev->set_multicast_list = ieee80211_master_set_multicast_list; | ||
1661 | |||
1662 | sdata->vif.type = IEEE80211_IF_TYPE_AP; | ||
1663 | sdata->dev = mdev; | ||
1664 | sdata->local = local; | ||
1665 | sdata->u.ap.force_unicast_rateidx = -1; | ||
1666 | sdata->u.ap.max_ratectrl_rateidx = -1; | ||
1667 | ieee80211_if_sdata_init(sdata); | ||
1668 | |||
1669 | /* no RCU needed since we're still during init phase */ | ||
1670 | list_add_tail(&sdata->list, &local->interfaces); | ||
1671 | |||
1672 | name = wiphy_dev(local->hw.wiphy)->driver->name; | ||
1673 | local->hw.workqueue = create_singlethread_workqueue(name); | ||
1674 | if (!local->hw.workqueue) { | ||
1675 | result = -ENOMEM; | ||
1676 | goto fail_workqueue; | ||
1677 | } | ||
1678 | |||
1679 | /* | ||
1680 | * The hardware needs headroom for sending the frame, | ||
1681 | * and we need some headroom for passing the frame to monitor | ||
1682 | * interfaces, but never both at the same time. | ||
1683 | */ | ||
1684 | local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom, | ||
1685 | sizeof(struct ieee80211_tx_status_rtap_hdr)); | ||
1686 | |||
1687 | debugfs_hw_add(local); | ||
1688 | |||
1689 | local->hw.conf.beacon_int = 1000; | ||
1690 | |||
1691 | local->wstats_flags |= local->hw.max_rssi ? | ||
1692 | IW_QUAL_LEVEL_UPDATED : IW_QUAL_LEVEL_INVALID; | ||
1693 | local->wstats_flags |= local->hw.max_signal ? | ||
1694 | IW_QUAL_QUAL_UPDATED : IW_QUAL_QUAL_INVALID; | ||
1695 | local->wstats_flags |= local->hw.max_noise ? | ||
1696 | IW_QUAL_NOISE_UPDATED : IW_QUAL_NOISE_INVALID; | ||
1697 | if (local->hw.max_rssi < 0 || local->hw.max_noise < 0) | ||
1698 | local->wstats_flags |= IW_QUAL_DBM; | ||
1699 | |||
1700 | result = sta_info_start(local); | ||
1701 | if (result < 0) | ||
1702 | goto fail_sta_info; | ||
1703 | |||
1704 | rtnl_lock(); | ||
1705 | result = dev_alloc_name(local->mdev, local->mdev->name); | ||
1706 | if (result < 0) | ||
1707 | goto fail_dev; | ||
1708 | |||
1709 | memcpy(local->mdev->dev_addr, local->hw.wiphy->perm_addr, ETH_ALEN); | ||
1710 | SET_NETDEV_DEV(local->mdev, wiphy_dev(local->hw.wiphy)); | ||
1711 | |||
1712 | result = register_netdevice(local->mdev); | ||
1713 | if (result < 0) | ||
1714 | goto fail_dev; | ||
1715 | |||
1716 | ieee80211_debugfs_add_netdev(IEEE80211_DEV_TO_SUB_IF(local->mdev)); | ||
1717 | ieee80211_if_set_type(local->mdev, IEEE80211_IF_TYPE_AP); | ||
1718 | |||
1719 | result = ieee80211_init_rate_ctrl_alg(local, | ||
1720 | hw->rate_control_algorithm); | ||
1721 | if (result < 0) { | ||
1722 | printk(KERN_DEBUG "%s: Failed to initialize rate control " | ||
1723 | "algorithm\n", wiphy_name(local->hw.wiphy)); | ||
1724 | goto fail_rate; | ||
1725 | } | ||
1726 | |||
1727 | result = ieee80211_wep_init(local); | ||
1728 | |||
1729 | if (result < 0) { | ||
1730 | printk(KERN_DEBUG "%s: Failed to initialize wep\n", | ||
1731 | wiphy_name(local->hw.wiphy)); | ||
1732 | goto fail_wep; | ||
1733 | } | ||
1734 | |||
1735 | ieee80211_install_qdisc(local->mdev); | ||
1736 | |||
1737 | /* add one default STA interface */ | ||
1738 | result = ieee80211_if_add(local->mdev, "wlan%d", NULL, | ||
1739 | IEEE80211_IF_TYPE_STA, NULL); | ||
1740 | if (result) | ||
1741 | printk(KERN_WARNING "%s: Failed to add default virtual iface\n", | ||
1742 | wiphy_name(local->hw.wiphy)); | ||
1743 | |||
1744 | local->reg_state = IEEE80211_DEV_REGISTERED; | ||
1745 | rtnl_unlock(); | ||
1746 | |||
1747 | ieee80211_led_init(local); | ||
1748 | |||
1749 | return 0; | ||
1750 | |||
1751 | fail_wep: | ||
1752 | rate_control_deinitialize(local); | ||
1753 | fail_rate: | ||
1754 | ieee80211_debugfs_remove_netdev(IEEE80211_DEV_TO_SUB_IF(local->mdev)); | ||
1755 | unregister_netdevice(local->mdev); | ||
1756 | fail_dev: | ||
1757 | rtnl_unlock(); | ||
1758 | sta_info_stop(local); | ||
1759 | fail_sta_info: | ||
1760 | debugfs_hw_del(local); | ||
1761 | destroy_workqueue(local->hw.workqueue); | ||
1762 | fail_workqueue: | ||
1763 | ieee80211_if_free(local->mdev); | ||
1764 | local->mdev = NULL; | ||
1765 | fail_mdev_alloc: | ||
1766 | wiphy_unregister(local->hw.wiphy); | ||
1767 | return result; | ||
1768 | } | ||
1769 | EXPORT_SYMBOL(ieee80211_register_hw); | ||
1770 | |||
1771 | void ieee80211_unregister_hw(struct ieee80211_hw *hw) | ||
1772 | { | ||
1773 | struct ieee80211_local *local = hw_to_local(hw); | ||
1774 | struct ieee80211_sub_if_data *sdata, *tmp; | ||
1775 | |||
1776 | tasklet_kill(&local->tx_pending_tasklet); | ||
1777 | tasklet_kill(&local->tasklet); | ||
1778 | |||
1779 | rtnl_lock(); | ||
1780 | |||
1781 | BUG_ON(local->reg_state != IEEE80211_DEV_REGISTERED); | ||
1782 | |||
1783 | local->reg_state = IEEE80211_DEV_UNREGISTERED; | ||
1784 | |||
1785 | /* | ||
1786 | * At this point, interface list manipulations are fine | ||
1787 | * because the driver cannot be handing us frames any | ||
1788 | * more and the tasklet is killed. | ||
1789 | */ | ||
1790 | |||
1791 | /* | ||
1792 | * First, we remove all non-master interfaces. Do this because they | ||
1793 | * may have bss pointer dependency on the master, and when we free | ||
1794 | * the master these would be freed as well, breaking our list | ||
1795 | * iteration completely. | ||
1796 | */ | ||
1797 | list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) { | ||
1798 | if (sdata->dev == local->mdev) | ||
1799 | continue; | ||
1800 | list_del(&sdata->list); | ||
1801 | __ieee80211_if_del(local, sdata); | ||
1802 | } | ||
1803 | |||
1804 | /* then, finally, remove the master interface */ | ||
1805 | __ieee80211_if_del(local, IEEE80211_DEV_TO_SUB_IF(local->mdev)); | ||
1806 | |||
1807 | rtnl_unlock(); | ||
1808 | |||
1809 | ieee80211_rx_bss_list_deinit(local->mdev); | ||
1810 | ieee80211_clear_tx_pending(local); | ||
1811 | sta_info_stop(local); | ||
1812 | rate_control_deinitialize(local); | ||
1813 | debugfs_hw_del(local); | ||
1814 | |||
1815 | if (skb_queue_len(&local->skb_queue) | ||
1816 | || skb_queue_len(&local->skb_queue_unreliable)) | ||
1817 | printk(KERN_WARNING "%s: skb_queue not empty\n", | ||
1818 | wiphy_name(local->hw.wiphy)); | ||
1819 | skb_queue_purge(&local->skb_queue); | ||
1820 | skb_queue_purge(&local->skb_queue_unreliable); | ||
1821 | |||
1822 | destroy_workqueue(local->hw.workqueue); | ||
1823 | wiphy_unregister(local->hw.wiphy); | ||
1824 | ieee80211_wep_free(local); | ||
1825 | ieee80211_led_exit(local); | ||
1826 | ieee80211_if_free(local->mdev); | ||
1827 | local->mdev = NULL; | ||
1828 | } | ||
1829 | EXPORT_SYMBOL(ieee80211_unregister_hw); | ||
1830 | |||
1831 | void ieee80211_free_hw(struct ieee80211_hw *hw) | ||
1832 | { | ||
1833 | struct ieee80211_local *local = hw_to_local(hw); | ||
1834 | |||
1835 | wiphy_free(local->hw.wiphy); | ||
1836 | } | ||
1837 | EXPORT_SYMBOL(ieee80211_free_hw); | ||
1838 | |||
1839 | static int __init ieee80211_init(void) | ||
1840 | { | ||
1841 | struct sk_buff *skb; | ||
1842 | int ret; | ||
1843 | |||
1844 | BUILD_BUG_ON(sizeof(struct ieee80211_tx_packet_data) > sizeof(skb->cb)); | ||
1845 | |||
1846 | ret = rc80211_pid_init(); | ||
1847 | if (ret) | ||
1848 | goto out; | ||
1849 | |||
1850 | ret = ieee80211_wme_register(); | ||
1851 | if (ret) { | ||
1852 | printk(KERN_DEBUG "ieee80211_init: failed to " | ||
1853 | "initialize WME (err=%d)\n", ret); | ||
1854 | goto out_cleanup_pid; | ||
1855 | } | ||
1856 | |||
1857 | ieee80211_debugfs_netdev_init(); | ||
1858 | |||
1859 | return 0; | ||
1860 | |||
1861 | out_cleanup_pid: | ||
1862 | rc80211_pid_exit(); | ||
1863 | out: | ||
1864 | return ret; | ||
1865 | } | ||
1866 | |||
1867 | static void __exit ieee80211_exit(void) | ||
1868 | { | ||
1869 | rc80211_pid_exit(); | ||
1870 | |||
1871 | /* | ||
1872 | * For key todo, it'll be empty by now but the work | ||
1873 | * might still be scheduled. | ||
1874 | */ | ||
1875 | flush_scheduled_work(); | ||
1876 | |||
1877 | if (mesh_allocated) | ||
1878 | ieee80211s_stop(); | ||
1879 | |||
1880 | ieee80211_wme_unregister(); | ||
1881 | ieee80211_debugfs_netdev_exit(); | ||
1882 | } | ||
1883 | |||
1884 | |||
1885 | subsys_initcall(ieee80211_init); | ||
1886 | module_exit(ieee80211_exit); | ||
1887 | |||
1888 | MODULE_DESCRIPTION("IEEE 802.11 subsystem"); | ||
1889 | MODULE_LICENSE("GPL"); | ||