scan.c 38.4 KB
Newer Older
1 2 3 4 5 6
/*
 * cfg80211 scan result handling
 *
 * Copyright 2008 Johannes Berg <johannes@sipsolutions.net>
 */
#include <linux/kernel.h>
7
#include <linux/slab.h>
8 9 10 11 12 13 14
#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/wireless.h>
#include <linux/nl80211.h>
#include <linux/etherdevice.h>
#include <net/arp.h>
#include <net/cfg80211.h>
15
#include <net/cfg80211-wext.h>
16 17 18
#include <net/iw_handler.h>
#include "core.h"
#include "nl80211.h"
19
#include "wext-compat.h"
20
#include "rdev-ops.h"
21

22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57
/**
 * DOC: BSS tree/list structure
 *
 * At the top level, the BSS list is kept in both a list in each
 * registered device (@bss_list) as well as an RB-tree for faster
 * lookup. In the RB-tree, entries can be looked up using their
 * channel, MESHID, MESHCONF (for MBSSes) or channel, BSSID, SSID
 * for other BSSes.
 *
 * Due to the possibility of hidden SSIDs, there's a second level
 * structure, the "hidden_list" and "hidden_beacon_bss" pointer.
 * The hidden_list connects all BSSes belonging to a single AP
 * that has a hidden SSID, and connects beacon and probe response
 * entries. For a probe response entry for a hidden SSID, the
 * hidden_beacon_bss pointer points to the BSS struct holding the
 * beacon's information.
 *
 * Reference counting is done for all these references except for
 * the hidden_list, so that a beacon BSS struct that is otherwise
 * not referenced has one reference for being on the bss_list and
 * one for each probe response entry that points to it using the
 * hidden_beacon_bss pointer. When a BSS struct that has such a
 * pointer is get/put, the refcount update is also propagated to
 * the referenced struct, this ensure that it cannot get removed
 * while somebody is using the probe response version.
 *
 * Note that the hidden_beacon_bss pointer never changes, due to
 * the reference counting. Therefore, no locking is needed for
 * it.
 *
 * Also note that the hidden_beacon_bss pointer is only relevant
 * if the driver uses something other than the IEs, e.g. private
 * data stored stored in the BSS struct, since the beacon IEs are
 * also linked into the probe response struct.
 */

58
#define IEEE80211_SCAN_RESULT_EXPIRE	(30 * HZ)
59

60
static void bss_free(struct cfg80211_internal_bss *bss)
61
{
62
	struct cfg80211_bss_ies *ies;
63 64 65 66

	if (WARN_ON(atomic_read(&bss->hold)))
		return;

67
	ies = (void *)rcu_access_pointer(bss->pub.beacon_ies);
68
	if (ies && !bss->pub.hidden_beacon_bss)
69 70 71 72
		kfree_rcu(ies, rcu_head);
	ies = (void *)rcu_access_pointer(bss->pub.proberesp_ies);
	if (ies)
		kfree_rcu(ies, rcu_head);
73

74 75 76 77 78 79 80
	/*
	 * This happens when the module is removed, it doesn't
	 * really matter any more save for completeness
	 */
	if (!list_empty(&bss->hidden_list))
		list_del(&bss->hidden_list);

81 82 83
	kfree(bss);
}

84 85
static inline void bss_ref_get(struct cfg80211_registered_device *dev,
			       struct cfg80211_internal_bss *bss)
J
Johannes Berg 已提交
86
{
87 88 89 90 91 92 93 94 95
	lockdep_assert_held(&dev->bss_lock);

	bss->refcount++;
	if (bss->pub.hidden_beacon_bss) {
		bss = container_of(bss->pub.hidden_beacon_bss,
				   struct cfg80211_internal_bss,
				   pub);
		bss->refcount++;
	}
J
Johannes Berg 已提交
96 97
}

98 99
static inline void bss_ref_put(struct cfg80211_registered_device *dev,
			       struct cfg80211_internal_bss *bss)
J
Johannes Berg 已提交
100
{
101 102 103 104 105 106 107 108 109 110 111 112 113 114
	lockdep_assert_held(&dev->bss_lock);

	if (bss->pub.hidden_beacon_bss) {
		struct cfg80211_internal_bss *hbss;
		hbss = container_of(bss->pub.hidden_beacon_bss,
				    struct cfg80211_internal_bss,
				    pub);
		hbss->refcount--;
		if (hbss->refcount == 0)
			bss_free(hbss);
	}
	bss->refcount--;
	if (bss->refcount == 0)
		bss_free(bss);
J
Johannes Berg 已提交
115 116
}

117
static bool __cfg80211_unlink_bss(struct cfg80211_registered_device *dev,
118 119
				  struct cfg80211_internal_bss *bss)
{
120 121
	lockdep_assert_held(&dev->bss_lock);

122 123 124 125 126 127 128 129 130 131 132 133 134 135
	if (!list_empty(&bss->hidden_list)) {
		/*
		 * don't remove the beacon entry if it has
		 * probe responses associated with it
		 */
		if (!bss->pub.hidden_beacon_bss)
			return false;
		/*
		 * if it's a probe response entry break its
		 * link to the other entries in the group
		 */
		list_del_init(&bss->hidden_list);
	}

136 137
	list_del_init(&bss->list);
	rb_erase(&bss->rbn, &dev->bss_tree);
138 139
	bss_ref_put(dev, bss);
	return true;
140 141
}

142 143 144 145 146 147
static void __cfg80211_bss_expire(struct cfg80211_registered_device *dev,
				  unsigned long expire_time)
{
	struct cfg80211_internal_bss *bss, *tmp;
	bool expired = false;

148 149
	lockdep_assert_held(&dev->bss_lock);

150 151 152 153 154 155
	list_for_each_entry_safe(bss, tmp, &dev->bss_list, list) {
		if (atomic_read(&bss->hold))
			continue;
		if (!time_after(expire_time, bss->ts))
			continue;

156 157
		if (__cfg80211_unlink_bss(dev, bss))
			expired = true;
158 159 160 161 162 163
	}

	if (expired)
		dev->bss_generation++;
}

