mlme.c 23.5 KB
Newer Older
1 2 3 4 5 6 7 8 9 10
/*
 * cfg80211 MLME SAP interface
 *
 * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/nl80211.h>
11
#include <linux/wireless.h>
12
#include <net/cfg80211.h>
13
#include <net/iw_handler.h>
14 15 16
#include "core.h"
#include "nl80211.h"

17
void cfg80211_send_rx_auth(struct net_device *dev, const u8 *buf, size_t len)
18
{
J
Johannes Berg 已提交
19 20
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
21
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
22 23 24 25 26 27
	struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
	u8 *bssid = mgmt->bssid;
	int i;
	u16 status = le16_to_cpu(mgmt->u.auth.status_code);
	bool done = false;

J
Johannes Berg 已提交
28
	wdev_lock(wdev);
29

J
Johannes Berg 已提交
30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46
	for (i = 0; i < MAX_AUTH_BSSES; i++) {
		if (wdev->authtry_bsses[i] &&
		    memcmp(wdev->authtry_bsses[i]->pub.bssid, bssid,
							ETH_ALEN) == 0) {
			if (status == WLAN_STATUS_SUCCESS) {
				wdev->auth_bsses[i] = wdev->authtry_bsses[i];
			} else {
				cfg80211_unhold_bss(wdev->authtry_bsses[i]);
				cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
			}
			wdev->authtry_bsses[i] = NULL;
			done = true;
			break;
		}
	}

	WARN_ON(!done);
47

48
	nl80211_send_rx_auth(rdev, dev, buf, len, GFP_KERNEL);
49
	cfg80211_sme_rx_auth(dev, buf, len);
J
Johannes Berg 已提交
50 51

	wdev_unlock(wdev);
52 53 54
}
EXPORT_SYMBOL(cfg80211_send_rx_auth);

55
void cfg80211_send_rx_assoc(struct net_device *dev, const u8 *buf, size_t len)
56
{
57 58 59
	u16 status_code;
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
60
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
61 62
	struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
	u8 *ie = mgmt->u.assoc_resp.variable;
J
Johannes Berg 已提交
63
	int i, ieoffs = offsetof(struct ieee80211_mgmt, u.assoc_resp.variable);
64
	struct cfg80211_internal_bss *bss = NULL;
65

J
Johannes Berg 已提交
66
	wdev_lock(wdev);
67

68 69
	status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code);

70 71 72 73 74 75 76 77 78 79
	/*
	 * This is a bit of a hack, we don't notify userspace of
	 * a (re-)association reply if we tried to send a reassoc
	 * and got a reject -- we only try again with an assoc
	 * frame instead of reassoc.
	 */
	if (status_code != WLAN_STATUS_SUCCESS && wdev->conn &&
	    cfg80211_sme_failed_reassoc(wdev))
		goto out;

80
	nl80211_send_rx_assoc(rdev, dev, buf, len, GFP_KERNEL);
81

J
Johannes Berg 已提交
82
	if (status_code == WLAN_STATUS_SUCCESS) {
83 84 85 86 87 88
		for (i = 0; i < MAX_AUTH_BSSES; i++) {
			if (!wdev->auth_bsses[i])
				continue;
			if (memcmp(wdev->auth_bsses[i]->pub.bssid, mgmt->bssid,
				   ETH_ALEN) == 0) {
				bss = wdev->auth_bsses[i];
J
Johannes Berg 已提交
89
				wdev->auth_bsses[i] = NULL;
90 91
				/* additional reference to drop hold */
				cfg80211_ref_bss(bss);
J
Johannes Berg 已提交
92 93 94 95
				break;
			}
		}

96 97 98 99 100 101 102 103 104 105 106 107
		/*
		 * We might be coming here because the driver reported
		 * a successful association at the same time as the
		 * user requested a deauth. In that case, we will have
		 * removed the BSS from the auth_bsses list due to the
		 * deauth request when the assoc response makes it. If
		 * the two code paths acquire the lock the other way
		 * around, that's just the standard situation of a
		 * deauth being requested while connected.
		 */
		if (!bss)
			goto out;
108 109 110 111 112 113 114
	} else if (wdev->conn) {
		cfg80211_sme_failed_assoc(wdev);
		/*
		 * do not call connect_result() now because the
		 * sme will schedule work that does it later.
		 */
		goto out;
115 116
	}

