scan.c 38.5 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
	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]);
		}
	}

	r = memcmp(a->bssid, b->bssid, sizeof(a->bssid));
	if (r)
		return r;

472 473
	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);
474

475 476 477
	if (!ie1 && !ie2)
		return 0;

J
Johannes Berg 已提交
478
	/*
479 480 481
	 * 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 已提交
482
	 */
483 484 485 486 487 488 489

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

490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509
	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];
510
		return memcmp(ie1 + 2, ie2 + 2, ie1[1]);
511 512 513 514 515 516 517 518 519
	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;
	}
520 521
}

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

533 534 535
	trace_cfg80211_get_bss(wiphy, channel, bssid, ssid, ssid_len, capa_mask,
			       capa_val);

536 537 538
	spin_lock_bh(&dev->bss_lock);

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

	spin_unlock_bh(&dev->bss_lock);
	if (!res)
		return NULL;
557
	trace_cfg80211_return_bss(&res->pub);
558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573
	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);

574
		cmp = cmp_bss(&bss->pub, &tbss->pub, BSS_CMP_REGULAR);
575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592

		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,
593
	    struct cfg80211_internal_bss *res,
594
	    enum bss_compare_mode mode)
595 596 597 598 599 600 601
{
	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);
602
		r = cmp_bss(&res->pub, &bss->pub, mode);
603 604 605 606 607 608 609 610 611 612 613 614

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

	return NULL;
}

615 616
static bool cfg80211_combine_bsses(struct cfg80211_registered_device *dev,
				   struct cfg80211_internal_bss *new)
617
{
618
	const struct cfg80211_bss_ies *ies;
619 620 621 622
	struct cfg80211_internal_bss *bss;
	const u8 *ie;
	int i, ssidlen;
	u8 fold = 0;
623

624
	ies = rcu_access_pointer(new->pub.beacon_ies);
625
	if (WARN_ON(!ies))
626
		return false;
627

628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649
	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;
650 651
		if (bss->pub.scan_width != new->pub.scan_width)
			continue;
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
		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;
678 679
}

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

687
	if (WARN_ON(!tmp->pub.channel))
688 689
		return NULL;

690
	tmp->ts = jiffies;
691 692 693

	spin_lock_bh(&dev->bss_lock);

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

699
	found = rb_find_bss(dev, tmp, BSS_CMP_REGULAR);
700

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

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

708 709
			rcu_assign_pointer(found->pub.proberesp_ies,
					   tmp->pub.proberesp_ies);
710
			/* Override possible earlier Beacon frame IEs */
711 712 713 714 715 716
			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)) {
717
			const struct cfg80211_bss_ies *old;
718 719 720 721
			struct cfg80211_internal_bss *bss;

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

724 725 726 727 728 729 730 731 732
				/*
				 * 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.
				 */
733 734 735 736

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

740 741 742 743
			old = rcu_access_pointer(found->pub.beacon_ies);

			rcu_assign_pointer(found->pub.beacon_ies,
					   tmp->pub.beacon_ies);
744 745

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

750 751 752 753 754 755 756 757 758 759 760 761
			/* 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);
			}

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

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

776 777 778 779 780 781 782 783 784 785 786 787 788 789
		/*
		 * 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);
790
			goto drop;
791 792
		}
		memcpy(new, tmp, sizeof(*new));
793 794 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
		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;
			}
		}

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

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

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

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
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;
}

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

	if (WARN_ON(!wiphy))
		return NULL;

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

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

892 893
	memcpy(tmp.pub.bssid, bssid, ETH_ALEN);
	tmp.pub.channel = channel;
894
	tmp.pub.scan_width = scan_width;
895 896 897
	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
	/* cfg80211_bss_update gives us a referenced result */
	return &res->pub;
}
927
EXPORT_SYMBOL(cfg80211_inform_bss_width);
928

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

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

945 946
	trace_cfg80211_inform_bss_width_frame(wiphy, channel, scan_width, mgmt,
					      len, signal);
947

948 949 950 951 952
	if (WARN_ON(!mgmt))
		return NULL;

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

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

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

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

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