164
void ___cfg80211_scan_done(struct cfg80211_registered_device *rdev, bool leak)
165
{
J
Johannes Berg 已提交
166
	struct cfg80211_scan_request *request;
J
Johannes Berg 已提交
167
	struct wireless_dev *wdev;
J
Johannes Berg 已提交
168
#ifdef CONFIG_CFG80211_WEXT
169 170 171
	union iwreq_data wrqu;
#endif

172
	ASSERT_RTNL();
173

J
Johannes Berg 已提交
174 175
	request = rdev->scan_req;

176 177 178
	if (!request)
		return;

J
Johannes Berg 已提交
179
	wdev = request->wdev;
180

181 182 183 184 185
	/*
	 * This must be before sending the other events!
	 * Otherwise, wpa_supplicant gets completely confused with
	 * wext events.
	 */
J
Johannes Berg 已提交
186 187
	if (wdev->netdev)
		cfg80211_sme_scan_done(wdev->netdev);
188

189
	if (request->aborted) {
J
Johannes Berg 已提交
190
		nl80211_send_scan_aborted(rdev, wdev);
191 192 193 194 195 196 197
	} else {
		if (request->flags & NL80211_SCAN_FLAG_FLUSH) {
			/* flush entries from previous scans */
			spin_lock_bh(&rdev->bss_lock);
			__cfg80211_bss_expire(rdev, request->scan_start);
			spin_unlock_bh(&rdev->bss_lock);
		}
J
Johannes Berg 已提交
198
		nl80211_send_scan_done(rdev, wdev);
199
	}
200

J
Johannes Berg 已提交
201
#ifdef CONFIG_CFG80211_WEXT
J
Johannes Berg 已提交
202
	if (wdev->netdev && !request->aborted) {
203 204
		memset(&wrqu, 0, sizeof(wrqu));

J
Johannes Berg 已提交
205
		wireless_send_event(wdev->netdev, SIOCGIWSCAN, &wrqu, NULL);
206 207 208
	}
#endif

J
Johannes Berg 已提交
209 210
	if (wdev->netdev)
		dev_put(wdev->netdev);
211

212
	rdev->scan_req = NULL;
213 214 215 216 217 218 219 220 221 222 223

	/*
	 * OK. If this is invoked with "leak" then we can't
	 * free this ... but we've cleaned it up anyway. The
	 * driver failed to call the scan_done callback, so
	 * all bets are off, it might still be trying to use
	 * the scan request or not ... if it accesses the dev
	 * in there (it shouldn't anyway) then it may crash.
	 */
	if (!leak)
		kfree(request);
224
}
J
Johannes Berg 已提交
225

226 227 228 229 230 231 232
void __cfg80211_scan_done(struct work_struct *wk)
{
	struct cfg80211_registered_device *rdev;

	rdev = container_of(wk, struct cfg80211_registered_device,
			    scan_done_wk);

233
	rtnl_lock();
234
	___cfg80211_scan_done(rdev, false);
235
	rtnl_unlock();
236 237
}

J
Johannes Berg 已提交
238 239
void cfg80211_scan_done(struct cfg80211_scan_request *request, bool aborted)
{
240
	trace_cfg80211_scan_done(request, aborted);
J
Johannes Berg 已提交
241 242 243
	WARN_ON(request != wiphy_to_dev(request->wiphy)->scan_req);

	request->aborted = aborted;
244
	request->notified = true;
245
	queue_work(cfg80211_wq, &wiphy_to_dev(request->wiphy)->scan_done_wk);
J
Johannes Berg 已提交
246
}
247 248
EXPORT_SYMBOL(cfg80211_scan_done);

249 250 251
void __cfg80211_sched_scan_results(struct work_struct *wk)
{
	struct cfg80211_registered_device *rdev;
252
	struct cfg80211_sched_scan_request *request;
253 254 255 256

	rdev = container_of(wk, struct cfg80211_registered_device,
			    sched_scan_results_wk);

257 258
	request = rdev->sched_scan_req;

259
	rtnl_lock();
260 261

	/* we don't have sched_scan_req anymore if the scan is stopping */
262 263 264 265 266 267 268 269 270 271 272
	if (request) {
		if (request->flags & NL80211_SCAN_FLAG_FLUSH) {
			/* flush entries from previous scans */
			spin_lock_bh(&rdev->bss_lock);
			__cfg80211_bss_expire(rdev, request->scan_start);
			spin_unlock_bh(&rdev->bss_lock);
			request->scan_start =
				jiffies + msecs_to_jiffies(request->interval);
		}
		nl80211_send_sched_scan_results(rdev, request->dev);
	}
273

274
	rtnl_unlock();
275 276 277 278
}

void cfg80211_sched_scan_results(struct wiphy *wiphy)
{
279
	trace_cfg80211_sched_scan_results(wiphy);
280 281 282 283 284 285 286
	/* ignore if we're not scanning */
	if (wiphy_to_dev(wiphy)->sched_scan_req)
		queue_work(cfg80211_wq,
			   &wiphy_to_dev(wiphy)->sched_scan_results_wk);
}
EXPORT_SYMBOL(cfg80211_sched_scan_results);

287
void cfg80211_sched_scan_stopped(struct wiphy *wiphy)
288
{
289
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
290

291 292
	trace_cfg80211_sched_scan_stopped(wiphy);

293
	rtnl_lock();
294
	__cfg80211_stop_sched_scan(rdev, true);
295
	rtnl_unlock();
296 297 298 299 300 301 302 303
}
EXPORT_SYMBOL(cfg80211_sched_scan_stopped);

int __cfg80211_stop_sched_scan(struct cfg80211_registered_device *rdev,
			       bool driver_initiated)
{
	struct net_device *dev;

304
	ASSERT_RTNL();
305 306

	if (!rdev->sched_scan_req)
307
		return -ENOENT;
308 309 310

	dev = rdev->sched_scan_req->dev;

311
	if (!driver_initiated) {
312
		int err = rdev_sched_scan_stop(rdev, dev);
313 314 315
		if (err)
			return err;
	}
316 317 318 319 320 321

	nl80211_send_sched_scan(rdev, dev, NL80211_CMD_SCHED_SCAN_STOPPED);

	kfree(rdev->sched_scan_req);
	rdev->sched_scan_req = NULL;

322
	return 0;
323 324
}

325 326 327 328 329 330
void cfg80211_bss_age(struct cfg80211_registered_device *dev,
                      unsigned long age_secs)
{
	struct cfg80211_internal_bss *bss;
	unsigned long age_jiffies = msecs_to_jiffies(age_secs * MSEC_PER_SEC);

331
	spin_lock_bh(&dev->bss_lock);
332
	list_for_each_entry(bss, &dev->bss_list, list)
333
		bss->ts -= age_jiffies;
334
	spin_unlock_bh(&dev->bss_lock);
335 336
}

337 338
void cfg80211_bss_expire(struct cfg80211_registered_device *dev)
{
339
	__cfg80211_bss_expire(dev, jiffies - IEEE80211_SCAN_RESULT_EXPIRE);
340 341
}

342
const u8 *cfg80211_find_ie(u8 eid, const u8 *ies, int len)
343
{
344
	while (len > 2 && ies[0] != eid) {
345 346 347 348 349 350 351 352 353
		len -= ies[1] + 2;
		ies += ies[1] + 2;
	}
	if (len < 2)
		return NULL;
	if (len < 2 + ies[1])
		return NULL;
	return ies;
}
354
EXPORT_SYMBOL(cfg80211_find_ie);
355

356 357 358 359 360 361 362 363 364 365 366 367 368 369
const u8 *cfg80211_find_vendor_ie(unsigned int oui, u8 oui_type,
				  const u8 *ies, int len)
{
	struct ieee80211_vendor_ie *ie;
	const u8 *pos = ies, *end = ies + len;
	int ie_oui;

	while (pos < end) {
		pos = cfg80211_find_ie(WLAN_EID_VENDOR_SPECIFIC, pos,
				       end - pos);
		if (!pos)
			return NULL;

		ie = (struct ieee80211_vendor_ie *)pos;
370 371 372 373 374 375 376

		/* make sure we can access ie->len */
		BUILD_BUG_ON(offsetof(struct ieee80211_vendor_ie, len) != 1);

		if (ie->len < sizeof(*ie))
			goto cont;

377 378 379
		ie_oui = ie->oui[0] << 16 | ie->oui[1] << 8 | ie->oui[2];
		if (ie_oui == oui && ie->oui_type == oui_type)
			return pos;
380
cont:
381 382 383 384 385 386
		pos += 2 + ie->len;
	}
	return NULL;
}
EXPORT_SYMBOL(cfg80211_find_vendor_ie);

