scan.c 38.0 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
	lockdep_assert_held(&rdev->sched_scan_mtx);
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
	mutex_lock(&rdev->sched_scan_mtx);
234
	___cfg80211_scan_done(rdev, false);
235
	mutex_unlock(&rdev->sched_scan_mtx);
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
	queue_work(cfg80211_wq, &wiphy_to_dev(request->wiphy)->scan_done_wk);
J
Johannes Berg 已提交
245
}
246 247
EXPORT_SYMBOL(cfg80211_scan_done);

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

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

256 257
	request = rdev->sched_scan_req;

258
	mutex_lock(&rdev->sched_scan_mtx);
259 260

	/* we don't have sched_scan_req anymore if the scan is stopping */
261 262 263 264 265 266 267 268 269 270 271
	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);
	}
272

273
	mutex_unlock(&rdev->sched_scan_mtx);
274 275 276 277
}

void cfg80211_sched_scan_results(struct wiphy *wiphy)
{
278
	trace_cfg80211_sched_scan_results(wiphy);
279 280 281 282 283 284 285
	/* 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);

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

290 291
	trace_cfg80211_sched_scan_stopped(wiphy);

292
	mutex_lock(&rdev->sched_scan_mtx);
293
	__cfg80211_stop_sched_scan(rdev, true);
294
	mutex_unlock(&rdev->sched_scan_mtx);
295 296 297 298 299 300 301 302
}
EXPORT_SYMBOL(cfg80211_sched_scan_stopped);

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

303
	lockdep_assert_held(&rdev->sched_scan_mtx);
304 305

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

	dev = rdev->sched_scan_req->dev;

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

	nl80211_send_sched_scan(rdev, dev, NL80211_CMD_SCHED_SCAN_STOPPED);

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

321
	return 0;
322 323
}

324 325 326 327 328 329
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);

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

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

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

355 356 357 358 359 360 361 362 363 364 365 366 367 368
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;
369 370 371 372 373 374 375

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

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

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

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

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

395 396 397
	if (!ssid)
		return true;

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

409 410 411 412 413 414 415 416 417 418 419 420
/**
 * 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,
};

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

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

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

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

475 476
	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);
477

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

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

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

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

525 526 527
struct cfg80211_bss *cfg80211_get_bss(struct wiphy *wiphy,
				      struct ieee80211_channel *channel,
				      const u8 *bssid,
528 529
				      const u8 *ssid, size_t ssid_len,
				      u16 capa_mask, u16 capa_val)
530 531 532
{
	struct cfg80211_registered_device *dev = wiphy_to_dev(wiphy);
	struct cfg80211_internal_bss *bss, *res = NULL;
533
	unsigned long now = jiffies;
534

535 536 537
	trace_cfg80211_get_bss(wiphy, channel, bssid, ssid, ssid_len, capa_mask,
			       capa_val);

538 539 540
	spin_lock_bh(&dev->bss_lock);

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

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

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

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

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

	return NULL;
}

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

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

630 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
	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;
678 679
}

680 681
static struct cfg80211_internal_bss *
cfg80211_bss_update(struct cfg80211_registered_device *dev,
682
		    struct cfg80211_internal_bss *tmp)
683 684 685
{
	struct cfg80211_internal_bss *found = NULL;

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

689
	tmp->ts = jiffies;
690 691 692

	spin_lock_bh(&dev->bss_lock);

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

	return found;
831 832 833
 drop:
	spin_unlock_bh(&dev->bss_lock);
	return NULL;
834 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
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;
}

868 869 870
struct cfg80211_bss*
cfg80211_inform_bss(struct wiphy *wiphy,
		    struct ieee80211_channel *channel,
871 872
		    const u8 *bssid, u64 tsf, u16 capability,
		    u16 beacon_interval, const u8 *ie, size_t ielen,
873 874
		    s32 signal, gfp_t gfp)
{
875 876
	struct cfg80211_bss_ies *ies;
	struct cfg80211_internal_bss tmp = {}, *res;
877 878 879 880

	if (WARN_ON(!wiphy))
		return NULL;

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

885 886 887 888
	channel = cfg80211_get_bss_channel(wiphy, ie, ielen, channel);
	if (!channel)
		return NULL;

889 890 891 892 893
	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;
894 895 896 897 898
	/*
	 * 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
899
	 * override the IEs pointer should we have received an earlier
900
	 * indication of Probe Response data.
901
	 */
902 903 904 905
	ies = kmalloc(sizeof(*ies) + ielen, gfp);
	if (!ies)
		return NULL;
	ies->len = ielen;
J
Johannes Berg 已提交
906
	ies->tsf = tsf;
907
	memcpy(ies->data, ie, ielen);
908

909 910
	rcu_assign_pointer(tmp.pub.beacon_ies, ies);
	rcu_assign_pointer(tmp.pub.ies, ies);
911

912
	res = cfg80211_bss_update(wiphy_to_dev(wiphy), &tmp);
913 914 915 916 917 918
	if (!res)
		return NULL;

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

919
	trace_cfg80211_return_bss(&res->pub);
920 921 922 923 924
	/* cfg80211_bss_update gives us a referenced result */
	return &res->pub;
}
EXPORT_SYMBOL(cfg80211_inform_bss);