117 118 119 120 121 122 123 124 125
	if (!wdev->conn && wdev->sme_state == CFG80211_SME_IDLE) {
		/*
		 * This is for the userspace SME, the CONNECTING
		 * state will be changed to CONNECTED by
		 * __cfg80211_connect_result() below.
		 */
		wdev->sme_state = CFG80211_SME_CONNECTING;
	}

126 127 128 129 130 131 132 133 134
	/* this consumes one bss reference (unless bss is NULL) */
	__cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, ie, len - ieoffs,
				  status_code,
				  status_code == WLAN_STATUS_SUCCESS,
				  bss ? &bss->pub : NULL);
	/* drop hold now, and also reference acquired above */
	if (bss) {
		cfg80211_unhold_bss(bss);
		cfg80211_put_bss(&bss->pub);
J
Johannes Berg 已提交
135
	}
J
Johannes Berg 已提交
136

137
 out:
J
Johannes Berg 已提交
138
	wdev_unlock(wdev);
139 140 141
}
EXPORT_SYMBOL(cfg80211_send_rx_assoc);

142
void __cfg80211_send_deauth(struct net_device *dev,
J
Johannes Berg 已提交
143
				   const u8 *buf, size_t len)
144
{
145 146
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
147
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
148
	struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
J
Johannes Berg 已提交
149 150
	const u8 *bssid = mgmt->bssid;
	int i;
151
	bool found = false;
152

J
Johannes Berg 已提交
153
	ASSERT_WDEV_LOCK(wdev);
154

J
Johannes Berg 已提交
155 156 157 158 159
	if (wdev->current_bss &&
	    memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0) {
		cfg80211_unhold_bss(wdev->current_bss);
		cfg80211_put_bss(&wdev->current_bss->pub);
		wdev->current_bss = NULL;
160
		found = true;
J
Johannes Berg 已提交
161 162 163 164 165 166
	} else for (i = 0; i < MAX_AUTH_BSSES; i++) {
		if (wdev->auth_bsses[i] &&
		    memcmp(wdev->auth_bsses[i]->pub.bssid, bssid, ETH_ALEN) == 0) {
			cfg80211_unhold_bss(wdev->auth_bsses[i]);
			cfg80211_put_bss(&wdev->auth_bsses[i]->pub);
			wdev->auth_bsses[i] = NULL;
167
			found = true;
J
Johannes Berg 已提交
168 169 170 171 172 173 174
			break;
		}
		if (wdev->authtry_bsses[i] &&
		    memcmp(wdev->authtry_bsses[i]->pub.bssid, bssid, ETH_ALEN) == 0) {
			cfg80211_unhold_bss(wdev->authtry_bsses[i]);
			cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
			wdev->authtry_bsses[i] = NULL;
175
			found = true;
J
Johannes Berg 已提交
176 177 178 179
			break;
		}
	}

180 181 182 183 184
	if (!found)
		return;

	nl80211_send_deauth(rdev, dev, buf, len, GFP_KERNEL);

185 186 187 188 189 190
	if (wdev->sme_state == CFG80211_SME_CONNECTED) {
		u16 reason_code;
		bool from_ap;

		reason_code = le16_to_cpu(mgmt->u.deauth.reason_code);

191
		from_ap = memcmp(mgmt->sa, dev->dev_addr, ETH_ALEN) != 0;
J
Johannes Berg 已提交
192
		__cfg80211_disconnected(dev, NULL, 0, reason_code, from_ap);
193
	} else if (wdev->sme_state == CFG80211_SME_CONNECTING) {
J
Johannes Berg 已提交
194 195
		__cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, NULL, 0,
					  WLAN_STATUS_UNSPECIFIED_FAILURE,
196
					  false, NULL);
J
Johannes Berg 已提交
197 198
	}
}
199
EXPORT_SYMBOL(__cfg80211_send_deauth);
J
Johannes Berg 已提交
200

201
void cfg80211_send_deauth(struct net_device *dev, const u8 *buf, size_t len)
J
Johannes Berg 已提交
202 203 204
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;