387
static bool is_bss(struct cfg80211_bss *a, const u8 *bssid,
388 389
		   const u8 *ssid, size_t ssid_len)
{
390
	const struct cfg80211_bss_ies *ies;
391 392
	const u8 *ssidie;

393
	if (bssid && !ether_addr_equal(a->bssid, bssid))
394 395
		return false;

396 397 398
	if (!ssid)
		return true;

399 400 401 402
	ies = rcu_access_pointer(a->ies);
	if (!ies)
		return false;
	ssidie = cfg80211_find_ie(WLAN_EID_SSID, ies->data, ies->len);
403 404 405 406 407 408 409
	if (!ssidie)
		return false;
	if (ssidie[1] != ssid_len)
		return false;
	return memcmp(ssidie + 2, ssid, ssid_len) == 0;
}

410 411 412 413 414 415 416 417 418 419 420 421
/**
 * enum bss_compare_mode - BSS compare mode
 * @BSS_CMP_REGULAR: regular compare mode (for insertion and normal find)
 * @BSS_CMP_HIDE_ZLEN: find hidden SSID with zero-length mode
 * @BSS_CMP_HIDE_NUL: find hidden SSID with NUL-ed out mode
 */
enum bss_compare_mode {
	BSS_CMP_REGULAR,
	BSS_CMP_HIDE_ZLEN,
	BSS_CMP_HIDE_NUL,
};

422
static int cmp_bss(struct cfg80211_bss *a,
423
		   struct cfg80211_bss *b,
424
		   enum bss_compare_mode mode)
425
{
426
	const struct cfg80211_bss_ies *a_ies, *b_ies;
427 428
	const u8 *ie1 = NULL;
	const u8 *ie2 = NULL;
429
	int i, r;
430

431 432
	if (a->channel != b->channel)
		return b->channel->center_freq - a->channel->center_freq;
433

434 435 436 437 438 439 440
	a_ies = rcu_access_pointer(a->ies);
	if (!a_ies)
		return -1;
	b_ies = rcu_access_pointer(b->ies);
	if (!b_ies)
		return 1;

441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475
	if (WLAN_CAPABILITY_IS_STA_BSS(a->capability))
		ie1 = cfg80211_find_ie(WLAN_EID_MESH_ID,
				       a_ies->data, a_ies->len);
	if (WLAN_CAPABILITY_IS_STA_BSS(b->capability))
		ie2 = cfg80211_find_ie(WLAN_EID_MESH_ID,
				       b_ies->data, b_ies->len);
	if (ie1 && ie2) {
		int mesh_id_cmp;

		if (ie1[1] == ie2[1])
			mesh_id_cmp = memcmp(ie1 + 2, ie2 + 2, ie1[1]);
		else
			mesh_id_cmp = ie2[1] - ie1[1];

		ie1 = cfg80211_find_ie(WLAN_EID_MESH_CONFIG,
				       a_ies->data, a_ies->len);
		ie2 = cfg80211_find_ie(WLAN_EID_MESH_CONFIG,
				       b_ies->data, b_ies->len);
		if (ie1 && ie2) {
			if (mesh_id_cmp)
				return mesh_id_cmp;
			if (ie1[1] != ie2[1])
				return ie2[1] - ie1[1];
			return memcmp(ie1 + 2, ie2 + 2, ie1[1]);
		}
	}

	/*
	 * we can't use compare_ether_addr here since we need a < > operator.
	 * The binary return value of compare_ether_addr isn't enough
	 */
	r = memcmp(a->bssid, b->bssid, sizeof(a->bssid));
	if (r)
		return r;

476 477
	ie1 = cfg80211_find_ie(WLAN_EID_SSID, a_ies->data, a_ies->len);
	ie2 = cfg80211_find_ie(WLAN_EID_SSID, b_ies->data, b_ies->len);
478

479 480 481
	if (!ie1 && !ie2)
		return 0;

J
Johannes Berg 已提交
482
	/*
483 484 485
	 * Note that with "hide_ssid", the function returns a match if
	 * the already-present BSS ("b") is a hidden SSID beacon for
	 * the new BSS ("a").
J
Johannes Berg 已提交
486
	 */
487 488 489 490 491 492 493

	/* sort missing IE before (left of) present IE */
	if (!ie1)
		return -1;
	if (!ie2)
		return 1;

494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513
	switch (mode) {
	case BSS_CMP_HIDE_ZLEN:
		/*
		 * In ZLEN mode we assume the BSS entry we're
		 * looking for has a zero-length SSID. So if
		 * the one we're looking at right now has that,
		 * return 0. Otherwise, return the difference
		 * in length, but since we're looking for the
		 * 0-length it's really equivalent to returning
		 * the length of the one we're looking at.
		 *
		 * No content comparison is needed as we assume
		 * the content length is zero.
		 */
		return ie2[1];
	case BSS_CMP_REGULAR:
	default:
		/* sort by length first, then by contents */
		if (ie1[1] != ie2[1])
			return ie2[1] - ie1[1];
514
		return memcmp(ie1 + 2, ie2 + 2, ie1[1]);
515 516 517 518 519 520 521 522 523
	case BSS_CMP_HIDE_NUL:
		if (ie1[1] != ie2[1])
			return ie2[1] - ie1[1];
		/* this is equivalent to memcmp(zeroes, ie2 + 2, len) */
		for (i = 0; i < ie2[1]; i++)
			if (ie2[i + 2])
				return -1;
		return 0;
	}
524 525
}

526
/* Returned bss is reference counted and must be cleaned up appropriately. */
527 528 529
struct cfg80211_bss *cfg80211_get_bss(struct wiphy *wiphy,
				      struct ieee80211_channel *channel,
				      const u8 *bssid,
530 531
				      const u8 *ssid, size_t ssid_len,
				      u16 capa_mask, u16 capa_val)
532 533 534
{
	struct cfg80211_registered_device *dev = wiphy_to_dev(wiphy);
	struct cfg80211_internal_bss *bss, *res = NULL;
535
	unsigned long now = jiffies;
536

537 538 539
	trace_cfg80211_get_bss(wiphy, channel, bssid, ssid, ssid_len, capa_mask,
			       capa_val);

540 541 542
	spin_lock_bh(&dev->bss_lock);

	list_for_each_entry(bss, &dev->bss_list, list) {
543 544
		if ((bss->pub.capability & capa_mask) != capa_val)
			continue;
545 546
		if (channel && bss->pub.channel != channel)
			continue;
547 548 549 550
		/* Don't get expired BSS structs */
		if (time_after(now, bss->ts + IEEE80211_SCAN_RESULT_EXPIRE) &&
		    !atomic_read(&bss->hold))
			continue;
551 552
		if (is_bss(&bss->pub, bssid, ssid, ssid_len)) {
			res = bss;
553
			bss_ref_get(dev, res);
554 555 556 557 558 559 560
			break;
		}
	}

	spin_unlock_bh(&dev->bss_lock);
	if (!res)
		return NULL;
561
	trace_cfg80211_return_bss(&res->pub);
562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577
	return &res->pub;
}
EXPORT_SYMBOL(cfg80211_get_bss);