925 926 927 928
struct cfg80211_bss *
cfg80211_inform_bss_frame(struct wiphy *wiphy,
			  struct ieee80211_channel *channel,
			  struct ieee80211_mgmt *mgmt, size_t len,
J
Johannes Berg 已提交
929
			  s32 signal, gfp_t gfp)
930
{
931 932
	struct cfg80211_internal_bss tmp = {}, *res;
	struct cfg80211_bss_ies *ies;
933 934
	size_t ielen = len - offsetof(struct ieee80211_mgmt,
				      u.probe_resp.variable);
935

936 937 938
	BUILD_BUG_ON(offsetof(struct ieee80211_mgmt, u.probe_resp.variable) !=
			offsetof(struct ieee80211_mgmt, u.beacon.variable));

939 940
	trace_cfg80211_inform_bss_frame(wiphy, channel, mgmt, len, signal);

941 942 943 944 945
	if (WARN_ON(!mgmt))
		return NULL;

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

S
Sujith 已提交
947
	if (WARN_ON(wiphy->signal_type == CFG80211_SIGNAL_TYPE_UNSPEC &&
H
Hila Gonen 已提交
948
		    (signal < 0 || signal > 100)))
949 950
		return NULL;

951
	if (WARN_ON(len < offsetof(struct ieee80211_mgmt, u.probe_resp.variable)))
952 953
		return NULL;

954 955 956 957 958
	channel = cfg80211_get_bss_channel(wiphy, mgmt->u.beacon.variable,
					   ielen, channel);
	if (!channel)
		return NULL;

959 960
	ies = kmalloc(sizeof(*ies) + ielen, gfp);
	if (!ies)
961
		return NULL;
962
	ies->len = ielen;
J
Johannes Berg 已提交
963
	ies->tsf = le64_to_cpu(mgmt->u.probe_resp.timestamp);
964
	memcpy(ies->data, mgmt->u.probe_resp.variable, ielen);
965

966 967 968 969 970 971 972 973 974 975 976 977 978
	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);
979 980 981
	if (!res)
		return NULL;

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

985
	trace_cfg80211_return_bss(&res->pub);
986 987 988 989 990
	/* cfg80211_bss_update gives us a referenced result */
	return &res->pub;
}
EXPORT_SYMBOL(cfg80211_inform_bss_frame);

991
void cfg80211_ref_bss(struct wiphy *wiphy, struct cfg80211_bss *pub)
992
{
993
	struct cfg80211_registered_device *dev = wiphy_to_dev(wiphy);
994 995 996 997 998 999
	struct cfg80211_internal_bss *bss;

	if (!pub)
		return;

	bss = container_of(pub, struct cfg80211_internal_bss, pub);
1000 1001 1002 1003

	spin_lock_bh(&dev->bss_lock);
	bss_ref_get(dev, bss);
	spin_unlock_bh(&dev->bss_lock);
1004 1005 1006
}
EXPORT_SYMBOL(cfg80211_ref_bss);

1007
void cfg80211_put_bss(struct wiphy *wiphy, struct cfg80211_bss *pub)
1008
{
1009
	struct cfg80211_registered_device *dev = wiphy_to_dev(wiphy);
1010 1011 1012 1013 1014 1015
	struct cfg80211_internal_bss *bss;

	if (!pub)
		return;

	bss = container_of(pub, struct cfg80211_internal_bss, pub);
1016 1017 1018 1019

	spin_lock_bh(&dev->bss_lock);
	bss_ref_put(dev, bss);
	spin_unlock_bh(&dev->bss_lock);
1020 1021 1022
}
EXPORT_SYMBOL(cfg80211_put_bss);