205 206 207
	wdev_lock(wdev);
	__cfg80211_send_deauth(dev, buf, len);
	wdev_unlock(wdev);
208
}
209
EXPORT_SYMBOL(cfg80211_send_deauth);
210

211
void __cfg80211_send_disassoc(struct net_device *dev,
J
Johannes Berg 已提交
212
				     const u8 *buf, size_t len)
213
{
214 215
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
216
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
217
	struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
J
Johannes Berg 已提交
218 219 220 221 222
	const u8 *bssid = mgmt->bssid;
	int i;
	u16 reason_code;
	bool from_ap;
	bool done = false;
223

224
	ASSERT_WDEV_LOCK(wdev);
225 226

	nl80211_send_disassoc(rdev, dev, buf, len, GFP_KERNEL);
227

228 229
	if (wdev->sme_state != CFG80211_SME_CONNECTED)
		return;
230

J
Johannes Berg 已提交
231
	if (wdev->current_bss &&
232
	    memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0) {
J
Johannes Berg 已提交
233 234 235 236 237 238 239 240 241 242 243 244
		for (i = 0; i < MAX_AUTH_BSSES; i++) {
			if (wdev->authtry_bsses[i] || wdev->auth_bsses[i])
				continue;
			wdev->auth_bsses[i] = wdev->current_bss;
			wdev->current_bss = NULL;
			done = true;
			cfg80211_sme_disassoc(dev, i);
			break;
		}
		WARN_ON(!done);
	} else
		WARN_ON(1);
245 246


J
Johannes Berg 已提交
247 248
	reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code);

249
	from_ap = memcmp(mgmt->sa, dev->dev_addr, ETH_ALEN) != 0;
J
Johannes Berg 已提交
250 251
	__cfg80211_disconnected(dev, NULL, 0, reason_code, from_ap);
}
252
EXPORT_SYMBOL(__cfg80211_send_disassoc);
J
Johannes Berg 已提交
253

254
void cfg80211_send_disassoc(struct net_device *dev, const u8 *buf, size_t len)
J
Johannes Berg 已提交
255 256 257
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;

258 259 260
	wdev_lock(wdev);
	__cfg80211_send_disassoc(dev, buf, len);
	wdev_unlock(wdev);
261
}
262
EXPORT_SYMBOL(cfg80211_send_disassoc);
263

264
static void __cfg80211_auth_remove(struct wireless_dev *wdev, const u8 *addr)
265
{
J
Johannes Berg 已提交
266 267 268
	int i;
	bool done = false;

269
	ASSERT_WDEV_LOCK(wdev);
J
Johannes Berg 已提交
270 271 272 273 274 275 276 277 278 279 280 281 282 283

	for (i = 0; addr && i < MAX_AUTH_BSSES; i++) {
		if (wdev->authtry_bsses[i] &&
		    memcmp(wdev->authtry_bsses[i]->pub.bssid,
			   addr, ETH_ALEN) == 0) {
			cfg80211_unhold_bss(wdev->authtry_bsses[i]);
			cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
			wdev->authtry_bsses[i] = NULL;
			done = true;
			break;
		}
	}

	WARN_ON(!done);
284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306
}

void __cfg80211_auth_canceled(struct net_device *dev, const u8 *addr)
{
	__cfg80211_auth_remove(dev->ieee80211_ptr, addr);
}
EXPORT_SYMBOL(__cfg80211_auth_canceled);

void cfg80211_send_auth_timeout(struct net_device *dev, const u8 *addr)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);

	wdev_lock(wdev);

	nl80211_send_auth_timeout(rdev, dev, addr, GFP_KERNEL);
	if (wdev->sme_state == CFG80211_SME_CONNECTING)
		__cfg80211_connect_result(dev, addr, NULL, 0, NULL, 0,
					  WLAN_STATUS_UNSPECIFIED_FAILURE,
					  false, NULL);

	__cfg80211_auth_remove(wdev, addr);
J
Johannes Berg 已提交
307 308

	wdev_unlock(wdev);
309 310 311
}
EXPORT_SYMBOL(cfg80211_send_auth_timeout);