static void rb_insert_bss(struct cfg80211_registered_device *dev,
			  struct cfg80211_internal_bss *bss)
{
	struct rb_node **p = &dev->bss_tree.rb_node;
	struct rb_node *parent = NULL;
	struct cfg80211_internal_bss *tbss;
	int cmp;

	while (*p) {
		parent = *p;
		tbss = rb_entry(parent, struct cfg80211_internal_bss, rbn);

578
		cmp = cmp_bss(&bss->pub, &tbss->pub, BSS_CMP_REGULAR);
579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596

		if (WARN_ON(!cmp)) {
			/* will sort of leak this BSS */
			return;
		}

		if (cmp < 0)
			p = &(*p)->rb_left;
		else
			p = &(*p)->rb_right;
	}

	rb_link_node(&bss->rbn, parent, p);
	rb_insert_color(&bss->rbn, &dev->bss_tree);
}

static struct cfg80211_internal_bss *
rb_find_bss(struct cfg80211_registered_device *dev,
597
	    struct cfg80211_internal_bss *res,
598
	    enum bss_compare_mode mode)
599 600 601 602 603 604 605
{
	struct rb_node *n = dev->bss_tree.rb_node;
	struct cfg80211_internal_bss *bss;
	int r;

	while (n) {
		bss = rb_entry(n, struct cfg80211_internal_bss, rbn);
606
		r = cmp_bss(&res->pub, &bss->pub, mode);
607 608 609 610 611 612 613 614 615 616 617 618

		if (r == 0)
			return bss;
		else if (r < 0)
			n = n->rb_left;
		else
			n = n->rb_right;
	}

	return NULL;
}

619 620
static bool cfg80211_combine_bsses(struct cfg80211_registered_device *dev,
				   struct cfg80211_internal_bss *new)
621
{
622
	const struct cfg80211_bss_ies *ies;
623 624 625 626
	struct cfg80211_internal_bss *bss;
	const u8 *ie;
	int i, ssidlen;
	u8 fold = 0;
627

628
	ies = rcu_access_pointer(new->pub.beacon_ies);
629
	if (WARN_ON(!ies))
630
		return false;
631

632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679
	ie = cfg80211_find_ie(WLAN_EID_SSID, ies->data, ies->len);
	if (!ie) {
		/* nothing to do */
		return true;
	}

	ssidlen = ie[1];
	for (i = 0; i < ssidlen; i++)
		fold |= ie[2 + i];

	if (fold) {
		/* not a hidden SSID */
		return true;
	}

	/* This is the bad part ... */

	list_for_each_entry(bss, &dev->bss_list, list) {
		if (!ether_addr_equal(bss->pub.bssid, new->pub.bssid))
			continue;
		if (bss->pub.channel != new->pub.channel)
			continue;
		if (rcu_access_pointer(bss->pub.beacon_ies))
			continue;
		ies = rcu_access_pointer(bss->pub.ies);
		if (!ies)
			continue;
		ie = cfg80211_find_ie(WLAN_EID_SSID, ies->data, ies->len);
		if (!ie)
			continue;
		if (ssidlen && ie[1] != ssidlen)
			continue;
		/* that would be odd ... */
		if (bss->pub.beacon_ies)
			continue;
		if (WARN_ON_ONCE(bss->pub.hidden_beacon_bss))
			continue;
		if (WARN_ON_ONCE(!list_empty(&bss->hidden_list)))
			list_del(&bss->hidden_list);
		/* combine them */
		list_add(&bss->hidden_list, &new->hidden_list);
		bss->pub.hidden_beacon_bss = &new->pub;
		new->refcount += bss->refcount;
		rcu_assign_pointer(bss->pub.beacon_ies,
				   new->pub.beacon_ies);
	}

	return true;
680 681
}

682
/* Returned bss is reference counted and must be cleaned up appropriately. */
683 684
static struct cfg80211_internal_bss *
cfg80211_bss_update(struct cfg80211_registered_device *dev,
685
		    struct cfg80211_internal_bss *tmp)
686 687 688
{
	struct cfg80211_internal_bss *found = NULL;

689
	if (WARN_ON(!tmp->pub.channel))
690 691
		return NULL;

692
	tmp->ts = jiffies;
693 694 695

	spin_lock_bh(&dev->bss_lock);

696 697 698 699 700
	if (WARN_ON(!rcu_access_pointer(tmp->pub.ies))) {
		spin_unlock_bh(&dev->bss_lock);
		return NULL;
	}

701
	found = rb_find_bss(dev, tmp, BSS_CMP_REGULAR);
702

703
	if (found) {
704
		/* Update IEs */
705 706 707 708
		if (rcu_access_pointer(tmp->pub.proberesp_ies)) {
			const struct cfg80211_bss_ies *old;

			old = rcu_access_pointer(found->pub.proberesp_ies);
709

710 711
			rcu_assign_pointer(found->pub.proberesp_ies,
					   tmp->pub.proberesp_ies);
712
			/* Override possible earlier Beacon frame IEs */
713 714 715 716 717 718
			rcu_assign_pointer(found->pub.ies,
					   tmp->pub.proberesp_ies);
			if (old)
				kfree_rcu((struct cfg80211_bss_ies *)old,
					  rcu_head);
		} else if (rcu_access_pointer(tmp->pub.beacon_ies)) {
719
			const struct cfg80211_bss_ies *old;
720 721 722 723
			struct cfg80211_internal_bss *bss;

			if (found->pub.hidden_beacon_bss &&
			    !list_empty(&found->hidden_list)) {
724 725
				const struct cfg80211_bss_ies *f;

726 727 728 729 730 731 732 733 734
				/*
				 * The found BSS struct is one of the probe
				 * response members of a group, but we're
				 * receiving a beacon (beacon_ies in the tmp
				 * bss is used). This can only mean that the
				 * AP changed its beacon from not having an
				 * SSID to showing it, which is confusing so
				 * drop this information.
				 */
735 736 737 738

				f = rcu_access_pointer(tmp->pub.beacon_ies);
				kfree_rcu((struct cfg80211_bss_ies *)f,
					  rcu_head);
739 740
				goto drop;
			}
741

742 743 744 745
			old = rcu_access_pointer(found->pub.beacon_ies);

			rcu_assign_pointer(found->pub.beacon_ies,
					   tmp->pub.beacon_ies);
746 747

			/* Override IEs if they were from a beacon before */
748
			if (old == rcu_access_pointer(found->pub.ies))
749 750
				rcu_assign_pointer(found->pub.ies,
						   tmp->pub.beacon_ies);
751

752 753 754 755 756 757 758 759 760 761 762 763
			/* Assign beacon IEs to all sub entries */
			list_for_each_entry(bss, &found->hidden_list,
					    hidden_list) {
				const struct cfg80211_bss_ies *ies;

				ies = rcu_access_pointer(bss->pub.beacon_ies);
				WARN_ON(ies != old);

				rcu_assign_pointer(bss->pub.beacon_ies,
						   tmp->pub.beacon_ies);
			}

764 765 766 767
			if (old)
				kfree_rcu((struct cfg80211_bss_ies *)old,
					  rcu_head);
		}
768 769 770 771 772

		found->pub.beacon_interval = tmp->pub.beacon_interval;
		found->pub.signal = tmp->pub.signal;
		found->pub.capability = tmp->pub.capability;
		found->ts = tmp->ts;
773
	} else {
774
		struct cfg80211_internal_bss *new;
775
		struct cfg80211_internal_bss *hidden;
776
		struct cfg80211_bss_ies *ies;
777

778 779 780 781 782 783 784 785 786 787 788 789 790 791
		/*
		 * create a copy -- the "res" variable that is passed in
		 * is allocated on the stack since it's not needed in the
		 * more common case of an update
		 */
		new = kzalloc(sizeof(*new) + dev->wiphy.bss_priv_size,
			      GFP_ATOMIC);
		if (!new) {
			ies = (void *)rcu_dereference(tmp->pub.beacon_ies);
			if (ies)
				kfree_rcu(ies, rcu_head);
			ies = (void *)rcu_dereference(tmp->pub.proberesp_ies);
			if (ies)
				kfree_rcu(ies, rcu_head);
792
			goto drop;
793 794
		}
		memcpy(new, tmp, sizeof(*new));
795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823
		new->refcount = 1;
		INIT_LIST_HEAD(&new->hidden_list);

		if (rcu_access_pointer(tmp->pub.proberesp_ies)) {
			hidden = rb_find_bss(dev, tmp, BSS_CMP_HIDE_ZLEN);
			if (!hidden)
				hidden = rb_find_bss(dev, tmp,
						     BSS_CMP_HIDE_NUL);
			if (hidden) {
				new->pub.hidden_beacon_bss = &hidden->pub;
				list_add(&new->hidden_list,
					 &hidden->hidden_list);
				hidden->refcount++;
				rcu_assign_pointer(new->pub.beacon_ies,
						   hidden->pub.beacon_ies);
			}
		} else {
			/*
			 * Ok so we found a beacon, and don't have an entry. If
			 * it's a beacon with hidden SSID, we might be in for an
			 * expensive search for any probe responses that should
			 * be grouped with this beacon for updates ...
			 */
			if (!cfg80211_combine_bsses(dev, new)) {
				kfree(new);
				goto drop;
			}
		}

824 825 826
		list_add_tail(&new->list, &dev->bss_list);
		rb_insert_bss(dev, new);
		found = new;
827 828 829
	}

	dev->bss_generation++;
830
	bss_ref_get(dev, found);
831 832 833
	spin_unlock_bh(&dev->bss_lock);

	return found;
834 835 836
 drop:
	spin_unlock_bh(&dev->bss_lock);
	return NULL;
837 838
}