973 974 975 976 977 978 979 980
	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;
981
	tmp.pub.scan_width = scan_width;
982 983 984 985 986
	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);
987 988 989
	if (!res)
		return NULL;

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

993
	trace_cfg80211_return_bss(&res->pub);
994 995 996
	/* cfg80211_bss_update gives us a referenced result */
	return &res->pub;
}
997
EXPORT_SYMBOL(cfg80211_inform_bss_width_frame);
998

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

	if (!pub)
		return;

	bss = container_of(pub, struct cfg80211_internal_bss, pub);
1008 1009 1010 1011

	spin_lock_bh(&dev->bss_lock);
	bss_ref_get(dev, bss);
	spin_unlock_bh(&dev->bss_lock);
1012 1013 1014
}
EXPORT_SYMBOL(cfg80211_ref_bss);

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

	if (!pub)
		return;

	bss = container_of(pub, struct cfg80211_internal_bss, pub);
1024 1025 1026 1027

	spin_lock_bh(&dev->bss_lock);
	bss_ref_put(dev, bss);
	spin_unlock_bh(&dev->bss_lock);
1028 1029 1030
}
EXPORT_SYMBOL(cfg80211_put_bss);

1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041
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 已提交
1042
	if (!list_empty(&bss->list)) {
1043 1044
		if (__cfg80211_unlink_bss(dev, bss))
			dev->bss_generation++;
J
Johannes Berg 已提交
1045
	}
1046 1047 1048 1049
	spin_unlock_bh(&dev->bss_lock);
}
EXPORT_SYMBOL(cfg80211_unlink_bss);

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

1057 1058
	ASSERT_RTNL();

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

1070 1071 1072 1073 1074 1075 1076
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;
1077
	struct cfg80211_scan_request *creq = NULL;
1078 1079 1080 1081 1082 1083
	int i, err, n_channels = 0;
	enum ieee80211_band band;

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

1084 1085 1086
	if (wrqu->data.length == sizeof(struct iw_scan_req))
		wreq = (struct iw_scan_req *)extra;

1087
	rdev = cfg80211_get_dev_from_ifindex(dev_net(dev), dev->ifindex);
1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098

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

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

	wiphy = &rdev->wiphy;

1099 1100 1101 1102 1103 1104 1105 1106
	/* 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;
	}
1107 1108 1109 1110 1111 1112 1113 1114 1115 1116

	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 已提交
1117
	creq->wdev = dev->ieee80211_ptr;
1118 1119
	/* SSIDs come after channels */
	creq->ssids = (void *)&creq->channels[n_channels];
1120 1121
	creq->n_channels = n_channels;
	creq->n_ssids = 1;
1122
	creq->scan_start = jiffies;
1123

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

1129 1130
		if (!wiphy->bands[band])
			continue;
J
Johannes Berg 已提交
1131

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

			/* 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++) {
1146
					int wext_freq = cfg80211_wext_freq(wiphy, &wreq->channel_list[k]);
1147 1148 1149 1150 1151 1152 1153
					if (wext_freq == wiphy_freq)
						goto wext_freq_found;
				}
				goto wext_freq_not_found;
			}

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

1165 1166
	/* Set real number of channels specified in creq->channels[] */
	creq->n_channels = i;
1167

1168 1169
	/* translate "Scan for SSID" request */
	if (wreq) {
1170
		if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
1171 1172 1173 1174
			if (wreq->essid_len > IEEE80211_MAX_SSID_LEN) {
				err = -EINVAL;
				goto out;
			}
1175 1176 1177 1178 1179 1180 1181
			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;
	}

1182
	for (i = 0; i < IEEE80211_NUM_BANDS; i++)
1183 1184
		if (wiphy->bands[i])
			creq->rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1;
1185

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

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

1210
	if (!ies)
1211 1212 1213 1214 1215 1216
		return;

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

	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,
1229 1230
						   end_buf, &iwe,
						   (void *)pos);
1231 1232 1233 1234 1235 1236 1237 1238 1239

		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,