312
void cfg80211_send_assoc_timeout(struct net_device *dev, const u8 *addr)
313
{
314 315
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
316
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
317 318 319
	int i;
	bool done = false;

J
Johannes Berg 已提交
320
	wdev_lock(wdev);
321 322

	nl80211_send_assoc_timeout(rdev, dev, addr, GFP_KERNEL);
323
	if (wdev->sme_state == CFG80211_SME_CONNECTING)
J
Johannes Berg 已提交
324 325
		__cfg80211_connect_result(dev, addr, NULL, 0, NULL, 0,
					  WLAN_STATUS_UNSPECIFIED_FAILURE,
326
					  false, NULL);
J
Johannes Berg 已提交
327 328 329 330 331 332 333 334 335 336 337 338 339 340

	for (i = 0; addr && i < MAX_AUTH_BSSES; i++) {
		if (wdev->auth_bsses[i] &&
		    memcmp(wdev->auth_bsses[i]->pub.bssid,
			   addr, ETH_ALEN) == 0) {
			cfg80211_unhold_bss(wdev->auth_bsses[i]);
			cfg80211_put_bss(&wdev->auth_bsses[i]->pub);
			wdev->auth_bsses[i] = NULL;
			done = true;
			break;
		}
	}

	WARN_ON(!done);
J
Johannes Berg 已提交
341 342

	wdev_unlock(wdev);
343 344 345
}
EXPORT_SYMBOL(cfg80211_send_assoc_timeout);

346 347
void cfg80211_michael_mic_failure(struct net_device *dev, const u8 *addr,
				  enum nl80211_key_type key_type, int key_id,
348
				  const u8 *tsc, gfp_t gfp)
349 350 351
{
	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
352
#ifdef CONFIG_CFG80211_WEXT
353
	union iwreq_data wrqu;
354
	char *buf = kmalloc(128, gfp);
355 356 357 358 359 360 361 362 363 364 365 366 367

	if (buf) {
		sprintf(buf, "MLME-MICHAELMICFAILURE.indication("
			"keyid=%d %scast addr=%pM)", key_id,
			key_type == NL80211_KEYTYPE_GROUP ? "broad" : "uni",
			addr);
		memset(&wrqu, 0, sizeof(wrqu));
		wrqu.data.length = strlen(buf);
		wireless_send_event(dev, IWEVCUSTOM, &wrqu, buf);
		kfree(buf);
	}
#endif

368
	nl80211_michael_mic_failure(rdev, dev, addr, key_type, key_id, tsc, gfp);
369 370
}
EXPORT_SYMBOL(cfg80211_michael_mic_failure);
J
Johannes Berg 已提交
371 372

/* some MLME handling for userspace SME */
J
Johannes Berg 已提交
373 374 375 376 377 378
int __cfg80211_mlme_auth(struct cfg80211_registered_device *rdev,
			 struct net_device *dev,
			 struct ieee80211_channel *chan,
			 enum nl80211_auth_type auth_type,
			 const u8 *bssid,
			 const u8 *ssid, int ssid_len,
J
Johannes Berg 已提交
379 380
			 const u8 *ie, int ie_len,
			 const u8 *key, int key_len, int key_idx)
J
Johannes Berg 已提交
381 382 383 384 385 386
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_auth_request req;
	struct cfg80211_internal_bss *bss;
	int i, err, slot = -1, nfree = 0;

J
Johannes Berg 已提交
387 388
	ASSERT_WDEV_LOCK(wdev);

J
Johannes Berg 已提交
389 390 391 392
	if (auth_type == NL80211_AUTHTYPE_SHARED_KEY)
		if (!key || !key_len || key_idx < 0 || key_idx > 4)
			return -EINVAL;

393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
	if (wdev->current_bss &&
	    memcmp(bssid, wdev->current_bss->pub.bssid, ETH_ALEN) == 0)
		return -EALREADY;

	for (i = 0; i < MAX_AUTH_BSSES; i++) {
		if (wdev->authtry_bsses[i] &&
		    memcmp(bssid, wdev->authtry_bsses[i]->pub.bssid,
						ETH_ALEN) == 0)
			return -EALREADY;
		if (wdev->auth_bsses[i] &&
		    memcmp(bssid, wdev->auth_bsses[i]->pub.bssid,
						ETH_ALEN) == 0)
			return -EALREADY;
	}