839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870
static struct ieee80211_channel *
cfg80211_get_bss_channel(struct wiphy *wiphy, const u8 *ie, size_t ielen,
			 struct ieee80211_channel *channel)
{
	const u8 *tmp;
	u32 freq;
	int channel_number = -1;

	tmp = cfg80211_find_ie(WLAN_EID_DS_PARAMS, ie, ielen);
	if (tmp && tmp[1] == 1) {
		channel_number = tmp[2];
	} else {
		tmp = cfg80211_find_ie(WLAN_EID_HT_OPERATION, ie, ielen);
		if (tmp && tmp[1] >= sizeof(struct ieee80211_ht_operation)) {
			struct ieee80211_ht_operation *htop = (void *)(tmp + 2);

			channel_number = htop->primary_chan;
		}
	}

	if (channel_number < 0)
		return channel;

	freq = ieee80211_channel_to_frequency(channel_number, channel->band);
	channel = ieee80211_get_channel(wiphy, freq);
	if (!channel)
		return NULL;
	if (channel->flags & IEEE80211_CHAN_DISABLED)
		return NULL;
	return channel;
}

871
/* Returned bss is reference counted and must be cleaned up appropriately. */
872 873 874
struct cfg80211_bss*
cfg80211_inform_bss(struct wiphy *wiphy,
		    struct ieee80211_channel *channel,
875 876
		    const u8 *bssid, u64 tsf, u16 capability,
		    u16 beacon_interval, const u8 *ie, size_t ielen,
877 878
		    s32 signal, gfp_t gfp)
{
879 880
	struct cfg80211_bss_ies *ies;
	struct cfg80211_internal_bss tmp = {}, *res;
881 882 883 884

	if (WARN_ON(!wiphy))
		return NULL;

S
Sujith 已提交
885
	if (WARN_ON(wiphy->signal_type == CFG80211_SIGNAL_TYPE_UNSPEC &&
886 887 888
			(signal < 0 || signal > 100)))
		return NULL;

889 890 891 892
	channel = cfg80211_get_bss_channel(wiphy, ie, ielen, channel);
	if (!channel)
		return NULL;

893 894 895 896 897
	memcpy(tmp.pub.bssid, bssid, ETH_ALEN);
	tmp.pub.channel = channel;
	tmp.pub.signal = signal;
	tmp.pub.beacon_interval = beacon_interval;
	tmp.pub.capability = capability;
898 899 900 901 902
	/*
	 * Since we do not know here whether the IEs are from a Beacon or Probe
	 * Response frame, we need to pick one of the options and only use it
	 * with the driver that does not provide the full Beacon/Probe Response
	 * frame. Use Beacon frame pointer to avoid indicating that this should
903
	 * override the IEs pointer should we have received an earlier
904
	 * indication of Probe Response data.
905
	 */
906 907 908 909
	ies = kmalloc(sizeof(*ies) + ielen, gfp);
	if (!ies)
		return NULL;
	ies->len = ielen;
J
Johannes Berg 已提交
910
	ies->tsf = tsf;
911
	memcpy(ies->data, ie, ielen);
912

913 914
	rcu_assign_pointer(tmp.pub.beacon_ies, ies);
	rcu_assign_pointer(tmp.pub.ies, ies);
915

916
	res = cfg80211_bss_update(wiphy_to_dev(wiphy), &tmp);
917 918 919 920 921 922
	if (!res)
		return NULL;

	if (res->pub.capability & WLAN_CAPABILITY_ESS)
		regulatory_hint_found_beacon(wiphy, channel, gfp);

923
	trace_cfg80211_return_bss(&res->pub);
924 925 926 927 928
	/* cfg80211_bss_update gives us a referenced result */
	return &res->pub;
}
EXPORT_SYMBOL(cfg80211_inform_bss);

929
/* Returned bss is reference counted and must be cleaned up appropriately. */
930 931 932 933
struct cfg80211_bss *
cfg80211_inform_bss_frame(struct wiphy *wiphy,
			  struct ieee80211_channel *channel,
			  struct ieee80211_mgmt *mgmt, size_t len,
J
Johannes Berg 已提交
934
			  s32 signal, gfp_t gfp)