1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033
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 已提交
1034
	if (!list_empty(&bss->list)) {
1035 1036
		if (__cfg80211_unlink_bss(dev, bss))
			dev->bss_generation++;
J
Johannes Berg 已提交
1037
	}
1038 1039 1040 1041
	spin_unlock_bh(&dev->bss_lock);
}
EXPORT_SYMBOL(cfg80211_unlink_bss);

J
Johannes Berg 已提交
1042
#ifdef CONFIG_CFG80211_WEXT
1043 1044 1045 1046 1047 1048 1049
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;
1050
	struct cfg80211_scan_request *creq = NULL;
1051 1052 1053 1054 1055 1056
	int i, err, n_channels = 0;
	enum ieee80211_band band;

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

1057 1058 1059
	if (wrqu->data.length == sizeof(struct iw_scan_req))
		wreq = (struct iw_scan_req *)extra;

1060
	rdev = cfg80211_get_dev_from_ifindex(dev_net(dev), dev->ifindex);
1061 1062 1063 1064

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

1065
	mutex_lock(&rdev->sched_scan_mtx);
1066 1067 1068 1069 1070 1071 1072
	if (rdev->scan_req) {
		err = -EBUSY;
		goto out;
	}

	wiphy = &rdev->wiphy;

1073 1074 1075 1076 1077 1078 1079 1080
	/* 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;
	}
1081 1082 1083 1084 1085 1086 1087 1088 1089 1090

	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 已提交
1091
	creq->wdev = dev->ieee80211_ptr;
1092 1093
	/* SSIDs come after channels */
	creq->ssids = (void *)&creq->channels[n_channels];
1094 1095
	creq->n_channels = n_channels;
	creq->n_ssids = 1;
1096
	creq->scan_start = jiffies;
1097

1098
	/* translate "Scan on frequencies" request */
1099 1100 1101
	i = 0;
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		int j;
J
Johannes Berg 已提交
1102

1103 1104
		if (!wiphy->bands[band])
			continue;
J
Johannes Berg 已提交
1105

1106
		for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
J
Johannes Berg 已提交
1107 1108 1109 1110
			/* ignore disabled channels */
			if (wiphy->bands[band]->channels[j].flags &
						IEEE80211_CHAN_DISABLED)
				continue;
1111 1112 1113 1114 1115 1116 1117 1118 1119

			/* 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++) {
1120
					int wext_freq = cfg80211_wext_freq(wiphy, &wreq->channel_list[k]);
1121 1122 1123 1124 1125 1126 1127
					if (wext_freq == wiphy_freq)
						goto wext_freq_found;
				}
				goto wext_freq_not_found;
			}

		wext_freq_found:
1128 1129
			creq->channels[i] = &wiphy->bands[band]->channels[j];
			i++;
1130
		wext_freq_not_found: ;
1131 1132
		}
	}
1133 1134 1135 1136 1137
	/* No channels found? */
	if (!i) {
		err = -EINVAL;
		goto out;
	}
1138

1139 1140
	/* Set real number of channels specified in creq->channels[] */
	creq->n_channels = i;
1141

1142 1143
	/* translate "Scan for SSID" request */
	if (wreq) {
1144
		if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
1145 1146 1147 1148
			if (wreq->essid_len > IEEE80211_MAX_SSID_LEN) {
				err = -EINVAL;
				goto out;
			}
1149 1150 1151 1152 1153 1154 1155
			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;
	}

1156
	for (i = 0; i < IEEE80211_NUM_BANDS; i++)
1157 1158
		if (wiphy->bands[i])
			creq->rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1;
1159

1160
	rdev->scan_req = creq;
1161
	err = rdev_scan(rdev, creq);
1162 1163
	if (err) {
		rdev->scan_req = NULL;
1164
		/* creq will be freed below */
1165
	} else {
J
Johannes Berg 已提交
1166
		nl80211_send_scan_start(rdev, dev->ieee80211_ptr);
1167 1168
		/* creq now owned by driver */
		creq = NULL;
1169 1170
		dev_hold(dev);
	}
1171
 out:
1172
	mutex_unlock(&rdev->sched_scan_mtx);
1173
	kfree(creq);
1174
	cfg80211_unlock_rdev(rdev);