J
Johannes Berg 已提交
408 409 410 411 412 413 414
	memset(&req, 0, sizeof(req));

	req.ie = ie;
	req.ie_len = ie_len;
	req.auth_type = auth_type;
	req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
				   WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
J
Johannes Berg 已提交
415 416 417
	req.key = key;
	req.key_len = key_len;
	req.key_idx = key_idx;
J
Johannes Berg 已提交
418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450
	if (!req.bss)
		return -ENOENT;

	bss = bss_from_pub(req.bss);

	for (i = 0; i < MAX_AUTH_BSSES; i++) {
		if (!wdev->auth_bsses[i] && !wdev->authtry_bsses[i]) {
			slot = i;
			nfree++;
		}
	}

	/* we need one free slot for disassoc and one for this auth */
	if (nfree < 2) {
		err = -ENOSPC;
		goto out;
	}

	wdev->authtry_bsses[slot] = bss;
	cfg80211_hold_bss(bss);

	err = rdev->ops->auth(&rdev->wiphy, dev, &req);
	if (err) {
		wdev->authtry_bsses[slot] = NULL;
		cfg80211_unhold_bss(bss);
	}

 out:
	if (err)
		cfg80211_put_bss(req.bss);
	return err;
}

J
Johannes Berg 已提交
451 452 453 454
int cfg80211_mlme_auth(struct cfg80211_registered_device *rdev,
		       struct net_device *dev, struct ieee80211_channel *chan,
		       enum nl80211_auth_type auth_type, const u8 *bssid,
		       const u8 *ssid, int ssid_len,
J
Johannes Berg 已提交
455 456
		       const u8 *ie, int ie_len,
		       const u8 *key, int key_len, int key_idx)
J
Johannes Berg 已提交
457 458 459 460 461
{
	int err;

	wdev_lock(dev->ieee80211_ptr);
	err = __cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
J
Johannes Berg 已提交
462 463
				   ssid, ssid_len, ie, ie_len,
				   key, key_len, key_idx);
J
Johannes Berg 已提交
464 465 466 467 468 469 470 471 472 473 474 475
	wdev_unlock(dev->ieee80211_ptr);

	return err;
}

int __cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev,
			  struct net_device *dev,
			  struct ieee80211_channel *chan,
			  const u8 *bssid, const u8 *prev_bssid,
			  const u8 *ssid, int ssid_len,
			  const u8 *ie, int ie_len, bool use_mfp,
			  struct cfg80211_crypto_settings *crypt)
J
Johannes Berg 已提交
476 477 478 479 480
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_assoc_request req;
	struct cfg80211_internal_bss *bss;
	int i, err, slot = -1;
481
	bool was_connected = false;
J
Johannes Berg 已提交
482

J
Johannes Berg 已提交
483 484
	ASSERT_WDEV_LOCK(wdev);

J
Johannes Berg 已提交
485 486
	memset(&req, 0, sizeof(req));

487 488 489 490 491 492 493 494 495 496 497
	if (wdev->current_bss && prev_bssid &&
	    memcmp(wdev->current_bss->pub.bssid, prev_bssid, ETH_ALEN) == 0) {
		/*
		 * Trying to reassociate: Allow this to proceed and let the old
		 * association to be dropped when the new one is completed.
		 */
		if (wdev->sme_state == CFG80211_SME_CONNECTED) {
			was_connected = true;
			wdev->sme_state = CFG80211_SME_CONNECTING;
		}
	} else if (wdev->current_bss)
J
Johannes Berg 已提交
498 499 500 501 502 503
		return -EALREADY;

	req.ie = ie;
	req.ie_len = ie_len;
	memcpy(&req.crypto, crypt, sizeof(req.crypto));
	req.use_mfp = use_mfp;
504
	req.prev_bssid = prev_bssid;
J
Johannes Berg 已提交
505 506
	req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
				   WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