935
{
936 937
	struct cfg80211_internal_bss tmp = {}, *res;
	struct cfg80211_bss_ies *ies;
938 939
	size_t ielen = len - offsetof(struct ieee80211_mgmt,
				      u.probe_resp.variable);
940

941 942 943
	BUILD_BUG_ON(offsetof(struct ieee80211_mgmt, u.probe_resp.variable) !=
			offsetof(struct ieee80211_mgmt, u.beacon.variable));

944 945
	trace_cfg80211_inform_bss_frame(wiphy, channel, mgmt, len, signal);

946 947 948 949 950
	if (WARN_ON(!mgmt))
		return NULL;

	if (WARN_ON(!wiphy))
		return NULL;
951

S
Sujith 已提交
952
	if (WARN_ON(wiphy->signal_type == CFG80211_SIGNAL_TYPE_UNSPEC &&
H
Hila Gonen 已提交
953
		    (signal < 0 || signal > 100)))
954 955
		return NULL;

956
	if (WARN_ON(len < offsetof(struct ieee80211_mgmt, u.probe_resp.variable)))
957 958
		return NULL;

959 960 961 962 963
	channel = cfg80211_get_bss_channel(wiphy, mgmt->u.beacon.variable,
					   ielen, channel);
	if (!channel)
		return NULL;

964 965
	ies = kmalloc(sizeof(*ies) + ielen, gfp);
	if (!ies)
966
		return NULL;
967
	ies->len = ielen;
J
Johannes Berg 已提交
968
	ies->tsf = le64_to_cpu(mgmt->u.probe_resp.timestamp);
969
	memcpy(ies->data, mgmt->u.probe_resp.variable, ielen);
970

971 972 973 974 975 976 977 978 979 980 981 982 983
	if (ieee80211_is_probe_resp(mgmt->frame_control))
		rcu_assign_pointer(tmp.pub.proberesp_ies, ies);
	else
		rcu_assign_pointer(tmp.pub.beacon_ies, ies);
	rcu_assign_pointer(tmp.pub.ies, ies);
	
	memcpy(tmp.pub.bssid, mgmt->bssid, ETH_ALEN);
	tmp.pub.channel = channel;
	tmp.pub.signal = signal;
	tmp.pub.beacon_interval = le16_to_cpu(mgmt->u.probe_resp.beacon_int);
	tmp.pub.capability = le16_to_cpu(mgmt->u.probe_resp.capab_info);

	res = cfg80211_bss_update(wiphy_to_dev(wiphy), &tmp);
984 985 986
	if (!res)
		return NULL;

987 988 989
	if (res->pub.capability & WLAN_CAPABILITY_ESS)
		regulatory_hint_found_beacon(wiphy, channel, gfp);

990
	trace_cfg80211_return_bss(&res->pub);
991 992 993 994 995
	/* cfg80211_bss_update gives us a referenced result */
	return &res->pub;
}
EXPORT_SYMBOL(cfg80211_inform_bss_frame);

996
void cfg80211_ref_bss(struct wiphy *wiphy, struct cfg80211_bss *pub)
997
{
998
	struct cfg80211_registered_device *dev = wiphy_to_dev(wiphy);
999 1000 1001 1002 1003 1004
	struct cfg80211_internal_bss *bss;

	if (!pub)
		return;

	bss = container_of(pub, struct cfg80211_internal_bss, pub);
1005 1006 1007 1008

	spin_lock_bh(&dev->bss_lock);
	bss_ref_get(dev, bss);
	spin_unlock_bh(&dev->bss_lock);
1009 1010 1011
}
EXPORT_SYMBOL(cfg80211_ref_bss);

1012
void cfg80211_put_bss(struct wiphy *wiphy, struct cfg80211_bss *pub)
1013
{
1014
	struct cfg80211_registered_device *dev = wiphy_to_dev(wiphy);
1015 1016 1017 1018 1019 1020
	struct cfg80211_internal_bss *bss;

	if (!pub)
		return;

	bss = container_of(pub, struct cfg80211_internal_bss, pub);
1021 1022 1023 1024

	spin_lock_bh(&dev->bss_lock);
	bss_ref_put(dev, bss);
	spin_unlock_bh(&dev->bss_lock);
1025 1026 1027
}
EXPORT_SYMBOL(cfg80211_put_bss);

1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038
void cfg80211_unlink_bss(struct wiphy *wiphy, struct cfg80211_bss *pub)
{
	struct cfg80211_registered_device *dev = wiphy_to_dev(wiphy);
	struct cfg80211_internal_bss *bss;

	if (WARN_ON(!pub))
		return;

	bss = container_of(pub, struct cfg80211_internal_bss, pub);

	spin_lock_bh(&dev->bss_lock);
J
Johannes Berg 已提交
1039
	if (!list_empty(&bss->list)) {
1040 1041
		if (__cfg80211_unlink_bss(dev, bss))
			dev->bss_generation++;
J
Johannes Berg 已提交
1042
	}
1043 1044 1045 1046
	spin_unlock_bh(&dev->bss_lock);
}
EXPORT_SYMBOL(cfg80211_unlink_bss);

J
Johannes Berg 已提交
1047
#ifdef CONFIG_CFG80211_WEXT
1048 1049 1050
static struct cfg80211_registered_device *
cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
{
1051
	struct cfg80211_registered_device *rdev;
1052 1053
	struct net_device *dev;

1054 1055
	ASSERT_RTNL();

1056 1057
	dev = dev_get_by_index(net, ifindex);
	if (!dev)
1058 1059
		return ERR_PTR(-ENODEV);
	if (dev->ieee80211_ptr)
1060
		rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
1061
	else
1062 1063 1064 1065 1066
		rdev = ERR_PTR(-ENODEV);
	dev_put(dev);
	return rdev;
}

1067 1068 1069 1070 1071 1072 1073
int cfg80211_wext_siwscan(struct net_device *dev,
			  struct iw_request_info *info,
			  union iwreq_data *wrqu, char *extra)
{
	struct cfg80211_registered_device *rdev;
	struct wiphy *wiphy;
	struct iw_scan_req *wreq = NULL;
1074
	struct cfg80211_scan_request *creq = NULL;
1075 1076 1077 1078 1079 1080
	int i, err, n_channels = 0;
	enum ieee80211_band band;

	if (!netif_running(dev))
		return -ENETDOWN;

1081 1082 1083
	if (wrqu->data.length == sizeof(struct iw_scan_req))
		wreq = (struct iw_scan_req *)extra;

1084
	rdev = cfg80211_get_dev_from_ifindex(dev_net(dev), dev->ifindex);
1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095

	if (IS_ERR(rdev))
		return PTR_ERR(rdev);

	if (rdev->scan_req) {
		err = -EBUSY;
		goto out;
	}

	wiphy = &rdev->wiphy;

1096 1097 1098 1099 1100 1101 1102 1103
	/* Determine number of channels, needed to allocate creq */
	if (wreq && wreq->num_channels)
		n_channels = wreq->num_channels;
	else {
		for (band = 0; band < IEEE80211_NUM_BANDS; band++)
			if (wiphy->bands[band])
				n_channels += wiphy->bands[band]->n_channels;
	}
1104 1105 1106 1107 1108 1109 1110 1111 1112 1113

	creq = kzalloc(sizeof(*creq) + sizeof(struct cfg80211_ssid) +
		       n_channels * sizeof(void *),
		       GFP_ATOMIC);
	if (!creq) {
		err = -ENOMEM;
		goto out;
	}

