?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
dma-debug: update DMA debug API to better handle multiple mappings of a buffer
[linux-2.6/cjktty.git] / net / mac80211 / iface.c
blobbaaa8608e52de8d9d504f14a254bb7e6631b5f2e
1 /*
2 * Interface handling (except master interface)
3 *
4 * Copyright 2002-2005, Instant802 Networks, Inc.
5 * Copyright 2005-2006, Devicescape Software, Inc.
6 * Copyright (c) 2006 Jiri Benc <jbenc@suse.cz>
7 * Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
12 */
13 #include <linux/slab.h>
14 #include <linux/kernel.h>
15 #include <linux/if_arp.h>
16 #include <linux/netdevice.h>
17 #include <linux/rtnetlink.h>
18 #include <net/mac80211.h>
19 #include <net/ieee80211_radiotap.h>
20 #include "ieee80211_i.h"
21 #include "sta_info.h"
22 #include "debugfs_netdev.h"
23 #include "mesh.h"
24 #include "led.h"
25 #include "driver-ops.h"
26 #include "wme.h"
27 #include "rate.h"
28
29 /**
30 * DOC: Interface list locking
31 *
32 * The interface list in each struct ieee80211_local is protected
33 * three-fold:
34 *
35 * (1) modifications may only be done under the RTNL
36 * (2) modifications and readers are protected against each other by
37 * the iflist_mtx.
38 * (3) modifications are done in an RCU manner so atomic readers
39 * can traverse the list in RCU-safe blocks.
40 *
41 * As a consequence, reads (traversals) of the list can be protected
42 * by either the RTNL, the iflist_mtx or RCU.
43 */
44
45 bool __ieee80211_recalc_txpower(struct ieee80211_sub_if_data *sdata)
46 {
47 struct ieee80211_chanctx_conf *chanctx_conf;
48 int power;
49
50 rcu_read_lock();
51 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
52 if (!chanctx_conf) {
53 rcu_read_unlock();
54 return false;
55 }
56
57 power = chanctx_conf->def.chan->max_power;
58 rcu_read_unlock();
59
60 if (sdata->user_power_level != IEEE80211_UNSET_POWER_LEVEL)
61 power = min(power, sdata->user_power_level);
62
63 if (sdata->ap_power_level != IEEE80211_UNSET_POWER_LEVEL)
64 power = min(power, sdata->ap_power_level);
65
66 if (power != sdata->vif.bss_conf.txpower) {
67 sdata->vif.bss_conf.txpower = power;
68 ieee80211_hw_config(sdata->local, 0);
69 return true;
70 }
71
72 return false;
73 }
74
75 void ieee80211_recalc_txpower(struct ieee80211_sub_if_data *sdata)
76 {
77 if (__ieee80211_recalc_txpower(sdata))
78 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_TXPOWER);
79 }
80
81 static u32 ieee80211_idle_off(struct ieee80211_local *local)
82 {
83 if (!(local->hw.conf.flags & IEEE80211_CONF_IDLE))
84 return 0;
85
86 local->hw.conf.flags &= ~IEEE80211_CONF_IDLE;
87 return IEEE80211_CONF_CHANGE_IDLE;
88 }
89
90 static u32 ieee80211_idle_on(struct ieee80211_local *local)
91 {
92 if (local->hw.conf.flags & IEEE80211_CONF_IDLE)
93 return 0;
94
95 drv_flush(local, false);
96
97 local->hw.conf.flags |= IEEE80211_CONF_IDLE;
98 return IEEE80211_CONF_CHANGE_IDLE;
99 }
100
101 void ieee80211_recalc_idle(struct ieee80211_local *local)
102 {
103 bool working = false, scanning, active;
104 unsigned int led_trig_start = 0, led_trig_stop = 0;
105 struct ieee80211_roc_work *roc;
106 u32 change;
107
108 lockdep_assert_held(&local->mtx);
109
110 active = !list_empty(&local->chanctx_list) || local->monitors;
111
112 if (!local->ops->remain_on_channel) {
113 list_for_each_entry(roc, &local->roc_list, list) {
114 working = true;
115 break;
116 }
117 }
118
119 scanning = test_bit(SCAN_SW_SCANNING, &local->scanning) ||
120 test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning);
121
122 if (working || scanning)
123 led_trig_start |= IEEE80211_TPT_LEDTRIG_FL_WORK;
124 else
125 led_trig_stop |= IEEE80211_TPT_LEDTRIG_FL_WORK;
126
127 if (active)
128 led_trig_start |= IEEE80211_TPT_LEDTRIG_FL_CONNECTED;
129 else
130 led_trig_stop |= IEEE80211_TPT_LEDTRIG_FL_CONNECTED;
131
132 ieee80211_mod_tpt_led_trig(local, led_trig_start, led_trig_stop);
133
134 if (working || scanning || active)
135 change = ieee80211_idle_off(local);
136 else
137 change = ieee80211_idle_on(local);
138 if (change)
139 ieee80211_hw_config(local, change);
140 }
141
142 static int ieee80211_change_mtu(struct net_device *dev, int new_mtu)
143 {
144 if (new_mtu < 256 || new_mtu > IEEE80211_MAX_DATA_LEN)
145 return -EINVAL;
146
147 dev->mtu = new_mtu;
148 return 0;
149 }
150
151 static int ieee80211_verify_mac(struct ieee80211_local *local, u8 *addr)
152 {
153 struct ieee80211_sub_if_data *sdata;
154 u64 new, mask, tmp;
155 u8 *m;
156 int ret = 0;
157
158 if (is_zero_ether_addr(local->hw.wiphy->addr_mask))
159 return 0;
160
161 m = addr;
162 new = ((u64)m[0] << 5*8) | ((u64)m[1] << 4*8) |
163 ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) |
164 ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8);
165
166 m = local->hw.wiphy->addr_mask;
167 mask = ((u64)m[0] << 5*8) | ((u64)m[1] << 4*8) |
168 ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) |
169 ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8);
170
171
172 mutex_lock(&local->iflist_mtx);
173 list_for_each_entry(sdata, &local->interfaces, list) {
174 if (sdata->vif.type == NL80211_IFTYPE_MONITOR)
175 continue;
176
177 m = sdata->vif.addr;
178 tmp = ((u64)m[0] << 5*8) | ((u64)m[1] << 4*8) |
179 ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) |
180 ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8);
181
182 if ((new & ~mask) != (tmp & ~mask)) {
183 ret = -EINVAL;
184 break;
185 }
186 }
187 mutex_unlock(&local->iflist_mtx);
188
189 return ret;
190 }
191
192 static int ieee80211_change_mac(struct net_device *dev, void *addr)
193 {
194 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
195 struct sockaddr *sa = addr;
196 int ret;
197
198 if (ieee80211_sdata_running(sdata))
199 return -EBUSY;
200
201 ret = ieee80211_verify_mac(sdata->local, sa->sa_data);
202 if (ret)
203 return ret;
204
205 ret = eth_mac_addr(dev, sa);
206
207 if (ret == 0)
208 memcpy(sdata->vif.addr, sa->sa_data, ETH_ALEN);
209
210 return ret;
211 }
212
213 static inline int identical_mac_addr_allowed(int type1, int type2)
214 {
215 return type1 == NL80211_IFTYPE_MONITOR ||
216 type2 == NL80211_IFTYPE_MONITOR ||
217 type1 == NL80211_IFTYPE_P2P_DEVICE ||
218 type2 == NL80211_IFTYPE_P2P_DEVICE ||
219 (type1 == NL80211_IFTYPE_AP && type2 == NL80211_IFTYPE_WDS) ||
220 (type1 == NL80211_IFTYPE_WDS &&
221 (type2 == NL80211_IFTYPE_WDS ||
222 type2 == NL80211_IFTYPE_AP)) ||
223 (type1 == NL80211_IFTYPE_AP && type2 == NL80211_IFTYPE_AP_VLAN) ||
224 (type1 == NL80211_IFTYPE_AP_VLAN &&
225 (type2 == NL80211_IFTYPE_AP ||
226 type2 == NL80211_IFTYPE_AP_VLAN));
227 }
228
229 static int ieee80211_check_concurrent_iface(struct ieee80211_sub_if_data *sdata,
230 enum nl80211_iftype iftype)
231 {
232 struct ieee80211_local *local = sdata->local;
233 struct ieee80211_sub_if_data *nsdata;
234
235 ASSERT_RTNL();
236
237 /* we hold the RTNL here so can safely walk the list */
238 list_for_each_entry(nsdata, &local->interfaces, list) {
239 if (nsdata != sdata && ieee80211_sdata_running(nsdata)) {
240 /*
241 * Allow only a single IBSS interface to be up at any
242 * time. This is restricted because beacon distribution
243 * cannot work properly if both are in the same IBSS.
244 *
245 * To remove this restriction we'd have to disallow them
246 * from setting the same SSID on different IBSS interfaces
247 * belonging to the same hardware. Then, however, we're
248 * faced with having to adopt two different TSF timers...
249 */
250 if (iftype == NL80211_IFTYPE_ADHOC &&
251 nsdata->vif.type == NL80211_IFTYPE_ADHOC)
252 return -EBUSY;
253
254 /*
255 * The remaining checks are only performed for interfaces
256 * with the same MAC address.
257 */
258 if (!ether_addr_equal(sdata->vif.addr,
259 nsdata->vif.addr))
260 continue;
261
262 /*
263 * check whether it may have the same address
264 */
265 if (!identical_mac_addr_allowed(iftype,
266 nsdata->vif.type))
267 return -ENOTUNIQ;
268
269 /*
270 * can only add VLANs to enabled APs
271 */
272 if (iftype == NL80211_IFTYPE_AP_VLAN &&
273 nsdata->vif.type == NL80211_IFTYPE_AP)
274 sdata->bss = &nsdata->u.ap;
275 }
276 }
277
278 return 0;
279 }
280
281 static int ieee80211_check_queues(struct ieee80211_sub_if_data *sdata)
282 {
283 int n_queues = sdata->local->hw.queues;
284 int i;
285
286 if (sdata->vif.type != NL80211_IFTYPE_P2P_DEVICE) {
287 for (i = 0; i < IEEE80211_NUM_ACS; i++) {
288 if (WARN_ON_ONCE(sdata->vif.hw_queue[i] ==
289 IEEE80211_INVAL_HW_QUEUE))
290 return -EINVAL;
291 if (WARN_ON_ONCE(sdata->vif.hw_queue[i] >=
292 n_queues))
293 return -EINVAL;
294 }
295 }
296
297 if ((sdata->vif.type != NL80211_IFTYPE_AP &&
298 sdata->vif.type != NL80211_IFTYPE_MESH_POINT) ||
299 !(sdata->local->hw.flags & IEEE80211_HW_QUEUE_CONTROL)) {
300 sdata->vif.cab_queue = IEEE80211_INVAL_HW_QUEUE;
301 return 0;
302 }
303
304 if (WARN_ON_ONCE(sdata->vif.cab_queue == IEEE80211_INVAL_HW_QUEUE))
305 return -EINVAL;
306
307 if (WARN_ON_ONCE(sdata->vif.cab_queue >= n_queues))
308 return -EINVAL;
309
310 return 0;
311 }
312
313 void ieee80211_adjust_monitor_flags(struct ieee80211_sub_if_data *sdata,
314 const int offset)
315 {
316 struct ieee80211_local *local = sdata->local;
317 u32 flags = sdata->u.mntr_flags;
318
319 #define ADJUST(_f, _s) do { \
320 if (flags & MONITOR_FLAG_##_f) \
321 local->fif_##_s += offset; \
322 } while (0)
323
324 ADJUST(FCSFAIL, fcsfail);
325 ADJUST(PLCPFAIL, plcpfail);
326 ADJUST(CONTROL, control);
327 ADJUST(CONTROL, pspoll);
328 ADJUST(OTHER_BSS, other_bss);
329
330 #undef ADJUST
331 }
332
333 static void ieee80211_set_default_queues(struct ieee80211_sub_if_data *sdata)
334 {
335 struct ieee80211_local *local = sdata->local;
336 int i;
337
338 for (i = 0; i < IEEE80211_NUM_ACS; i++) {
339 if (local->hw.flags & IEEE80211_HW_QUEUE_CONTROL)
340 sdata->vif.hw_queue[i] = IEEE80211_INVAL_HW_QUEUE;
341 else if (local->hw.queues >= IEEE80211_NUM_ACS)
342 sdata->vif.hw_queue[i] = i;
343 else
344 sdata->vif.hw_queue[i] = 0;
345 }
346 sdata->vif.cab_queue = IEEE80211_INVAL_HW_QUEUE;
347 }
348
349 static int ieee80211_add_virtual_monitor(struct ieee80211_local *local)
350 {
351 struct ieee80211_sub_if_data *sdata;
352 int ret = 0;
353
354 if (!(local->hw.flags & IEEE80211_HW_WANT_MONITOR_VIF))
355 return 0;
356
357 mutex_lock(&local->iflist_mtx);
358
359 if (local->monitor_sdata)
360 goto out_unlock;
361
362 sdata = kzalloc(sizeof(*sdata) + local->hw.vif_data_size, GFP_KERNEL);
363 if (!sdata) {
364 ret = -ENOMEM;
365 goto out_unlock;
366 }
367
368 /* set up data */
369 sdata->local = local;
370 sdata->vif.type = NL80211_IFTYPE_MONITOR;
371 snprintf(sdata->name, IFNAMSIZ, "%s-monitor",
372 wiphy_name(local->hw.wiphy));
373
374 ieee80211_set_default_queues(sdata);
375
376 ret = drv_add_interface(local, sdata);
377 if (WARN_ON(ret)) {
378 /* ok .. stupid driver, it asked for this! */
379 kfree(sdata);
380 goto out_unlock;
381 }
382
383 ret = ieee80211_check_queues(sdata);
384 if (ret) {
385 kfree(sdata);
386 goto out_unlock;
387 }
388
389 ret = ieee80211_vif_use_channel(sdata, &local->monitor_chandef,
390 IEEE80211_CHANCTX_EXCLUSIVE);
391 if (ret) {
392 drv_remove_interface(local, sdata);
393 kfree(sdata);
394 goto out_unlock;
395 }
396
397 rcu_assign_pointer(local->monitor_sdata, sdata);
398 out_unlock:
399 mutex_unlock(&local->iflist_mtx);
400 return ret;
401 }
402
403 static void ieee80211_del_virtual_monitor(struct ieee80211_local *local)
404 {
405 struct ieee80211_sub_if_data *sdata;
406
407 if (!(local->hw.flags & IEEE80211_HW_WANT_MONITOR_VIF))
408 return;
409
410 mutex_lock(&local->iflist_mtx);
411
412 sdata = rcu_dereference_protected(local->monitor_sdata,
413 lockdep_is_held(&local->iflist_mtx));
414 if (!sdata)
415 goto out_unlock;
416
417 rcu_assign_pointer(local->monitor_sdata, NULL);
418 synchronize_net();
419
420 ieee80211_vif_release_channel(sdata);
421
422 drv_remove_interface(local, sdata);
423
424 kfree(sdata);
425 out_unlock:
426 mutex_unlock(&local->iflist_mtx);
427 }
428
429 /*
430 * NOTE: Be very careful when changing this function, it must NOT return
431 * an error on interface type changes that have been pre-checked, so most
432 * checks should be in ieee80211_check_concurrent_iface.
433 */
434 int ieee80211_do_open(struct wireless_dev *wdev, bool coming_up)
435 {
436 struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
437 struct net_device *dev = wdev->netdev;
438 struct ieee80211_local *local = sdata->local;
439 struct sta_info *sta;
440 u32 changed = 0;
441 int res;
442 u32 hw_reconf_flags = 0;
443
444 switch (sdata->vif.type) {
445 case NL80211_IFTYPE_WDS:
446 if (!is_valid_ether_addr(sdata->u.wds.remote_addr))
447 return -ENOLINK;
448 break;
449 case NL80211_IFTYPE_AP_VLAN: {
450 struct ieee80211_sub_if_data *master;
451
452 if (!sdata->bss)
453 return -ENOLINK;
454
455 list_add(&sdata->u.vlan.list, &sdata->bss->vlans);
456
457 master = container_of(sdata->bss,
458 struct ieee80211_sub_if_data, u.ap);
459 sdata->control_port_protocol =
460 master->control_port_protocol;
461 sdata->control_port_no_encrypt =
462 master->control_port_no_encrypt;
463 break;
464 }
465 case NL80211_IFTYPE_AP:
466 sdata->bss = &sdata->u.ap;
467 break;
468 case NL80211_IFTYPE_MESH_POINT:
469 case NL80211_IFTYPE_STATION:
470 case NL80211_IFTYPE_MONITOR:
471 case NL80211_IFTYPE_ADHOC:
472 case NL80211_IFTYPE_P2P_DEVICE:
473 /* no special treatment */
474 break;
475 case NL80211_IFTYPE_UNSPECIFIED:
476 case NUM_NL80211_IFTYPES:
477 case NL80211_IFTYPE_P2P_CLIENT:
478 case NL80211_IFTYPE_P2P_GO:
479 /* cannot happen */
480 WARN_ON(1);
481 break;
482 }
483
484 if (local->open_count == 0) {
485 res = drv_start(local);
486 if (res)
487 goto err_del_bss;
488 if (local->ops->napi_poll)
489 napi_enable(&local->napi);
490 /* we're brought up, everything changes */
491 hw_reconf_flags = ~0;
492 ieee80211_led_radio(local, true);
493 ieee80211_mod_tpt_led_trig(local,
494 IEEE80211_TPT_LEDTRIG_FL_RADIO, 0);
495 }
496
497 /*
498 * Copy the hopefully now-present MAC address to
499 * this interface, if it has the special null one.
500 */
501 if (dev && is_zero_ether_addr(dev->dev_addr)) {
502 memcpy(dev->dev_addr,
503 local->hw.wiphy->perm_addr,
504 ETH_ALEN);
505 memcpy(dev->perm_addr, dev->dev_addr, ETH_ALEN);
506
507 if (!is_valid_ether_addr(dev->dev_addr)) {
508 res = -EADDRNOTAVAIL;
509 goto err_stop;
510 }
511 }
512
513 switch (sdata->vif.type) {
514 case NL80211_IFTYPE_AP_VLAN:
515 /* no need to tell driver, but set carrier and chanctx */
516 if (rtnl_dereference(sdata->bss->beacon)) {
517 ieee80211_vif_vlan_copy_chanctx(sdata);
518 netif_carrier_on(dev);
519 } else {
520 netif_carrier_off(dev);
521 }
522 break;
523 case NL80211_IFTYPE_MONITOR:
524 if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) {
525 local->cooked_mntrs++;
526 break;
527 }
528
529 if (local->monitors == 0 && local->open_count == 0) {
530 res = ieee80211_add_virtual_monitor(local);
531 if (res)
532 goto err_stop;
533 }
534
535 /* must be before the call to ieee80211_configure_filter */
536 local->monitors++;
537 if (local->monitors == 1) {
538 local->hw.conf.flags |= IEEE80211_CONF_MONITOR;
539 hw_reconf_flags |= IEEE80211_CONF_CHANGE_MONITOR;
540 }
541
542 ieee80211_adjust_monitor_flags(sdata, 1);
543 ieee80211_configure_filter(local);
544 mutex_lock(&local->mtx);
545 ieee80211_recalc_idle(local);
546 mutex_unlock(&local->mtx);
547
548 netif_carrier_on(dev);
549 break;
550 default:
551 if (coming_up) {
552 ieee80211_del_virtual_monitor(local);
553
554 res = drv_add_interface(local, sdata);
555 if (res)
556 goto err_stop;
557 res = ieee80211_check_queues(sdata);
558 if (res)
559 goto err_del_interface;
560 }
561
562 drv_add_interface_debugfs(local, sdata);
563
564 if (sdata->vif.type == NL80211_IFTYPE_AP) {
565 local->fif_pspoll++;
566 local->fif_probe_req++;
567
568 ieee80211_configure_filter(local);
569 } else if (sdata->vif.type == NL80211_IFTYPE_ADHOC) {
570 local->fif_probe_req++;
571 }
572
573 if (sdata->vif.type != NL80211_IFTYPE_P2P_DEVICE)
574 changed |= ieee80211_reset_erp_info(sdata);
575 ieee80211_bss_info_change_notify(sdata, changed);
576
577 switch (sdata->vif.type) {
578 case NL80211_IFTYPE_STATION:
579 case NL80211_IFTYPE_ADHOC:
580 case NL80211_IFTYPE_AP:
581 case NL80211_IFTYPE_MESH_POINT:
582 netif_carrier_off(dev);
583 break;
584 case NL80211_IFTYPE_WDS:
585 case NL80211_IFTYPE_P2P_DEVICE:
586 break;
587 default:
588 netif_carrier_on(dev);
589 }
590
591 /*
592 * set default queue parameters so drivers don't
593 * need to initialise the hardware if the hardware
594 * doesn't start up with sane defaults
595 */
596 ieee80211_set_wmm_default(sdata, true);
597 }
598
599 set_bit(SDATA_STATE_RUNNING, &sdata->state);
600
601 if (sdata->vif.type == NL80211_IFTYPE_WDS) {
602 /* Create STA entry for the WDS peer */
603 sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr,
604 GFP_KERNEL);
605 if (!sta) {
606 res = -ENOMEM;
607 goto err_del_interface;
608 }
609
610 sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
611 sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
612 sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED);
613
614 res = sta_info_insert(sta);
615 if (res) {
616 /* STA has been freed */
617 goto err_del_interface;
618 }
619
620 rate_control_rate_init(sta);
621 netif_carrier_on(dev);
622 } else if (sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE) {
623 rcu_assign_pointer(local->p2p_sdata, sdata);
624 }
625
626 /*
627 * set_multicast_list will be invoked by the networking core
628 * which will check whether any increments here were done in
629 * error and sync them down to the hardware as filter flags.
630 */
631 if (sdata->flags & IEEE80211_SDATA_ALLMULTI)
632 atomic_inc(&local->iff_allmultis);
633
634 if (sdata->flags & IEEE80211_SDATA_PROMISC)
635 atomic_inc(&local->iff_promiscs);
636
637 if (coming_up)
638 local->open_count++;
639
640 if (hw_reconf_flags)
641 ieee80211_hw_config(local, hw_reconf_flags);
642
643 ieee80211_recalc_ps(local, -1);
644
645 if (dev)
646 netif_tx_start_all_queues(dev);
647
648 return 0;
649 err_del_interface:
650 drv_remove_interface(local, sdata);
651 err_stop:
652 if (!local->open_count)
653 drv_stop(local);
654 err_del_bss:
655 sdata->bss = NULL;
656 if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
657 list_del(&sdata->u.vlan.list);
658 /* might already be clear but that doesn't matter */
659 clear_bit(SDATA_STATE_RUNNING, &sdata->state);
660 return res;
661 }
662
663 static int ieee80211_open(struct net_device *dev)
664 {
665 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
666 int err;
667
668 /* fail early if user set an invalid address */
669 if (!is_valid_ether_addr(dev->dev_addr))
670 return -EADDRNOTAVAIL;
671
672 err = ieee80211_check_concurrent_iface(sdata, sdata->vif.type);
673 if (err)
674 return err;
675
676 return ieee80211_do_open(&sdata->wdev, true);
677 }
678
679 static void ieee80211_do_stop(struct ieee80211_sub_if_data *sdata,
680 bool going_down)
681 {
682 struct ieee80211_local *local = sdata->local;
683 unsigned long flags;
684 struct sk_buff *skb, *tmp;
685 u32 hw_reconf_flags = 0;
686 int i, flushed;
687 struct ps_data *ps;
688
689 clear_bit(SDATA_STATE_RUNNING, &sdata->state);
690
691 if (rcu_access_pointer(local->scan_sdata) == sdata)
692 ieee80211_scan_cancel(local);
693
694 /*
695 * Stop TX on this interface first.
696 */
697 if (sdata->dev)
698 netif_tx_stop_all_queues(sdata->dev);
699
700 ieee80211_roc_purge(sdata);
701
702 if (sdata->vif.type == NL80211_IFTYPE_STATION)
703 ieee80211_mgd_stop(sdata);
704
705 /*
706 * Remove all stations associated with this interface.
707 *
708 * This must be done before calling ops->remove_interface()
709 * because otherwise we can later invoke ops->sta_notify()
710 * whenever the STAs are removed, and that invalidates driver
711 * assumptions about always getting a vif pointer that is valid
712 * (because if we remove a STA after ops->remove_interface()
713 * the driver will have removed the vif info already!)
714 *
715 * This is relevant only in WDS mode, in all other modes we've
716 * already removed all stations when disconnecting or similar,
717 * so warn otherwise.
718 *
719 * We call sta_info_flush_cleanup() later, to combine RCU waits.
720 */
721 flushed = sta_info_flush_defer(sdata);
722 WARN_ON_ONCE((sdata->vif.type != NL80211_IFTYPE_WDS && flushed > 0) ||
723 (sdata->vif.type == NL80211_IFTYPE_WDS && flushed != 1));
724
725 /*
726 * Don't count this interface for promisc/allmulti while it
727 * is down. dev_mc_unsync() will invoke set_multicast_list
728 * on the master interface which will sync these down to the
729 * hardware as filter flags.
730 */
731 if (sdata->flags & IEEE80211_SDATA_ALLMULTI)
732 atomic_dec(&local->iff_allmultis);
733
734 if (sdata->flags & IEEE80211_SDATA_PROMISC)
735 atomic_dec(&local->iff_promiscs);
736
737 if (sdata->vif.type == NL80211_IFTYPE_AP) {
738 local->fif_pspoll--;
739 local->fif_probe_req--;
740 } else if (sdata->vif.type == NL80211_IFTYPE_ADHOC) {
741 local->fif_probe_req--;
742 }
743
744 if (sdata->dev) {
745 netif_addr_lock_bh(sdata->dev);
746 spin_lock_bh(&local->filter_lock);
747 __hw_addr_unsync(&local->mc_list, &sdata->dev->mc,
748 sdata->dev->addr_len);
749 spin_unlock_bh(&local->filter_lock);
750 netif_addr_unlock_bh(sdata->dev);
751
752 ieee80211_configure_filter(local);
753 }
754
755 del_timer_sync(&local->dynamic_ps_timer);
756 cancel_work_sync(&local->dynamic_ps_enable_work);
757
758 cancel_work_sync(&sdata->recalc_smps);
759
760 cancel_delayed_work_sync(&sdata->dfs_cac_timer_work);
761
762 if (sdata->wdev.cac_started) {
763 mutex_lock(&local->iflist_mtx);
764 ieee80211_vif_release_channel(sdata);
765 mutex_unlock(&local->iflist_mtx);
766 cfg80211_cac_event(sdata->dev, NL80211_RADAR_CAC_ABORTED,
767 GFP_KERNEL);
768 }
769
770 /* APs need special treatment */
771 if (sdata->vif.type == NL80211_IFTYPE_AP) {
772 struct ieee80211_sub_if_data *vlan, *tmpsdata;
773
774 /* down all dependent devices, that is VLANs */
775 list_for_each_entry_safe(vlan, tmpsdata, &sdata->u.ap.vlans,
776 u.vlan.list)
777 dev_close(vlan->dev);
778 WARN_ON(!list_empty(&sdata->u.ap.vlans));
779 } else if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
780 /* remove all packets in parent bc_buf pointing to this dev */
781 ps = &sdata->bss->ps;
782
783 spin_lock_irqsave(&ps->bc_buf.lock, flags);
784 skb_queue_walk_safe(&ps->bc_buf, skb, tmp) {
785 if (skb->dev == sdata->dev) {
786 __skb_unlink(skb, &ps->bc_buf);
787 local->total_ps_buffered--;
788 ieee80211_free_txskb(&local->hw, skb);
789 }
790 }
791 spin_unlock_irqrestore(&ps->bc_buf.lock, flags);
792 }
793
794 if (going_down)
795 local->open_count--;
796
797 switch (sdata->vif.type) {
798 case NL80211_IFTYPE_AP_VLAN:
799 list_del(&sdata->u.vlan.list);
800 rcu_assign_pointer(sdata->vif.chanctx_conf, NULL);
801 /* no need to tell driver */
802 break;
803 case NL80211_IFTYPE_MONITOR:
804 if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) {
805 local->cooked_mntrs--;
806 break;
807 }
808
809 local->monitors--;
810 if (local->monitors == 0) {
811 local->hw.conf.flags &= ~IEEE80211_CONF_MONITOR;
812 hw_reconf_flags |= IEEE80211_CONF_CHANGE_MONITOR;
813 ieee80211_del_virtual_monitor(local);
814 }
815
816 ieee80211_adjust_monitor_flags(sdata, -1);
817 ieee80211_configure_filter(local);
818 mutex_lock(&local->mtx);
819 ieee80211_recalc_idle(local);
820 mutex_unlock(&local->mtx);
821 break;
822 case NL80211_IFTYPE_P2P_DEVICE:
823 /* relies on synchronize_rcu() below */
824 rcu_assign_pointer(local->p2p_sdata, NULL);
825 /* fall through */
826 default:
827 cancel_work_sync(&sdata->work);
828 /*
829 * When we get here, the interface is marked down.
830 *
831 * sta_info_flush_cleanup() requires rcu_barrier()
832 * first to wait for the station call_rcu() calls
833 * to complete, here we need at least sychronize_rcu()
834 * it to wait for the RX path in case it is using the
835 * interface and enqueuing frames at this very time on
836 * another CPU.
837 */
838 rcu_barrier();
839 sta_info_flush_cleanup(sdata);
840
841 skb_queue_purge(&sdata->skb_queue);
842
843 /*
844 * Free all remaining keys, there shouldn't be any,
845 * except maybe group keys in AP more or WDS?
846 */
847 ieee80211_free_keys(sdata);
848
849 drv_remove_interface_debugfs(local, sdata);
850
851 if (going_down)
852 drv_remove_interface(local, sdata);
853 }
854
855 sdata->bss = NULL;
856
857 ieee80211_recalc_ps(local, -1);
858
859 if (local->open_count == 0) {
860 if (local->ops->napi_poll)
861 napi_disable(&local->napi);
862 ieee80211_clear_tx_pending(local);
863 ieee80211_stop_device(local);
864
865 /* no reconfiguring after stop! */
866 hw_reconf_flags = 0;
867 }
868
869 /* do after stop to avoid reconfiguring when we stop anyway */
870 if (hw_reconf_flags)
871 ieee80211_hw_config(local, hw_reconf_flags);
872
873 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
874 for (i = 0; i < IEEE80211_MAX_QUEUES; i++) {
875 skb_queue_walk_safe(&local->pending[i], skb, tmp) {
876 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
877 if (info->control.vif == &sdata->vif) {
878 __skb_unlink(skb, &local->pending[i]);
879 ieee80211_free_txskb(&local->hw, skb);
880 }
881 }
882 }
883 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
884
885 if (local->monitors == local->open_count && local->monitors > 0)
886 ieee80211_add_virtual_monitor(local);
887 }
888
889 static int ieee80211_stop(struct net_device *dev)
890 {
891 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
892
893 ieee80211_do_stop(sdata, true);
894
895 return 0;
896 }
897
898 static void ieee80211_set_multicast_list(struct net_device *dev)
899 {
900 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
901 struct ieee80211_local *local = sdata->local;
902 int allmulti, promisc, sdata_allmulti, sdata_promisc;
903
904 allmulti = !!(dev->flags & IFF_ALLMULTI);
905 promisc = !!(dev->flags & IFF_PROMISC);
906 sdata_allmulti = !!(sdata->flags & IEEE80211_SDATA_ALLMULTI);
907 sdata_promisc = !!(sdata->flags & IEEE80211_SDATA_PROMISC);
908
909 if (allmulti != sdata_allmulti) {
910 if (dev->flags & IFF_ALLMULTI)
911 atomic_inc(&local->iff_allmultis);
912 else
913 atomic_dec(&local->iff_allmultis);
914 sdata->flags ^= IEEE80211_SDATA_ALLMULTI;
915 }
916
917 if (promisc != sdata_promisc) {
918 if (dev->flags & IFF_PROMISC)
919 atomic_inc(&local->iff_promiscs);
920 else
921 atomic_dec(&local->iff_promiscs);
922 sdata->flags ^= IEEE80211_SDATA_PROMISC;
923 }
924 spin_lock_bh(&local->filter_lock);
925 __hw_addr_sync(&local->mc_list, &dev->mc, dev->addr_len);
926 spin_unlock_bh(&local->filter_lock);
927 ieee80211_queue_work(&local->hw, &local->reconfig_filter);
928 }
929
930 /*
931 * Called when the netdev is removed or, by the code below, before
932 * the interface type changes.
933 */
934 static void ieee80211_teardown_sdata(struct ieee80211_sub_if_data *sdata)
935 {
936 int flushed;
937 int i;
938
939 /* free extra data */
940 ieee80211_free_keys(sdata);
941
942 ieee80211_debugfs_remove_netdev(sdata);
943
944 for (i = 0; i < IEEE80211_FRAGMENT_MAX; i++)
945 __skb_queue_purge(&sdata->fragments[i].skb_list);
946 sdata->fragment_next = 0;
947
948 if (ieee80211_vif_is_mesh(&sdata->vif))
949 mesh_rmc_free(sdata);
950
951 flushed = sta_info_flush(sdata);
952 WARN_ON(flushed);
953 }
954
955 static void ieee80211_uninit(struct net_device *dev)
956 {
957 ieee80211_teardown_sdata(IEEE80211_DEV_TO_SUB_IF(dev));
958 }
959
960 static u16 ieee80211_netdev_select_queue(struct net_device *dev,
961 struct sk_buff *skb)
962 {
963 return ieee80211_select_queue(IEEE80211_DEV_TO_SUB_IF(dev), skb);
964 }
965
966 static const struct net_device_ops ieee80211_dataif_ops = {
967 .ndo_open = ieee80211_open,
968 .ndo_stop = ieee80211_stop,
969 .ndo_uninit = ieee80211_uninit,
970 .ndo_start_xmit = ieee80211_subif_start_xmit,
971 .ndo_set_rx_mode = ieee80211_set_multicast_list,
972 .ndo_change_mtu = ieee80211_change_mtu,
973 .ndo_set_mac_address = ieee80211_change_mac,
974 .ndo_select_queue = ieee80211_netdev_select_queue,
975 };
976
977 static u16 ieee80211_monitor_select_queue(struct net_device *dev,
978 struct sk_buff *skb)
979 {
980 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
981 struct ieee80211_local *local = sdata->local;
982 struct ieee80211_hdr *hdr;
983 struct ieee80211_radiotap_header *rtap = (void *)skb->data;
984
985 if (local->hw.queues < IEEE80211_NUM_ACS)
986 return 0;
987
988 if (skb->len < 4 ||
989 skb->len < le16_to_cpu(rtap->it_len) + 2 /* frame control */)
990 return 0; /* doesn't matter, frame will be dropped */
991
992 hdr = (void *)((u8 *)skb->data + le16_to_cpu(rtap->it_len));
993
994 return ieee80211_select_queue_80211(sdata, skb, hdr);
995 }
996
997 static const struct net_device_ops ieee80211_monitorif_ops = {
998 .ndo_open = ieee80211_open,
999 .ndo_stop = ieee80211_stop,
1000 .ndo_uninit = ieee80211_uninit,
1001 .ndo_start_xmit = ieee80211_monitor_start_xmit,
1002 .ndo_set_rx_mode = ieee80211_set_multicast_list,
1003 .ndo_change_mtu = ieee80211_change_mtu,
1004 .ndo_set_mac_address = eth_mac_addr,
1005 .ndo_select_queue = ieee80211_monitor_select_queue,
1006 };
1007
1008 static void ieee80211_if_setup(struct net_device *dev)
1009 {
1010 ether_setup(dev);
1011 dev->priv_flags &= ~IFF_TX_SKB_SHARING;
1012 dev->netdev_ops = &ieee80211_dataif_ops;
1013 dev->destructor = free_netdev;
1014 }
1015
1016 static void ieee80211_iface_work(struct work_struct *work)
1017 {
1018 struct ieee80211_sub_if_data *sdata =
1019 container_of(work, struct ieee80211_sub_if_data, work);
1020 struct ieee80211_local *local = sdata->local;
1021 struct sk_buff *skb;
1022 struct sta_info *sta;
1023 struct ieee80211_ra_tid *ra_tid;
1024
1025 if (!ieee80211_sdata_running(sdata))
1026 return;
1027
1028 if (local->scanning)
1029 return;
1030
1031 /*
1032 * ieee80211_queue_work() should have picked up most cases,
1033 * here we'll pick the rest.
1034 */
1035 if (WARN(local->suspended,
1036 "interface work scheduled while going to suspend\n"))
1037 return;
1038
1039 /* first process frames */
1040 while ((skb = skb_dequeue(&sdata->skb_queue))) {
1041 struct ieee80211_mgmt *mgmt = (void *)skb->data;
1042
1043 if (skb->pkt_type == IEEE80211_SDATA_QUEUE_AGG_START) {
1044 ra_tid = (void *)&skb->cb;
1045 ieee80211_start_tx_ba_cb(&sdata->vif, ra_tid->ra,
1046 ra_tid->tid);
1047 } else if (skb->pkt_type == IEEE80211_SDATA_QUEUE_AGG_STOP) {
1048 ra_tid = (void *)&skb->cb;
1049 ieee80211_stop_tx_ba_cb(&sdata->vif, ra_tid->ra,
1050 ra_tid->tid);
1051 } else if (ieee80211_is_action(mgmt->frame_control) &&
1052 mgmt->u.action.category == WLAN_CATEGORY_BACK) {
1053 int len = skb->len;
1054
1055 mutex_lock(&local->sta_mtx);
1056 sta = sta_info_get_bss(sdata, mgmt->sa);
1057 if (sta) {
1058 switch (mgmt->u.action.u.addba_req.action_code) {
1059 case WLAN_ACTION_ADDBA_REQ:
1060 ieee80211_process_addba_request(
1061 local, sta, mgmt, len);
1062 break;
1063 case WLAN_ACTION_ADDBA_RESP:
1064 ieee80211_process_addba_resp(local, sta,
1065 mgmt, len);
1066 break;
1067 case WLAN_ACTION_DELBA:
1068 ieee80211_process_delba(sdata, sta,
1069 mgmt, len);
1070 break;
1071 default:
1072 WARN_ON(1);
1073 break;
1074 }
1075 }
1076 mutex_unlock(&local->sta_mtx);
1077 } else if (ieee80211_is_data_qos(mgmt->frame_control)) {
1078 struct ieee80211_hdr *hdr = (void *)mgmt;
1079 /*
1080 * So the frame isn't mgmt, but frame_control
1081 * is at the right place anyway, of course, so
1082 * the if statement is correct.
1083 *
1084 * Warn if we have other data frame types here,
1085 * they must not get here.
1086 */
1087 WARN_ON(hdr->frame_control &
1088 cpu_to_le16(IEEE80211_STYPE_NULLFUNC));
1089 WARN_ON(!(hdr->seq_ctrl &
1090 cpu_to_le16(IEEE80211_SCTL_FRAG)));
1091 /*
1092 * This was a fragment of a frame, received while
1093 * a block-ack session was active. That cannot be
1094 * right, so terminate the session.
1095 */
1096 mutex_lock(&local->sta_mtx);
1097 sta = sta_info_get_bss(sdata, mgmt->sa);
1098 if (sta) {
1099 u16 tid = *ieee80211_get_qos_ctl(hdr) &
1100 IEEE80211_QOS_CTL_TID_MASK;
1101
1102 __ieee80211_stop_rx_ba_session(
1103 sta, tid, WLAN_BACK_RECIPIENT,
1104 WLAN_REASON_QSTA_REQUIRE_SETUP,
1105 true);
1106 }
1107 mutex_unlock(&local->sta_mtx);
1108 } else switch (sdata->vif.type) {
1109 case NL80211_IFTYPE_STATION:
1110 ieee80211_sta_rx_queued_mgmt(sdata, skb);
1111 break;
1112 case NL80211_IFTYPE_ADHOC:
1113 ieee80211_ibss_rx_queued_mgmt(sdata, skb);
1114 break;
1115 case NL80211_IFTYPE_MESH_POINT:
1116 if (!ieee80211_vif_is_mesh(&sdata->vif))
1117 break;
1118 ieee80211_mesh_rx_queued_mgmt(sdata, skb);
1119 break;
1120 default:
1121 WARN(1, "frame for unexpected interface type");
1122 break;
1123 }
1124
1125 kfree_skb(skb);
1126 }
1127
1128 /* then other type-dependent work */
1129 switch (sdata->vif.type) {
1130 case NL80211_IFTYPE_STATION:
1131 ieee80211_sta_work(sdata);
1132 break;
1133 case NL80211_IFTYPE_ADHOC:
1134 ieee80211_ibss_work(sdata);
1135 break;
1136 case NL80211_IFTYPE_MESH_POINT:
1137 if (!ieee80211_vif_is_mesh(&sdata->vif))
1138 break;
1139 ieee80211_mesh_work(sdata);
1140 break;
1141 default:
1142 break;
1143 }
1144 }
1145
1146 static void ieee80211_recalc_smps_work(struct work_struct *work)
1147 {
1148 struct ieee80211_sub_if_data *sdata =
1149 container_of(work, struct ieee80211_sub_if_data, recalc_smps);
1150
1151 ieee80211_recalc_smps(sdata);
1152 }
1153
1154 /*
1155 * Helper function to initialise an interface to a specific type.
1156 */
1157 static void ieee80211_setup_sdata(struct ieee80211_sub_if_data *sdata,
1158 enum nl80211_iftype type)
1159 {
1160 /* clear type-dependent union */
1161 memset(&sdata->u, 0, sizeof(sdata->u));
1162
1163 /* and set some type-dependent values */
1164 sdata->vif.type = type;
1165 sdata->vif.p2p = false;
1166 sdata->wdev.iftype = type;
1167
1168 sdata->control_port_protocol = cpu_to_be16(ETH_P_PAE);
1169 sdata->control_port_no_encrypt = false;
1170
1171 sdata->noack_map = 0;
1172
1173 /* only monitor/p2p-device differ */
1174 if (sdata->dev) {
1175 sdata->dev->netdev_ops = &ieee80211_dataif_ops;
1176 sdata->dev->type = ARPHRD_ETHER;
1177 }
1178
1179 skb_queue_head_init(&sdata->skb_queue);
1180 INIT_WORK(&sdata->work, ieee80211_iface_work);
1181 INIT_WORK(&sdata->recalc_smps, ieee80211_recalc_smps_work);
1182
1183 switch (type) {
1184 case NL80211_IFTYPE_P2P_GO:
1185 type = NL80211_IFTYPE_AP;
1186 sdata->vif.type = type;
1187 sdata->vif.p2p = true;
1188 /* fall through */
1189 case NL80211_IFTYPE_AP:
1190 skb_queue_head_init(&sdata->u.ap.ps.bc_buf);
1191 INIT_LIST_HEAD(&sdata->u.ap.vlans);
1192 sdata->vif.bss_conf.bssid = sdata->vif.addr;
1193 break;
1194 case NL80211_IFTYPE_P2P_CLIENT:
1195 type = NL80211_IFTYPE_STATION;
1196 sdata->vif.type = type;
1197 sdata->vif.p2p = true;
1198 /* fall through */
1199 case NL80211_IFTYPE_STATION:
1200 sdata->vif.bss_conf.bssid = sdata->u.mgd.bssid;
1201 ieee80211_sta_setup_sdata(sdata);
1202 break;
1203 case NL80211_IFTYPE_ADHOC:
1204 sdata->vif.bss_conf.bssid = sdata->u.ibss.bssid;
1205 ieee80211_ibss_setup_sdata(sdata);
1206 break;
1207 case NL80211_IFTYPE_MESH_POINT:
1208 if (ieee80211_vif_is_mesh(&sdata->vif))
1209 ieee80211_mesh_init_sdata(sdata);
1210 break;
1211 case NL80211_IFTYPE_MONITOR:
1212 sdata->dev->type = ARPHRD_IEEE80211_RADIOTAP;
1213 sdata->dev->netdev_ops = &ieee80211_monitorif_ops;
1214 sdata->u.mntr_flags = MONITOR_FLAG_CONTROL |
1215 MONITOR_FLAG_OTHER_BSS;
1216 break;
1217 case NL80211_IFTYPE_WDS:
1218 sdata->vif.bss_conf.bssid = NULL;
1219 break;
1220 case NL80211_IFTYPE_AP_VLAN:
1221 break;
1222 case NL80211_IFTYPE_P2P_DEVICE:
1223 sdata->vif.bss_conf.bssid = sdata->vif.addr;
1224 break;
1225 case NL80211_IFTYPE_UNSPECIFIED:
1226 case NUM_NL80211_IFTYPES:
1227 BUG();
1228 break;
1229 }
1230
1231 ieee80211_debugfs_add_netdev(sdata);
1232 }
1233
1234 static int ieee80211_runtime_change_iftype(struct ieee80211_sub_if_data *sdata,
1235 enum nl80211_iftype type)
1236 {
1237 struct ieee80211_local *local = sdata->local;
1238 int ret, err;
1239 enum nl80211_iftype internal_type = type;
1240 bool p2p = false;
1241
1242 ASSERT_RTNL();
1243
1244 if (!local->ops->change_interface)
1245 return -EBUSY;
1246
1247 switch (sdata->vif.type) {
1248 case NL80211_IFTYPE_AP:
1249 case NL80211_IFTYPE_STATION:
1250 case NL80211_IFTYPE_ADHOC:
1251 /*
1252 * Could maybe also all others here?
1253 * Just not sure how that interacts
1254 * with the RX/config path e.g. for
1255 * mesh.
1256 */
1257 break;
1258 default:
1259 return -EBUSY;
1260 }
1261
1262 switch (type) {
1263 case NL80211_IFTYPE_AP:
1264 case NL80211_IFTYPE_STATION:
1265 case NL80211_IFTYPE_ADHOC:
1266 /*
1267 * Could probably support everything
1268 * but WDS here (WDS do_open can fail
1269 * under memory pressure, which this
1270 * code isn't prepared to handle).
1271 */
1272 break;
1273 case NL80211_IFTYPE_P2P_CLIENT:
1274 p2p = true;
1275 internal_type = NL80211_IFTYPE_STATION;
1276 break;
1277 case NL80211_IFTYPE_P2P_GO:
1278 p2p = true;
1279 internal_type = NL80211_IFTYPE_AP;
1280 break;
1281 default:
1282 return -EBUSY;
1283 }
1284
1285 ret = ieee80211_check_concurrent_iface(sdata, internal_type);
1286 if (ret)
1287 return ret;
1288
1289 ieee80211_do_stop(sdata, false);
1290
1291 ieee80211_teardown_sdata(sdata);
1292
1293 ret = drv_change_interface(local, sdata, internal_type, p2p);
1294 if (ret)
1295 type = sdata->vif.type;
1296
1297 /*
1298 * Ignore return value here, there's not much we can do since
1299 * the driver changed the interface type internally already.
1300 * The warnings will hopefully make driver authors fix it :-)
1301 */
1302 ieee80211_check_queues(sdata);
1303
1304 ieee80211_setup_sdata(sdata, type);
1305
1306 err = ieee80211_do_open(&sdata->wdev, false);
1307 WARN(err, "type change: do_open returned %d", err);
1308
1309 return ret;
1310 }
1311
1312 int ieee80211_if_change_type(struct ieee80211_sub_if_data *sdata,
1313 enum nl80211_iftype type)
1314 {
1315 int ret;
1316
1317 ASSERT_RTNL();
1318
1319 if (type == ieee80211_vif_type_p2p(&sdata->vif))
1320 return 0;
1321
1322 if (ieee80211_sdata_running(sdata)) {
1323 ret = ieee80211_runtime_change_iftype(sdata, type);
1324 if (ret)
1325 return ret;
1326 } else {
1327 /* Purge and reset type-dependent state. */
1328 ieee80211_teardown_sdata(sdata);
1329 ieee80211_setup_sdata(sdata, type);
1330 }
1331
1332 /* reset some values that shouldn't be kept across type changes */
1333 sdata->drop_unencrypted = 0;
1334 if (type == NL80211_IFTYPE_STATION)
1335 sdata->u.mgd.use_4addr = false;
1336
1337 return 0;
1338 }
1339
1340 static void ieee80211_assign_perm_addr(struct ieee80211_local *local,
1341 u8 *perm_addr, enum nl80211_iftype type)
1342 {
1343 struct ieee80211_sub_if_data *sdata;
1344 u64 mask, start, addr, val, inc;
1345 u8 *m;
1346 u8 tmp_addr[ETH_ALEN];
1347 int i;
1348
1349 /* default ... something at least */
1350 memcpy(perm_addr, local->hw.wiphy->perm_addr, ETH_ALEN);
1351
1352 if (is_zero_ether_addr(local->hw.wiphy->addr_mask) &&
1353 local->hw.wiphy->n_addresses <= 1)
1354 return;
1355
1356 mutex_lock(&local->iflist_mtx);
1357
1358 switch (type) {
1359 case NL80211_IFTYPE_MONITOR:
1360 /* doesn't matter */
1361 break;
1362 case NL80211_IFTYPE_WDS:
1363 case NL80211_IFTYPE_AP_VLAN:
1364 /* match up with an AP interface */
1365 list_for_each_entry(sdata, &local->interfaces, list) {
1366 if (sdata->vif.type != NL80211_IFTYPE_AP)
1367 continue;
1368 memcpy(perm_addr, sdata->vif.addr, ETH_ALEN);
1369 break;
1370 }
1371 /* keep default if no AP interface present */
1372 break;
1373 case NL80211_IFTYPE_P2P_CLIENT:
1374 case NL80211_IFTYPE_P2P_GO:
1375 if (local->hw.flags & IEEE80211_HW_P2P_DEV_ADDR_FOR_INTF) {
1376 list_for_each_entry(sdata, &local->interfaces, list) {
1377 if (sdata->vif.type != NL80211_IFTYPE_P2P_DEVICE)
1378 continue;
1379 if (!ieee80211_sdata_running(sdata))
1380 continue;
1381 memcpy(perm_addr, sdata->vif.addr, ETH_ALEN);
1382 goto out_unlock;
1383 }
1384 }
1385 /* otherwise fall through */
1386 default:
1387 /* assign a new address if possible -- try n_addresses first */
1388 for (i = 0; i < local->hw.wiphy->n_addresses; i++) {
1389 bool used = false;
1390
1391 list_for_each_entry(sdata, &local->interfaces, list) {
1392 if (memcmp(local->hw.wiphy->addresses[i].addr,
1393 sdata->vif.addr, ETH_ALEN) == 0) {
1394 used = true;
1395 break;
1396 }
1397 }
1398
1399 if (!used) {
1400 memcpy(perm_addr,
1401 local->hw.wiphy->addresses[i].addr,
1402 ETH_ALEN);
1403 break;
1404 }
1405 }
1406
1407 /* try mask if available */
1408 if (is_zero_ether_addr(local->hw.wiphy->addr_mask))
1409 break;
1410
1411 m = local->hw.wiphy->addr_mask;
1412 mask = ((u64)m[0] << 5*8) | ((u64)m[1] << 4*8) |
1413 ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) |
1414 ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8);
1415
1416 if (__ffs64(mask) + hweight64(mask) != fls64(mask)) {
1417 /* not a contiguous mask ... not handled now! */
1418 pr_info("not contiguous\n");
1419 break;
1420 }
1421
1422 m = local->hw.wiphy->perm_addr;
1423 start = ((u64)m[0] << 5*8) | ((u64)m[1] << 4*8) |
1424 ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) |
1425 ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8);
1426
1427 inc = 1ULL<<__ffs64(mask);
1428 val = (start & mask);
1429 addr = (start & ~mask) | (val & mask);
1430 do {
1431 bool used = false;
1432
1433 tmp_addr[5] = addr >> 0*8;
1434 tmp_addr[4] = addr >> 1*8;
1435 tmp_addr[3] = addr >> 2*8;
1436 tmp_addr[2] = addr >> 3*8;
1437 tmp_addr[1] = addr >> 4*8;
1438 tmp_addr[0] = addr >> 5*8;
1439
1440 val += inc;
1441
1442 list_for_each_entry(sdata, &local->interfaces, list) {
1443 if (memcmp(tmp_addr, sdata->vif.addr,
1444 ETH_ALEN) == 0) {
1445 used = true;
1446 break;
1447 }
1448 }
1449
1450 if (!used) {
1451 memcpy(perm_addr, tmp_addr, ETH_ALEN);
1452 break;
1453 }
1454 addr = (start & ~mask) | (val & mask);
1455 } while (addr != start);
1456
1457 break;
1458 }
1459
1460 out_unlock:
1461 mutex_unlock(&local->iflist_mtx);
1462 }
1463
1464 static void ieee80211_cleanup_sdata_stas_wk(struct work_struct *wk)
1465 {
1466 struct ieee80211_sub_if_data *sdata;
1467
1468 sdata = container_of(wk, struct ieee80211_sub_if_data, cleanup_stations_wk);
1469
1470 ieee80211_cleanup_sdata_stas(sdata);
1471 }
1472
1473 int ieee80211_if_add(struct ieee80211_local *local, const char *name,
1474 struct wireless_dev **new_wdev, enum nl80211_iftype type,
1475 struct vif_params *params)
1476 {
1477 struct net_device *ndev = NULL;
1478 struct ieee80211_sub_if_data *sdata = NULL;
1479 int ret, i;
1480 int txqs = 1;
1481
1482 ASSERT_RTNL();
1483
1484 if (type == NL80211_IFTYPE_P2P_DEVICE) {
1485 struct wireless_dev *wdev;
1486
1487 sdata = kzalloc(sizeof(*sdata) + local->hw.vif_data_size,
1488 GFP_KERNEL);
1489 if (!sdata)
1490 return -ENOMEM;
1491 wdev = &sdata->wdev;
1492
1493 sdata->dev = NULL;
1494 strlcpy(sdata->name, name, IFNAMSIZ);
1495 ieee80211_assign_perm_addr(local, wdev->address, type);
1496 memcpy(sdata->vif.addr, wdev->address, ETH_ALEN);
1497 } else {
1498 if (local->hw.queues >= IEEE80211_NUM_ACS)
1499 txqs = IEEE80211_NUM_ACS;
1500
1501 ndev = alloc_netdev_mqs(sizeof(*sdata) +
1502 local->hw.vif_data_size,
1503 name, ieee80211_if_setup, txqs, 1);
1504 if (!ndev)
1505 return -ENOMEM;
1506 dev_net_set(ndev, wiphy_net(local->hw.wiphy));
1507
1508 ndev->needed_headroom = local->tx_headroom +
1509 4*6 /* four MAC addresses */
1510 + 2 + 2 + 2 + 2 /* ctl, dur, seq, qos */
1511 + 6 /* mesh */
1512 + 8 /* rfc1042/bridge tunnel */
1513 - ETH_HLEN /* ethernet hard_header_len */
1514 + IEEE80211_ENCRYPT_HEADROOM;
1515 ndev->needed_tailroom = IEEE80211_ENCRYPT_TAILROOM;
1516
1517 ret = dev_alloc_name(ndev, ndev->name);
1518 if (ret < 0) {
1519 free_netdev(ndev);
1520 return ret;
1521 }
1522
1523 ieee80211_assign_perm_addr(local, ndev->perm_addr, type);
1524 memcpy(ndev->dev_addr, ndev->perm_addr, ETH_ALEN);
1525 SET_NETDEV_DEV(ndev, wiphy_dev(local->hw.wiphy));
1526
1527 /* don't use IEEE80211_DEV_TO_SUB_IF -- it checks too much */
1528 sdata = netdev_priv(ndev);
1529 ndev->ieee80211_ptr = &sdata->wdev;
1530 memcpy(sdata->vif.addr, ndev->dev_addr, ETH_ALEN);
1531 memcpy(sdata->name, ndev->name, IFNAMSIZ);
1532
1533 sdata->dev = ndev;
1534 }
1535
1536 /* initialise type-independent data */
1537 sdata->wdev.wiphy = local->hw.wiphy;
1538 sdata->local = local;
1539
1540 for (i = 0; i < IEEE80211_FRAGMENT_MAX; i++)
1541 skb_queue_head_init(&sdata->fragments[i].skb_list);
1542
1543 INIT_LIST_HEAD(&sdata->key_list);
1544
1545 spin_lock_init(&sdata->cleanup_stations_lock);
1546 INIT_LIST_HEAD(&sdata->cleanup_stations);
1547 INIT_WORK(&sdata->cleanup_stations_wk, ieee80211_cleanup_sdata_stas_wk);
1548 INIT_DELAYED_WORK(&sdata->dfs_cac_timer_work,
1549 ieee80211_dfs_cac_timer_work);
1550
1551 for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
1552 struct ieee80211_supported_band *sband;
1553 sband = local->hw.wiphy->bands[i];
1554 sdata->rc_rateidx_mask[i] =
1555 sband ? (1 << sband->n_bitrates) - 1 : 0;
1556 if (sband)
1557 memcpy(sdata->rc_rateidx_mcs_mask[i],
1558 sband->ht_cap.mcs.rx_mask,
1559 sizeof(sdata->rc_rateidx_mcs_mask[i]));
1560 else
1561 memset(sdata->rc_rateidx_mcs_mask[i], 0,
1562 sizeof(sdata->rc_rateidx_mcs_mask[i]));
1563 }
1564
1565 ieee80211_set_default_queues(sdata);
1566
1567 sdata->ap_power_level = IEEE80211_UNSET_POWER_LEVEL;
1568 sdata->user_power_level = local->user_power_level;
1569
1570 /* setup type-dependent data */
1571 ieee80211_setup_sdata(sdata, type);
1572
1573 if (ndev) {
1574 if (params) {
1575 ndev->ieee80211_ptr->use_4addr = params->use_4addr;
1576 if (type == NL80211_IFTYPE_STATION)
1577 sdata->u.mgd.use_4addr = params->use_4addr;
1578 }
1579
1580 ndev->features |= local->hw.netdev_features;
1581
1582 ret = register_netdevice(ndev);
1583 if (ret) {
1584 free_netdev(ndev);
1585 return ret;
1586 }
1587 }
1588
1589 mutex_lock(&local->iflist_mtx);
1590 list_add_tail_rcu(&sdata->list, &local->interfaces);
1591 mutex_unlock(&local->iflist_mtx);
1592
1593 if (new_wdev)
1594 *new_wdev = &sdata->wdev;
1595
1596 return 0;
1597 }
1598
1599 void ieee80211_if_remove(struct ieee80211_sub_if_data *sdata)
1600 {
1601 ASSERT_RTNL();
1602
1603 mutex_lock(&sdata->local->iflist_mtx);
1604 list_del_rcu(&sdata->list);
1605 mutex_unlock(&sdata->local->iflist_mtx);
1606
1607 synchronize_rcu();
1608
1609 if (sdata->dev) {
1610 unregister_netdevice(sdata->dev);
1611 } else {
1612 cfg80211_unregister_wdev(&sdata->wdev);
1613 kfree(sdata);
1614 }
1615 }
1616
1617 void ieee80211_sdata_stop(struct ieee80211_sub_if_data *sdata)
1618 {
1619 if (WARN_ON_ONCE(!test_bit(SDATA_STATE_RUNNING, &sdata->state)))
1620 return;
1621 ieee80211_do_stop(sdata, true);
1622 ieee80211_teardown_sdata(sdata);
1623 }
1624
1625 /*
1626 * Remove all interfaces, may only be called at hardware unregistration
1627 * time because it doesn't do RCU-safe list removals.
1628 */
1629 void ieee80211_remove_interfaces(struct ieee80211_local *local)
1630 {
1631 struct ieee80211_sub_if_data *sdata, *tmp;
1632 LIST_HEAD(unreg_list);
1633 LIST_HEAD(wdev_list);
1634
1635 ASSERT_RTNL();
1636
1637 mutex_lock(&local->iflist_mtx);
1638 list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) {
1639 list_del(&sdata->list);
1640
1641 if (sdata->dev)
1642 unregister_netdevice_queue(sdata->dev, &unreg_list);
1643 else
1644 list_add(&sdata->list, &wdev_list);
1645 }
1646 mutex_unlock(&local->iflist_mtx);
1647 unregister_netdevice_many(&unreg_list);
1648 list_del(&unreg_list);
1649
1650 list_for_each_entry_safe(sdata, tmp, &wdev_list, list) {
1651 list_del(&sdata->list);
1652 cfg80211_unregister_wdev(&sdata->wdev);
1653 kfree(sdata);
1654 }
1655 }
1656
1657 static int netdev_notify(struct notifier_block *nb,
1658 unsigned long state,
1659 void *ndev)
1660 {
1661 struct net_device *dev = ndev;
1662 struct ieee80211_sub_if_data *sdata;
1663
1664 if (state != NETDEV_CHANGENAME)
1665 return 0;
1666
1667 if (!dev->ieee80211_ptr || !dev->ieee80211_ptr->wiphy)
1668 return 0;
1669
1670 if (dev->ieee80211_ptr->wiphy->privid != mac80211_wiphy_privid)
1671 return 0;
1672
1673 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1674
1675 memcpy(sdata->name, dev->name, IFNAMSIZ);
1676
1677 ieee80211_debugfs_rename_netdev(sdata);
1678 return 0;
1679 }
1680
1681 static struct notifier_block mac80211_netdev_notifier = {
1682 .notifier_call = netdev_notify,
1683 };
1684
1685 int ieee80211_iface_init(void)
1686 {
1687 return register_netdevice_notifier(&mac80211_netdev_notifier);
1688 }
1689
1690 void ieee80211_iface_exit(void)
1691 {
1692 unregister_netdevice_notifier(&mac80211_netdev_notifier);
1693 }
CJK support for tty framebuffer vt