1240 1241
						   end_buf, &iwe,
						   (void *)pos);
1242 1243 1244 1245
	}
}

static char *
J
Johannes Berg 已提交
1246 1247 1248
ieee80211_bss(struct wiphy *wiphy, struct iw_request_info *info,
	      struct cfg80211_internal_bss *bss, char *current_ev,
	      char *end_buf)
1249
{
1250
	const struct cfg80211_bss_ies *ies;
1251
	struct iw_event iwe;
1252
	const u8 *ie;
1253
	u8 *buf, *cfg, *p;
1254
	int rem, i, sig;
1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
	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 已提交
1278
	if (wiphy->signal_type != CFG80211_SIGNAL_TYPE_NONE) {
1279 1280 1281 1282
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVQUAL;
		iwe.u.qual.updated = IW_QUAL_LEVEL_UPDATED |
				     IW_QUAL_NOISE_INVALID |
1283
				     IW_QUAL_QUAL_UPDATED;
J
Johannes Berg 已提交
1284
		switch (wiphy->signal_type) {
1285
		case CFG80211_SIGNAL_TYPE_MBM:
1286 1287
			sig = bss->pub.signal / 100;
			iwe.u.qual.level = sig;
1288
			iwe.u.qual.updated |= IW_QUAL_DBM;
1289 1290 1291 1292 1293 1294
			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;
1295 1296 1297
			break;
		case CFG80211_SIGNAL_TYPE_UNSPEC:
			iwe.u.qual.level = bss->pub.signal;
1298 1299
			/* will give range 0 .. 100 */
			iwe.u.qual.qual = bss->pub.signal;
1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
			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, "");

1319 1320
	rcu_read_lock();
	ies = rcu_dereference(bss->pub.ies);
1321 1322
	rem = ies->len;
	ie = ies->data;
1323

1324
	while (rem >= 2) {
1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335
		/* 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,
1336
							  &iwe, (u8 *)ie + 2);
1337 1338 1339 1340 1341 1342 1343
			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,
1344
							  &iwe, (u8 *)ie + 2);
1345 1346 1347
			break;
		case WLAN_EID_MESH_CONFIG:
			ismesh = true;
1348
			if (ie[1] != sizeof(struct ieee80211_meshconf_ie))
1349 1350 1351 1352
				break;
			buf = kmalloc(50, GFP_ATOMIC);
			if (!buf)
				break;
1353
			cfg = (u8 *)ie + 2;
1354 1355
			memset(&iwe, 0, sizeof(iwe));
			iwe.cmd = IWEVCUSTOM;
1356 1357
			sprintf(buf, "Mesh Network Path Selection Protocol ID: "
				"0x%02X", cfg[0]);
1358 1359 1360 1361
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1362 1363
			sprintf(buf, "Path Selection Metric ID: 0x%02X",
				cfg[1]);
1364 1365 1366 1367
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1368 1369
			sprintf(buf, "Congestion Control Mode ID: 0x%02X",
				cfg[2]);
1370 1371 1372 1373
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1374
			sprintf(buf, "Synchronization ID: 0x%02X", cfg[3]);
1375 1376 1377 1378
			iwe.u.data.length = strlen(buf);
			current_ev = iwe_stream_add_point(info, current_ev,
							  end_buf,
							  &iwe, buf);
1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389
			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]);
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 1416 1417 1418
			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;
	}

1419 1420
	if (bss->pub.capability & (WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_IBSS) ||
	    ismesh) {
1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432
		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);
	}

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

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

	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 已提交
1474 1475
		current_ev = ieee80211_bss(&dev->wiphy, info, bss,
					   current_ev, end_buf);
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491
	}
	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;

1492
	rdev = cfg80211_get_dev_from_ifindex(dev_net(dev), dev->ifindex);
1493 1494 1495 1496

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

1497 1498
	if (rdev->scan_req)
		return -EAGAIN;
1499 1500 1501 1502 1503 1504 1505 1506 1507 1508

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

	return res;
}
1509
EXPORT_SYMBOL_GPL(cfg80211_wext_giwscan);
1510
#endif