	creq->wiphy = wiphy;
J
Johannes Berg 已提交
1114
	creq->wdev = dev->ieee80211_ptr;
1115 1116
	/* SSIDs come after channels */
	creq->ssids = (void *)&creq->channels[n_channels];
1117 1118
	creq->n_channels = n_channels;
	creq->n_ssids = 1;
1119
	creq->scan_start = jiffies;
1120

1121
	/* translate "Scan on frequencies" request */
1122 1123 1124
	i = 0;
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		int j;
J
Johannes Berg 已提交
1125

1126 1127
		if (!wiphy->bands[band])
			continue;
J
Johannes Berg 已提交
1128

1129
		for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
J
Johannes Berg 已提交
1130 1131 1132 1133
			/* ignore disabled channels */
			if (wiphy->bands[band]->channels[j].flags &
						IEEE80211_CHAN_DISABLED)
				continue;
1134 1135 1136 1137 1138 1139 1140 1141 1142

			/* If we have a wireless request structure and the
			 * wireless request specifies frequencies, then search
			 * for the matching hardware channel.
			 */
			if (wreq && wreq->num_channels) {
				int k;
				int wiphy_freq = wiphy->bands[band]->channels[j].center_freq;
				for (k = 0; k < wreq->num_channels; k++) {
1143
					int wext_freq = cfg80211_wext_freq(wiphy, &wreq->channel_list[k]);
1144 1145 1146 1147 1148 1149 1150
					if (wext_freq == wiphy_freq)
						goto wext_freq_found;
				}
				goto wext_freq_not_found;
			}

		wext_freq_found:
1151 1152
			creq->channels[i] = &wiphy->bands[band]->channels[j];
			i++;
1153
		wext_freq_not_found: ;
1154 1155
		}
	}
1156 1157 1158 1159 1160
	/* No channels found? */
	if (!i) {
		err = -EINVAL;
		goto out;
	}
1161

1162 1163
	/* Set real number of channels specified in creq->channels[] */
	creq->n_channels = i;
1164

1165 1166
	/* translate "Scan for SSID" request */
	if (wreq) {
1167
		if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
1168 1169 1170 1171
			if (wreq->essid_len > IEEE80211_MAX_SSID_LEN) {
				err = -EINVAL;
				goto out;
			}
1172 1173 1174 1175 1176 1177 1178
			memcpy(creq->ssids[0].ssid, wreq->essid, wreq->essid_len);
			creq->ssids[0].ssid_len = wreq->essid_len;
		}
		if (wreq->scan_type == IW_SCAN_TYPE_PASSIVE)
			creq->n_ssids = 0;
	}

1179
	for (i = 0; i < IEEE80211_NUM_BANDS; i++)
1180 1181
		if (wiphy->bands[i])
			creq->rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1;
1182

1183
	rdev->scan_req = creq;
1184
	err = rdev_scan(rdev, creq);
1185 1186
	if (err) {
		rdev->scan_req = NULL;
1187
		/* creq will be freed below */
1188
	} else {
J
Johannes Berg 已提交
1189
		nl80211_send_scan_start(rdev, dev->ieee80211_ptr);
1190 1191
		/* creq now owned by driver */
		creq = NULL;
1192 1193
		dev_hold(dev);
	}
1194
 out:
1195
	kfree(creq);
1196 1197
	return err;
}
1198
EXPORT_SYMBOL_GPL(cfg80211_wext_siwscan);
1199 1200

static void ieee80211_scan_add_ies(struct iw_request_info *info,
1201
				   const struct cfg80211_bss_ies *ies,
1202 1203
				   char **current_ev, char *end_buf)
{
1204
	const u8 *pos, *end, *next;
1205 1206
	struct iw_event iwe;

1207
	if (!ies)
1208 1209 1210 1211 1212 1213
		return;

	/*
	 * If needed, fragment the IEs buffer (at IE boundaries) into short
	 * enough fragments to fit into IW_GENERIC_IE_MAX octet messages.
	 */
1214 1215
	pos = ies->data;
	end = pos + ies->len;
1216 1217 1218 1219 1220 1221 1222 1223 1224 1225

	while (end - pos > IW_GENERIC_IE_MAX) {
		next = pos + 2 + pos[1];
		while (next + 2 + next[1] - pos < IW_GENERIC_IE_MAX)
			next = next + 2 + next[1];

		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVGENIE;
		iwe.u.data.length = next - pos;
		*current_ev = iwe_stream_add_point(info, *current_ev,
1226 1227
						   end_buf, &iwe,
						   (void *)pos);
1228 1229 1230 1231 1232 1233 1234 1235 1236

		pos = next;
	}

	if (end > pos) {
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVGENIE;
		iwe.u.data.length = end - pos;
		*current_ev = iwe_stream_add_point(info, *current_ev,
1237 1238
						   end_buf, &iwe,
						   (void *)pos);
1239 1240 1241 1242
	}
}

static char *
J
Johannes Berg 已提交
1243 1244 1245
ieee80211_bss(struct wiphy *wiphy, struct iw_request_info *info,
	      struct cfg80211_internal_bss *bss, char *current_ev,
	      char *end_buf)