507 508 509
	if (!req.bss) {
		if (was_connected)
			wdev->sme_state = CFG80211_SME_CONNECTED;
J
Johannes Berg 已提交
510
		return -ENOENT;
511
	}
J
Johannes Berg 已提交
512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528

	bss = bss_from_pub(req.bss);

	for (i = 0; i < MAX_AUTH_BSSES; i++) {
		if (bss == wdev->auth_bsses[i]) {
			slot = i;
			break;
		}
	}

	if (slot < 0) {
		err = -ENOTCONN;
		goto out;
	}

	err = rdev->ops->assoc(&rdev->wiphy, dev, &req);
 out:
529 530
	if (err && was_connected)
		wdev->sme_state = CFG80211_SME_CONNECTED;
J
Johannes Berg 已提交
531 532 533 534 535
	/* still a reference in wdev->auth_bsses[slot] */
	cfg80211_put_bss(req.bss);
	return err;
}

J
Johannes Berg 已提交
536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557
int cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev,
			struct net_device *dev,
			struct ieee80211_channel *chan,
			const u8 *bssid, const u8 *prev_bssid,
			const u8 *ssid, int ssid_len,
			const u8 *ie, int ie_len, bool use_mfp,
			struct cfg80211_crypto_settings *crypt)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	int err;

	wdev_lock(wdev);
	err = __cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid,
				    ssid, ssid_len, ie, ie_len, use_mfp, crypt);
	wdev_unlock(wdev);

	return err;
}

int __cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev,
			   struct net_device *dev, const u8 *bssid,
			   const u8 *ie, int ie_len, u16 reason)
J
Johannes Berg 已提交
558 559 560 561 562
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_deauth_request req;
	int i;

J
Johannes Berg 已提交
563 564
	ASSERT_WDEV_LOCK(wdev);

J
Johannes Berg 已提交
565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587
	memset(&req, 0, sizeof(req));
	req.reason_code = reason;
	req.ie = ie;
	req.ie_len = ie_len;
	if (wdev->current_bss &&
	    memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0) {
		req.bss = &wdev->current_bss->pub;
	} else for (i = 0; i < MAX_AUTH_BSSES; i++) {
		if (wdev->auth_bsses[i] &&
		    memcmp(bssid, wdev->auth_bsses[i]->pub.bssid, ETH_ALEN) == 0) {
			req.bss = &wdev->auth_bsses[i]->pub;
			break;
		}
		if (wdev->authtry_bsses[i] &&
		    memcmp(bssid, wdev->authtry_bsses[i]->pub.bssid, ETH_ALEN) == 0) {
			req.bss = &wdev->authtry_bsses[i]->pub;
			break;
		}
	}

	if (!req.bss)
		return -ENOTCONN;

J
Johannes Berg 已提交
588
	return rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
J
Johannes Berg 已提交
589 590
}

J
Johannes Berg 已提交
591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607
int cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev,
			 struct net_device *dev, const u8 *bssid,
			 const u8 *ie, int ie_len, u16 reason)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	int err;

	wdev_lock(wdev);
	err = __cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason);
	wdev_unlock(wdev);

	return err;
}

static int __cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev,
				    struct net_device *dev, const u8 *bssid,
				    const u8 *ie, int ie_len, u16 reason)
J
Johannes Berg 已提交
608 609 610 611
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_disassoc_request req;

J
Johannes Berg 已提交
612 613
	ASSERT_WDEV_LOCK(wdev);

614 615 616 617 618 619
	if (wdev->sme_state != CFG80211_SME_CONNECTED)
		return -ENOTCONN;

	if (WARN_ON(!wdev->current_bss))
		return -ENOTCONN;

J
Johannes Berg 已提交
620 621 622 623 624 625 626 627 628
	memset(&req, 0, sizeof(req));
	req.reason_code = reason;
	req.ie = ie;
	req.ie_len = ie_len;
	if (memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0)
		req.bss = &wdev->current_bss->pub;
	else
		return -ENOTCONN;

J
Johannes Berg 已提交
629 630 631 632 633 634 635 636 637 638 639 640 641 642 643
	return rdev->ops->disassoc(&rdev->wiphy, dev, &req, wdev);
}

int cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev,
			   struct net_device *dev, const u8 *bssid,
			   const u8 *ie, int ie_len, u16 reason)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	int err;

	wdev_lock(wdev);
	err = __cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason);
	wdev_unlock(wdev);

	return err;
J
Johannes Berg 已提交
644 645 646 647 648 649 650 651 652
}

void cfg80211_mlme_down(struct cfg80211_registered_device *rdev,
			struct net_device *dev)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_deauth_request req;
	int i;

J
Johannes Berg 已提交
653 654
	ASSERT_WDEV_LOCK(wdev);

J
Johannes Berg 已提交
655 656 657 658 659 660 661 662 663 664
	if (!rdev->ops->deauth)
		return;

	memset(&req, 0, sizeof(req));
	req.reason_code = WLAN_REASON_DEAUTH_LEAVING;
	req.ie = NULL;
	req.ie_len = 0;

	if (wdev->current_bss) {
		req.bss = &wdev->current_bss->pub;
J
Johannes Berg 已提交
665
		rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
J
Johannes Berg 已提交
666 667 668 669 670 671 672 673 674 675
		if (wdev->current_bss) {
			cfg80211_unhold_bss(wdev->current_bss);
			cfg80211_put_bss(&wdev->current_bss->pub);
			wdev->current_bss = NULL;
		}
	}

	for (i = 0; i < MAX_AUTH_BSSES; i++) {
		if (wdev->auth_bsses[i]) {
			req.bss = &wdev->auth_bsses[i]->pub;
J
Johannes Berg 已提交
676
			rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
J
Johannes Berg 已提交
677 678 679 680 681 682 683 684
			if (wdev->auth_bsses[i]) {
				cfg80211_unhold_bss(wdev->auth_bsses[i]);
				cfg80211_put_bss(&wdev->auth_bsses[i]->pub);
				wdev->auth_bsses[i] = NULL;
			}
		}
		if (wdev->authtry_bsses[i]) {
			req.bss = &wdev->authtry_bsses[i]->pub;
J
Johannes Berg 已提交
685
			rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
J
Johannes Berg 已提交
686 687 688 689 690 691 692 693
			if (wdev->authtry_bsses[i]) {
				cfg80211_unhold_bss(wdev->authtry_bsses[i]);
				cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
				wdev->authtry_bsses[i] = NULL;
			}
		}
	}
}
694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720

void cfg80211_ready_on_channel(struct net_device *dev, u64 cookie,
			       struct ieee80211_channel *chan,
			       enum nl80211_channel_type channel_type,
			       unsigned int duration, gfp_t gfp)
{
	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);

	nl80211_send_remain_on_channel(rdev, dev, cookie, chan, channel_type,
				       duration, gfp);
}
EXPORT_SYMBOL(cfg80211_ready_on_channel);

void cfg80211_remain_on_channel_expired(struct net_device *dev,
					u64 cookie,
					struct ieee80211_channel *chan,
					enum nl80211_channel_type channel_type,
					gfp_t gfp)
{
	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);

	nl80211_send_remain_on_channel_cancel(rdev, dev, cookie, chan,
					      channel_type, gfp);
}
EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
721 722 723 724 725 726 727 728 729 730

void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
		      struct station_info *sinfo, gfp_t gfp)
{
	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);

	nl80211_send_sta_event(rdev, dev, mac_addr, sinfo, gfp);
}
EXPORT_SYMBOL(cfg80211_new_sta);
731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 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 821 822 823 824 825 826 827 828 829 830 831 832 833 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 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896

struct cfg80211_action_registration {
	struct list_head list;

	u32 nlpid;

	int match_len;

	u8 match[];
};

int cfg80211_mlme_register_action(struct wireless_dev *wdev, u32 snd_pid,
				  const u8 *match_data, int match_len)
{
	struct cfg80211_action_registration *reg, *nreg;
	int err = 0;

	nreg = kzalloc(sizeof(*reg) + match_len, GFP_KERNEL);
	if (!nreg)
		return -ENOMEM;

	spin_lock_bh(&wdev->action_registrations_lock);

	list_for_each_entry(reg, &wdev->action_registrations, list) {
		int mlen = min(match_len, reg->match_len);

		if (memcmp(reg->match, match_data, mlen) == 0) {
			err = -EALREADY;
			break;
		}
	}

	if (err) {
		kfree(nreg);
		goto out;
	}

	memcpy(nreg->match, match_data, match_len);
	nreg->match_len = match_len;
	nreg->nlpid = snd_pid;
	list_add(&nreg->list, &wdev->action_registrations);

 out:
	spin_unlock_bh(&wdev->action_registrations_lock);
	return err;
}