1175 1176
	return err;
}
1177
EXPORT_SYMBOL_GPL(cfg80211_wext_siwscan);
1178 1179

static void ieee80211_scan_add_ies(struct iw_request_info *info,
1180
				   const struct cfg80211_bss_ies *ies,
1181 1182
				   char **current_ev, char *end_buf)
{
1183
	const u8 *pos, *end, *next;
1184 1185
	struct iw_event iwe;

1186
	if (!ies)
1187 1188 1189 1190 1191 1192
		return;

	/*
	 * If needed, fragment the IEs buffer (at IE boundaries) into short
	 * enough fragments to fit into IW_GENERIC_IE_MAX octet messages.
	 */
1193 1194
	pos = ies->data;
	end = pos + ies->len;
1195 1196 1197 1198 1199 1200 1201 1202 1203 1204

	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,
1205 1206
						   end_buf, &iwe,
						   (void *)pos);
1207 1208 1209 1210 1211 1212 1213 1214 1215

		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,
1216 1217
						   end_buf, &iwe,
						   (void *)pos);
1218 1219 1220 1221
	}
}

static char *
J
Johannes Berg 已提交
1222 1223 1224
ieee80211_bss(struct wiphy *wiphy, struct iw_request_info *info,
	      struct cfg80211_internal_bss *bss, char *current_ev,
	      char *end_buf)
1225
{
1226
	const struct cfg80211_bss_ies *ies;
1227
	struct iw_event iwe;
1228
	const u8 *ie;
1229
	u8 *buf, *cfg, *p;
1230
	int rem, i, sig;
1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253
	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 已提交
1254
	if (wiphy->signal_type != CFG80211_SIGNAL_TYPE_NONE) {
1255 1256 1257 1258
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVQUAL;
		iwe.u.qual.updated = IW_QUAL_LEVEL_UPDATED |
				     IW_QUAL_NOISE_INVALID |
1259
				     IW_QUAL_QUAL_UPDATED;
J
Johannes Berg 已提交
1260
		switch (wiphy->signal_type) {
1261
		case CFG80211_SIGNAL_TYPE_MBM:
1262 1263
			sig = bss->pub.signal / 100;
			iwe.u.qual.level = sig;
1264
			iwe.u.qual.updated |= IW_QUAL_DBM;
1265 1266 1267 1268 1269 1270
			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;
1271 1272 1273
			break;
		case CFG80211_SIGNAL_TYPE_UNSPEC:
			iwe.u.qual.level = bss->pub.signal;
1274 1275
			/* will give range 0 .. 100 */
			iwe.u.qual.qual = bss->pub.signal;
1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294
			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, "");

1295 1296
	rcu_read_lock();
	ies = rcu_dereference(bss->pub.ies);
1297 1298
	rem = ies->len;
	ie = ies->data;
1299

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

1395 1396
	if (bss->pub.capability & (WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_IBSS) ||
	    ismesh) {
1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408
		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);
	}

1409
	buf = kmalloc(31, GFP_ATOMIC);
1410 1411 1412
	if (buf) {
		memset(&iwe, 0, sizeof(iwe));
		iwe.cmd = IWEVCUSTOM;
J
Johannes Berg 已提交
1413
		sprintf(buf, "tsf=%016llx", (unsigned long long)(ies->tsf));
1414 1415 1416 1417 1418
		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;
1419 1420
		sprintf(buf, " Last beacon: %ums ago",
			elapsed_jiffies_msecs(bss->ts));
1421 1422 1423 1424 1425 1426
		iwe.u.data.length = strlen(buf);
		current_ev = iwe_stream_add_point(info, current_ev,
						  end_buf, &iwe, buf);
		kfree(buf);
	}

1427 1428
	ieee80211_scan_add_ies(info, ies, &current_ev, end_buf);
	rcu_read_unlock();
1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449

	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 已提交
1450 1451
		current_ev = ieee80211_bss(&dev->wiphy, info, bss,
					   current_ev, end_buf);
1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467
	}
	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;

1468
	rdev = cfg80211_get_dev_from_ifindex(dev_net(dev), dev->ifindex);
1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485

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

	if (rdev->scan_req) {
		res = -EAGAIN;
		goto out;
	}

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

 out:
1486
	cfg80211_unlock_rdev(rdev);
1487 1488
	return res;
}
1489
EXPORT_SYMBOL_GPL(cfg80211_wext_giwscan);
1490
#endif