1246
{
1247
	const struct cfg80211_bss_ies *ies;
1248
	struct iw_event iwe;
1249
	const u8 *ie;
1250
	u8 *buf, *cfg, *p;
1251
	int rem, i, sig;
1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274
	bool ismesh = false;

	memset(&iwe, 0, sizeof(iwe));
	iwe.cmd = SIOCGIWAP;
	iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
	memcpy(iwe.u.ap_addr.sa_data, bss->pub.bssid, ETH_ALEN);
	current_ev = iwe_stream_add_event(info, current_ev, end_buf, &iwe,
					  IW_EV_ADDR_LEN);

	memset(&iwe, 0, sizeof(iwe));
	iwe.cmd = SIOCGIWFREQ;
	iwe.u.freq.m = ieee80211_frequency_to_channel(bss->pub.channel->center_freq);
	iwe.u.freq.e = 0;
	current_ev = iwe_stream_add_event(info, current_ev, end_buf, &iwe,
					  IW_EV_FREQ_LEN);

	memset(&iwe, 0, sizeof(iwe));
	iwe.cmd = SIOCGIWFREQ;
	iwe.u.freq.m = bss->pub.channel->center_freq;
	iwe.u.freq.e = 6;
	current_ev = iwe_stream_add_event(info, current_ev, end_buf, &iwe,
					  IW_EV_FREQ_LEN);

J
Johannes Berg 已提交
1275
	if (wiphy->signal_type != CFG80211_SIGNAL_TYPE_NONE) {
1276 1277 1278 1279
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVQUAL;
		iwe.u.qual.updated = IW_QUAL_LEVEL_UPDATED |
				     IW_QUAL_NOISE_INVALID |
1280
				     IW_QUAL_QUAL_UPDATED;
J
Johannes Berg 已提交
1281
		switch (wiphy->signal_type) {
1282
		case CFG80211_SIGNAL_TYPE_MBM:
1283 1284
			sig = bss->pub.signal / 100;
			iwe.u.qual.level = sig;
1285
			iwe.u.qual.updated |= IW_QUAL_DBM;
1286 1287 1288 1289 1290 1291
			if (sig < -110)		/* rather bad */
				sig = -110;
			else if (sig > -40)	/* perfect */
				sig = -40;
			/* will give a range of 0 .. 70 */
			iwe.u.qual.qual = sig + 110;
1292 1293 1294
			break;
		case CFG80211_SIGNAL_TYPE_UNSPEC:
			iwe.u.qual.level = bss->pub.signal;
1295 1296
			/* will give range 0 .. 100 */
			iwe.u.qual.qual = bss->pub.signal;
1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315
			break;
		default:
			/* not reached */
			break;
		}
		current_ev = iwe_stream_add_event(info, current_ev, end_buf,
						  &iwe, IW_EV_QUAL_LEN);
	}

	memset(&iwe, 0, sizeof(iwe));
	iwe.cmd = SIOCGIWENCODE;
	if (bss->pub.capability & WLAN_CAPABILITY_PRIVACY)
		iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
	else
		iwe.u.data.flags = IW_ENCODE_DISABLED;
	iwe.u.data.length = 0;
	current_ev = iwe_stream_add_point(info, current_ev, end_buf,
					  &iwe, "");

1316 1317
	rcu_read_lock();
	ies = rcu_dereference(bss->pub.ies);
1318 1319
	rem = ies->len;
	ie = ies->data;
1320

1321
	while (rem >= 2) {
1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332
		/* invalid data */
		if (ie[1] > rem - 2)
			break;

		switch (ie[0]) {
		case WLAN_EID_SSID:
			memset(&iwe, 0, sizeof(iwe));
			iwe.cmd = SIOCGIWESSID;
			iwe.u.data.length = ie[1];
			iwe.u.data.flags = 1;
			current_ev = iwe_stream_add_point(info, current_ev, end_buf,
1333
							  &iwe, (u8 *)ie + 2);
1334 1335 1336 1337 1338 1339 1340
			break;
		case WLAN_EID_MESH_ID:
			memset(&iwe, 0, sizeof(iwe));
			iwe.cmd = SIOCGIWESSID;
			iwe.u.data.length = ie[1];
			iwe.u.data.flags = 1;
			current_ev = iwe_stream_add_point(info, current_ev, end_buf,
1341
							  &iwe, (u8 *)ie + 2);
1342 1343 1344
			break;
		case WLAN_EID_MESH_CONFIG:
			ismesh = true;
1345
			if (ie[1] != sizeof(struct ieee80211_meshconf_ie))
1346 1347 1348 1349
				break;
			buf = kmalloc(50, GFP_ATOMIC);
			if (!buf)
				break;
1350
			cfg = (u8 *)ie + 2;
1351 1352
			memset(&iwe, 0, sizeof(iwe));
			iwe.cmd = IWEVCUSTOM;
1353 1354
			sprintf(buf, "Mesh Network Path Selection Protocol ID: "
				"0x%02X", cfg[0]);
1355 1356 1357 1358
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1359 1360
			sprintf(buf, "Path Selection Metric ID: 0x%02X",
				cfg[1]);
1361 1362 1363 1364
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1365 1366
			sprintf(buf, "Congestion Control Mode ID: 0x%02X",
				cfg[2]);
1367 1368 1369 1370
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1371
			sprintf(buf, "Synchronization ID: 0x%02X", cfg[3]);
1372 1373 1374 1375
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386
			sprintf(buf, "Authentication ID: 0x%02X", cfg[4]);
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
			sprintf(buf, "Formation Info: 0x%02X", cfg[5]);
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
			sprintf(buf, "Capabilities: 0x%02X", cfg[6]);
1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
			kfree(buf);
			break;
		case WLAN_EID_SUPP_RATES:
		case WLAN_EID_EXT_SUPP_RATES:
			/* display all supported rates in readable format */
			p = current_ev + iwe_stream_lcp_len(info);

			memset(&iwe, 0, sizeof(iwe));
			iwe.cmd = SIOCGIWRATE;
			/* Those two flags are ignored... */
			iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;

			for (i = 0; i < ie[1]; i++) {
				iwe.u.bitrate.value =
					((ie[i + 2] & 0x7f) * 500000);
				p = iwe_stream_add_value(info, current_ev, p,
						end_buf, &iwe, IW_EV_PARAM_LEN);
			}
			current_ev = p;
			break;
		}
		rem -= ie[1] + 2;
		ie += ie[1] + 2;
	}

1416 1417
	if (bss->pub.capability & (WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_IBSS) ||
	    ismesh) {
1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = SIOCGIWMODE;
		if (ismesh)
			iwe.u.mode = IW_MODE_MESH;
		else if (bss->pub.capability & WLAN_CAPABILITY_ESS)
			iwe.u.mode = IW_MODE_MASTER;
		else
			iwe.u.mode = IW_MODE_ADHOC;
		current_ev = iwe_stream_add_event(info, current_ev, end_buf,
						  &iwe, IW_EV_UINT_LEN);
	}

1430
	buf = kmalloc(31, GFP_ATOMIC);
1431 1432 1433
	if (buf) {
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVCUSTOM;
J
Johannes Berg 已提交
1434
		sprintf(buf, "tsf=%016llx", (unsigned long long)(ies->tsf));
1435 1436 1437 1438 1439
		iwe.u.data.length = strlen(buf);
		current_ev = iwe_stream_add_point(info, current_ev, end_buf,
						  &iwe, buf);
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVCUSTOM;
1440 1441
		sprintf(buf, " Last beacon: %ums ago",
			elapsed_jiffies_msecs(bss->ts));
1442 1443 1444 1445 1446 1447
		iwe.u.data.length = strlen(buf);
		current_ev = iwe_stream_add_point(info, current_ev,
						  end_buf, &iwe, buf);
		kfree(buf);
	}

1448 1449
	ieee80211_scan_add_ies(info, ies, &current_ev, end_buf);
	rcu_read_unlock();
1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470

	return current_ev;
}


static int ieee80211_scan_results(struct cfg80211_registered_device *dev,
				  struct iw_request_info *info,
				  char *buf, size_t len)
{
	char *current_ev = buf;
	char *end_buf = buf + len;
	struct cfg80211_internal_bss *bss;

	spin_lock_bh(&dev->bss_lock);
	cfg80211_bss_expire(dev);

	list_for_each_entry(bss, &dev->bss_list, list) {
		if (buf + len - current_ev <= IW_EV_ADDR_LEN) {
			spin_unlock_bh(&dev->bss_lock);
			return -E2BIG;
		}
J
Johannes Berg 已提交
1471 1472
		current_ev = ieee80211_bss(&dev->wiphy, info, bss,
					   current_ev, end_buf);
1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488
	}
	spin_unlock_bh(&dev->bss_lock);
	return current_ev - buf;
}


int cfg80211_wext_giwscan(struct net_device *dev,
			  struct iw_request_info *info,
			  struct iw_point *data, char *extra)
{
	struct cfg80211_registered_device *rdev;
	int res;

	if (!netif_running(dev))
		return -ENETDOWN;

1489
	rdev = cfg80211_get_dev_from_ifindex(dev_net(dev), dev->ifindex);
1490 1491 1492 1493

	if (IS_ERR(rdev))
		return PTR_ERR(rdev);

1494 1495
	if (rdev->scan_req)
		return -EAGAIN;
1496 1497 1498 1499 1500 1501 1502 1503 1504 1505

	res = ieee80211_scan_results(rdev, info, extra, data->length);
	data->length = 0;
	if (res >= 0) {
		data->length = res;
		res = 0;
	}

	return res;
}
1506
EXPORT_SYMBOL_GPL(cfg80211_wext_giwscan);
1507
#endif