void cfg80211_mlme_unregister_actions(struct wireless_dev *wdev, u32 nlpid)
{
	struct cfg80211_action_registration *reg, *tmp;

	spin_lock_bh(&wdev->action_registrations_lock);

	list_for_each_entry_safe(reg, tmp, &wdev->action_registrations, list) {
		if (reg->nlpid == nlpid) {
			list_del(&reg->list);
			kfree(reg);
		}
	}

	spin_unlock_bh(&wdev->action_registrations_lock);
}

void cfg80211_mlme_purge_actions(struct wireless_dev *wdev)
{
	struct cfg80211_action_registration *reg, *tmp;

	spin_lock_bh(&wdev->action_registrations_lock);

	list_for_each_entry_safe(reg, tmp, &wdev->action_registrations, list) {
		list_del(&reg->list);
		kfree(reg);
	}

	spin_unlock_bh(&wdev->action_registrations_lock);
}

int cfg80211_mlme_action(struct cfg80211_registered_device *rdev,
			 struct net_device *dev,
			 struct ieee80211_channel *chan,
			 enum nl80211_channel_type channel_type,
			 const u8 *buf, size_t len, u64 *cookie)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	const struct ieee80211_mgmt *mgmt;

	if (rdev->ops->action == NULL)
		return -EOPNOTSUPP;
	if (len < 24 + 1)
		return -EINVAL;

	mgmt = (const struct ieee80211_mgmt *) buf;
	if (!ieee80211_is_action(mgmt->frame_control))
		return -EINVAL;
	if (mgmt->u.action.category != WLAN_CATEGORY_PUBLIC) {
		/* Verify that we are associated with the destination AP */
		if (!wdev->current_bss ||
		    memcmp(wdev->current_bss->pub.bssid, mgmt->bssid,
			   ETH_ALEN) != 0 ||
		    memcmp(wdev->current_bss->pub.bssid, mgmt->da,
			   ETH_ALEN) != 0)
			return -ENOTCONN;
	}

	if (memcmp(mgmt->sa, dev->dev_addr, ETH_ALEN) != 0)
		return -EINVAL;

	/* Transmit the Action frame as requested by user space */
	return rdev->ops->action(&rdev->wiphy, dev, chan, channel_type,
				 buf, len, cookie);
}

bool cfg80211_rx_action(struct net_device *dev, int freq, const u8 *buf,
			size_t len, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
	struct cfg80211_action_registration *reg;
	const u8 *action_data;
	int action_data_len;
	bool result = false;

	/* frame length - min size excluding category */
	action_data_len = len - (IEEE80211_MIN_ACTION_SIZE - 1);

	/* action data starts with category */
	action_data = buf + IEEE80211_MIN_ACTION_SIZE - 1;

	spin_lock_bh(&wdev->action_registrations_lock);

	list_for_each_entry(reg, &wdev->action_registrations, list) {
		if (reg->match_len > action_data_len)
			continue;

		if (memcmp(reg->match, action_data, reg->match_len))
			continue;

		/* found match! */

		/* Indicate the received Action frame to user space */
		if (nl80211_send_action(rdev, dev, reg->nlpid, freq,
					buf, len, gfp))
			continue;

		result = true;
		break;
	}

	spin_unlock_bh(&wdev->action_registrations_lock);

	return result;
}
EXPORT_SYMBOL(cfg80211_rx_action);

void cfg80211_action_tx_status(struct net_device *dev, u64 cookie,
			       const u8 *buf, size_t len, bool ack, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);

	/* Indicate TX status of the Action frame to user space */
	nl80211_send_action_tx_status(rdev, dev, cookie, buf, len, ack, gfp);
}
EXPORT_SYMBOL(cfg80211_action_tx_status);