rt2x00mac.c 20.6 KB
Newer Older
1
/*
2
	Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
	<http://rt2x00.serialmonkey.com>

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2 of the License, or
	(at your option) any later version.

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the
	Free Software Foundation, Inc.,
	59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */

/*
	Module: rt2x00mac
	Abstract: rt2x00 generic mac80211 routines.
 */

#include <linux/kernel.h>
#include <linux/module.h>

#include "rt2x00.h"
#include "rt2x00lib.h"

static int rt2x00mac_tx_rts_cts(struct rt2x00_dev *rt2x00dev,
I
Ivo van Doorn 已提交
33
				struct data_queue *queue,
34
				struct sk_buff *frag_skb)
35
{
36 37
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(frag_skb);
	struct ieee80211_tx_info *rts_info;
38
	struct sk_buff *skb;
I
Ivo van Doorn 已提交
39
	unsigned int data_length;
40
	int retval = 0;
41

42
	if (tx_info->control.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT)
I
Ivo van Doorn 已提交
43
		data_length = sizeof(struct ieee80211_cts);
44
	else
I
Ivo van Doorn 已提交
45
		data_length = sizeof(struct ieee80211_rts);
46

I
Ivo van Doorn 已提交
47
	skb = dev_alloc_skb(data_length + rt2x00dev->hw->extra_tx_headroom);
48
	if (unlikely(!skb)) {
49
		WARNING(rt2x00dev, "Failed to create RTS/CTS frame.\n");
50
		return -ENOMEM;
51 52 53
	}

	skb_reserve(skb, rt2x00dev->hw->extra_tx_headroom);
I
Ivo van Doorn 已提交
54
	skb_put(skb, data_length);
55

56 57 58 59 60 61 62 63 64 65 66
	/*
	 * Copy TX information over from original frame to
	 * RTS/CTS frame. Note that we set the no encryption flag
	 * since we don't want this frame to be encrypted.
	 * RTS frames should be acked, while CTS-to-self frames
	 * should not. The ready for TX flag is cleared to prevent
	 * it being automatically send when the descriptor is
	 * written to the hardware.
	 */
	memcpy(skb->cb, frag_skb->cb, sizeof(skb->cb));
	rts_info = IEEE80211_SKB_CB(skb);
67 68
	rts_info->control.rates[0].flags &= ~IEEE80211_TX_RC_USE_RTS_CTS;
	rts_info->control.rates[0].flags &= ~IEEE80211_TX_RC_USE_CTS_PROTECT;
69

70
	if (tx_info->control.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT)
71 72 73 74
		rts_info->flags |= IEEE80211_TX_CTL_NO_ACK;
	else
		rts_info->flags &= ~IEEE80211_TX_CTL_NO_ACK;

75 76
	/* Disable hardware encryption */
	rts_info->control.hw_key = NULL;
I
Ivo van Doorn 已提交
77 78 79 80 81

	/*
	 * RTS/CTS frame should use the length of the frame plus any
	 * encryption overhead that will be added by the hardware.
	 */
82
	data_length += rt2x00crypto_tx_overhead(rt2x00dev, skb);
I
Ivo van Doorn 已提交
83

84
	if (tx_info->control.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT)
85
		ieee80211_ctstoself_get(rt2x00dev->hw, tx_info->control.vif,
I
Ivo van Doorn 已提交
86
					frag_skb->data, data_length, tx_info,
87 88
					(struct ieee80211_cts *)(skb->data));
	else
89
		ieee80211_rts_get(rt2x00dev->hw, tx_info->control.vif,
I
Ivo van Doorn 已提交
90
				  frag_skb->data, data_length, tx_info,
91 92
				  (struct ieee80211_rts *)(skb->data));

93
	retval = rt2x00queue_write_tx_frame(queue, skb, true);
94
	if (retval) {
95
		dev_kfree_skb_any(skb);
96 97 98
		WARNING(rt2x00dev, "Failed to send RTS/CTS frame.\n");
	}

99
	return retval;
100 101
}

102
void rt2x00mac_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
103 104
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
105
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
106
	enum data_queue_qid qid = skb_get_queue_mapping(skb);
107
	struct data_queue *queue = NULL;
108

109 110 111 112 113 114
	/*
	 * Mac80211 might be calling this function while we are trying
	 * to remove the device or perhaps suspending it.
	 * Note that we can only stop the TX queues inside the TX path
	 * due to possible race conditions in mac80211.
	 */
115
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
116
		goto exit_fail;
117

118
	/*
I
Ivo van Doorn 已提交
119
	 * Determine which queue to put packet on.
120
	 */
121
	if (tx_info->flags & IEEE80211_TX_CTL_SEND_AFTER_DTIM &&
122
	    test_bit(DRIVER_REQUIRE_ATIM_QUEUE, &rt2x00dev->flags))
123
		queue = rt2x00queue_get_queue(rt2x00dev, QID_ATIM);
124
	else
125
		queue = rt2x00queue_get_queue(rt2x00dev, qid);
I
Ivo van Doorn 已提交
126
	if (unlikely(!queue)) {
127 128
		ERROR(rt2x00dev,
		      "Attempt to send packet over invalid queue %d.\n"
129
		      "Please file bug report to %s.\n", qid, DRV_PROJECT);
I
Ivo van Doorn 已提交
130
		goto exit_fail;
131 132 133
	}

	/*
134 135 136
	 * If CTS/RTS is required. create and queue that frame first.
	 * Make sure we have at least enough entries available to send
	 * this CTS/RTS frame as well as the data frame.
137 138
	 * Note that when the driver has set the set_rts_threshold()
	 * callback function it doesn't need software generation of
139
	 * either RTS or CTS-to-self frame and handles everything
140
	 * inside the hardware.
141
	 */
142 143 144
	if (!rt2x00dev->ops->hw->set_rts_threshold &&
	    (tx_info->control.rates[0].flags & (IEEE80211_TX_RC_USE_RTS_CTS |
						IEEE80211_TX_RC_USE_CTS_PROTECT))) {
145 146
		if (rt2x00queue_available(queue) <= 1)
			goto exit_fail;
147

148 149
		if (rt2x00mac_tx_rts_cts(rt2x00dev, queue, skb))
			goto exit_fail;
150 151
	}

152
	if (rt2x00queue_write_tx_frame(queue, skb, false))
153 154
		goto exit_fail;

155
	if (rt2x00queue_threshold(queue))
156
		rt2x00queue_pause_queue(queue);
157

158
	return;
159 160 161 162

 exit_fail:
	ieee80211_stop_queue(rt2x00dev->hw, qid);
	dev_kfree_skb_any(skb);
163 164 165 166 167 168 169
}
EXPORT_SYMBOL_GPL(rt2x00mac_tx);

int rt2x00mac_start(struct ieee80211_hw *hw)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;

170
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
171 172
		return 0;

173
	return rt2x00lib_start(rt2x00dev);
174 175 176 177 178 179 180
}
EXPORT_SYMBOL_GPL(rt2x00mac_start);

void rt2x00mac_stop(struct ieee80211_hw *hw)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;

181
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
182 183
		return;

184
	rt2x00lib_stop(rt2x00dev);
185 186 187 188
}
EXPORT_SYMBOL_GPL(rt2x00mac_stop);

int rt2x00mac_add_interface(struct ieee80211_hw *hw,
189
			    struct ieee80211_vif *vif)
190 191
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
192
	struct rt2x00_intf *intf = vif_to_intf(vif);
193
	struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, QID_BEACON);
194 195
	struct queue_entry *entry = NULL;
	unsigned int i;
196 197

	/*
198 199
	 * Don't allow interfaces to be added
	 * the device has disappeared.
200
	 */
201 202
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags) ||
	    !test_bit(DEVICE_STATE_STARTED, &rt2x00dev->flags))
203 204
		return -ENODEV;

205
	switch (vif->type) {
206
	case NL80211_IFTYPE_AP:
207 208 209 210 211 212 213 214 215 216 217 218 219 220 221
		/*
		 * We don't support mixed combinations of
		 * sta and ap interfaces.
		 */
		if (rt2x00dev->intf_sta_count)
			return -ENOBUFS;

		/*
		 * Check if we exceeded the maximum amount
		 * of supported interfaces.
		 */
		if (rt2x00dev->intf_ap_count >= rt2x00dev->ops->max_ap_intf)
			return -ENOBUFS;

		break;
222 223
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_ADHOC:
A
Andrey Yurovsky 已提交
224
	case NL80211_IFTYPE_MESH_POINT:
I
Ivo van Doorn 已提交
225
	case NL80211_IFTYPE_WDS:
226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243
		/*
		 * We don't support mixed combinations of
		 * sta and ap interfaces.
		 */
		if (rt2x00dev->intf_ap_count)
			return -ENOBUFS;

		/*
		 * Check if we exceeded the maximum amount
		 * of supported interfaces.
		 */
		if (rt2x00dev->intf_sta_count >= rt2x00dev->ops->max_sta_intf)
			return -ENOBUFS;

		break;
	default:
		return -EINVAL;
	}
244 245 246 247 248 249 250 251 252

	/*
	 * Loop through all beacon queues to find a free
	 * entry. Since there are as much beacon entries
	 * as the maximum interfaces, this search shouldn't
	 * fail.
	 */
	for (i = 0; i < queue->limit; i++) {
		entry = &queue->entries[i];
253
		if (!test_and_set_bit(ENTRY_BCN_ASSIGNED, &entry->flags))
254 255 256 257
			break;
	}

	if (unlikely(i == queue->limit))
258 259
		return -ENOBUFS;

260 261 262 263 264
	/*
	 * We are now absolutely sure the interface can be created,
	 * increase interface count and start initialization.
	 */

265
	if (vif->type == NL80211_IFTYPE_AP)
266 267 268 269
		rt2x00dev->intf_ap_count++;
	else
		rt2x00dev->intf_sta_count++;

270
	spin_lock_init(&intf->seqlock);
271
	mutex_init(&intf->beacon_skb_mutex);
272 273
	intf->beacon = entry;

274
	/*
275
	 * The MAC address must be configured after the device
276 277
	 * has been initialized. Otherwise the device can reset
	 * the MAC registers.
278 279 280 281
	 * The BSSID address must only be configured in AP mode,
	 * however we should not send an empty BSSID address for
	 * STA interfaces at this time, since this can cause
	 * invalid behavior in the device.
282
	 */
283
	rt2x00lib_config_intf(rt2x00dev, intf, vif->type,
284
			      vif->addr, NULL);
285

286 287 288 289 290 291 292
	/*
	 * Some filters depend on the current working mode. We can force
	 * an update during the next configure_filter() run by mac80211 by
	 * resetting the current packet_filter state.
	 */
	rt2x00dev->packet_filter = 0;

293 294 295 296 297
	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_add_interface);

void rt2x00mac_remove_interface(struct ieee80211_hw *hw,
298
				struct ieee80211_vif *vif)
299 300
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
301
	struct rt2x00_intf *intf = vif_to_intf(vif);
302 303

	/*
304 305 306
	 * Don't allow interfaces to be remove while
	 * either the device has disappeared or when
	 * no interface is present.
307
	 */
308
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags) ||
309 310
	    (vif->type == NL80211_IFTYPE_AP && !rt2x00dev->intf_ap_count) ||
	    (vif->type != NL80211_IFTYPE_AP && !rt2x00dev->intf_sta_count))
311 312
		return;

313
	if (vif->type == NL80211_IFTYPE_AP)
314 315 316 317 318 319 320 321
		rt2x00dev->intf_ap_count--;
	else
		rt2x00dev->intf_sta_count--;

	/*
	 * Release beacon entry so it is available for
	 * new interfaces again.
	 */
322
	clear_bit(ENTRY_BCN_ASSIGNED, &intf->beacon->flags);
323 324 325 326 327

	/*
	 * Make sure the bssid and mac address registers
	 * are cleared to prevent false ACKing of frames.
	 */
328
	rt2x00lib_config_intf(rt2x00dev, intf,
329
			      NL80211_IFTYPE_UNSPECIFIED, NULL, NULL);
330 331 332
}
EXPORT_SYMBOL_GPL(rt2x00mac_remove_interface);

333
int rt2x00mac_config(struct ieee80211_hw *hw, u32 changed)
334 335
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
336
	struct ieee80211_conf *conf = &hw->conf;
337 338

	/*
L
Luis Correia 已提交
339
	 * mac80211 might be calling this function while we are trying
340
	 * to remove the device or perhaps suspending it.
341
	 */
342
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
343 344 345
		return 0;

	/*
346 347
	 * Some configuration parameters (e.g. channel and antenna values) can
	 * only be set when the radio is enabled, but do require the RX to
348 349 350
	 * be off. During this period we should keep link tuning enabled,
	 * if for any reason the link tuner must be reset, this will be
	 * handled by rt2x00lib_config().
351
	 */
352
	rt2x00queue_stop_queue(rt2x00dev->rx);
353

354 355 356 357 358
	/*
	 * When we've just turned on the radio, we want to reprogram
	 * everything to ensure a consistent state
	 */
	rt2x00lib_config(rt2x00dev, conf, changed);
359

360 361 362 363 364 365 366 367
	/*
	 * After the radio has been enabled we need to configure
	 * the antenna to the default settings. rt2x00lib_config_antenna()
	 * should determine if any action should be taken based on
	 * checking if diversity has been enabled or no antenna changes
	 * have been made since the last configuration change.
	 */
	rt2x00lib_config_antenna(rt2x00dev, rt2x00dev->default_ant);
368

369
	/* Turn RX back on */
370
	rt2x00queue_start_queue(rt2x00dev->rx);
371 372 373 374 375

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_config);

I
Ivo van Doorn 已提交
376 377 378
void rt2x00mac_configure_filter(struct ieee80211_hw *hw,
				unsigned int changed_flags,
				unsigned int *total_flags,
379
				u64 multicast)
I
Ivo van Doorn 已提交
380 381 382 383 384 385 386 387 388 389 390 391
{
	struct rt2x00_dev *rt2x00dev = hw->priv;

	/*
	 * Mask off any flags we are going to ignore
	 * from the total_flags field.
	 */
	*total_flags &=
	    FIF_ALLMULTI |
	    FIF_FCSFAIL |
	    FIF_PLCPFAIL |
	    FIF_CONTROL |
392
	    FIF_PSPOLL |
I
Ivo van Doorn 已提交
393 394 395 396 397 398 399 400 401 402 403 404 405 406
	    FIF_OTHER_BSS |
	    FIF_PROMISC_IN_BSS;

	/*
	 * Apply some rules to the filters:
	 * - Some filters imply different filters to be set.
	 * - Some things we can't filter out at all.
	 * - Multicast filter seems to kill broadcast traffic so never use it.
	 */
	*total_flags |= FIF_ALLMULTI;
	if (*total_flags & FIF_OTHER_BSS ||
	    *total_flags & FIF_PROMISC_IN_BSS)
		*total_flags |= FIF_PROMISC_IN_BSS | FIF_OTHER_BSS;

407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422
	/*
	 * If the device has a single filter for all control frames,
	 * FIF_CONTROL and FIF_PSPOLL flags imply each other.
	 * And if the device has more than one filter for control frames
	 * of different types, but has no a separate filter for PS Poll frames,
	 * FIF_CONTROL flag implies FIF_PSPOLL.
	 */
	if (!test_bit(DRIVER_SUPPORT_CONTROL_FILTERS, &rt2x00dev->flags)) {
		if (*total_flags & FIF_CONTROL || *total_flags & FIF_PSPOLL)
			*total_flags |= FIF_CONTROL | FIF_PSPOLL;
	}
	if (!test_bit(DRIVER_SUPPORT_CONTROL_FILTER_PSPOLL, &rt2x00dev->flags)) {
		if (*total_flags & FIF_CONTROL)
			*total_flags |= FIF_PSPOLL;
	}

I
Ivo van Doorn 已提交
423 424 425 426 427 428 429
	/*
	 * Check if there is any work left for us.
	 */
	if (rt2x00dev->packet_filter == *total_flags)
		return;
	rt2x00dev->packet_filter = *total_flags;

430
	rt2x00dev->ops->lib->config_filter(rt2x00dev, *total_flags);
I
Ivo van Doorn 已提交
431 432 433
}
EXPORT_SYMBOL_GPL(rt2x00mac_configure_filter);

434 435 436 437 438 439 440 441 442 443 444
static void rt2x00mac_set_tim_iter(void *data, u8 *mac,
				   struct ieee80211_vif *vif)
{
	struct rt2x00_intf *intf = vif_to_intf(vif);

	if (vif->type != NL80211_IFTYPE_AP &&
	    vif->type != NL80211_IFTYPE_ADHOC &&
	    vif->type != NL80211_IFTYPE_MESH_POINT &&
	    vif->type != NL80211_IFTYPE_WDS)
		return;

445
	set_bit(DELAYED_UPDATE_BEACON, &intf->delayed_flags);
446 447
}

448 449 450 451 452
int rt2x00mac_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
		      bool set)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;

453 454 455 456 457 458 459 460 461
	if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags))
		return 0;

	ieee80211_iterate_active_interfaces_atomic(rt2x00dev->hw,
						   rt2x00mac_set_tim_iter,
						   rt2x00dev);

	/* queue work to upodate the beacon template */
	ieee80211_queue_work(rt2x00dev->hw, &rt2x00dev->intf_work);
462 463 464 465
	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_set_tim);

I
Ivo van Doorn 已提交
466
#ifdef CONFIG_RT2X00_LIB_CRYPTO
467 468 469
static void memcpy_tkip(struct rt2x00lib_crypto *crypto, u8 *key, u8 key_len)
{
	if (key_len > NL80211_TKIP_DATA_OFFSET_ENCR_KEY)
470
		memcpy(crypto->key,
471 472 473 474
		       &key[NL80211_TKIP_DATA_OFFSET_ENCR_KEY],
		       sizeof(crypto->key));

	if (key_len > NL80211_TKIP_DATA_OFFSET_TX_MIC_KEY)
475
		memcpy(crypto->tx_mic,
476 477 478 479
		       &key[NL80211_TKIP_DATA_OFFSET_TX_MIC_KEY],
		       sizeof(crypto->tx_mic));

	if (key_len > NL80211_TKIP_DATA_OFFSET_RX_MIC_KEY)
480
		memcpy(crypto->rx_mic,
481 482 483 484
		       &key[NL80211_TKIP_DATA_OFFSET_RX_MIC_KEY],
		       sizeof(crypto->rx_mic));
}

I
Ivo van Doorn 已提交
485
int rt2x00mac_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
486
		      struct ieee80211_vif *vif, struct ieee80211_sta *sta,
I
Ivo van Doorn 已提交
487 488 489 490 491 492 493
		      struct ieee80211_key_conf *key)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
	int (*set_key) (struct rt2x00_dev *rt2x00dev,
			struct rt2x00lib_crypto *crypto,
			struct ieee80211_key_conf *key);
	struct rt2x00lib_crypto crypto;
494 495
	static const u8 bcast_addr[ETH_ALEN] =
		{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, };
I
Ivo van Doorn 已提交
496

497 498 499
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
		return 0;
	else if (!test_bit(CONFIG_SUPPORT_HW_CRYPTO, &rt2x00dev->flags))
I
Ivo van Doorn 已提交
500 501 502 503 504 505 506 507 508 509 510 511 512
		return -EOPNOTSUPP;
	else if (key->keylen > 32)
		return -ENOSPC;

	memset(&crypto, 0, sizeof(crypto));

	/*
	 * When in STA mode, bssidx is always 0 otherwise local_address[5]
	 * contains the bss number, see BSS_ID_MASK comments for details.
	 */
	if (rt2x00dev->intf_sta_count)
		crypto.bssidx = 0;
	else
513
		crypto.bssidx = vif->addr[5] & (rt2x00dev->ops->max_ap_intf - 1);
I
Ivo van Doorn 已提交
514 515 516 517 518 519

	crypto.cipher = rt2x00crypto_key_to_cipher(key);
	if (crypto.cipher == CIPHER_NONE)
		return -EOPNOTSUPP;

	crypto.cmd = cmd;
520 521 522 523 524 525 526

	if (sta) {
		/* some drivers need the AID */
		crypto.aid = sta->aid;
		crypto.address = sta->addr;
	} else
		crypto.address = bcast_addr;
I
Ivo van Doorn 已提交
527

528 529 530
	if (crypto.cipher == CIPHER_TKIP)
		memcpy_tkip(&crypto, &key->key[0], key->keylen);
	else
531
		memcpy(crypto.key, &key->key[0], key->keylen);
I
Ivo van Doorn 已提交
532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547
	/*
	 * Each BSS has a maximum of 4 shared keys.
	 * Shared key index values:
	 *	0) BSS0 key0
	 *	1) BSS0 key1
	 *	...
	 *	4) BSS1 key0
	 *	...
	 *	8) BSS2 key0
	 *	...
	 * Both pairwise as shared key indeces are determined by
	 * driver. This is required because the hardware requires
	 * keys to be assigned in correct order (When key 1 is
	 * provided but key 0 is not, then the key is not found
	 * by the hardware during RX).
	 */
548 549
	if (cmd == SET_KEY)
		key->hw_key_idx = 0;
I
Ivo van Doorn 已提交
550 551 552 553 554 555 556 557 558 559 560 561 562 563

	if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE)
		set_key = rt2x00dev->ops->lib->config_pairwise_key;
	else
		set_key = rt2x00dev->ops->lib->config_shared_key;

	if (!set_key)
		return -EOPNOTSUPP;

	return set_key(rt2x00dev, &crypto, key);
}
EXPORT_SYMBOL_GPL(rt2x00mac_set_key);
#endif /* CONFIG_RT2X00_LIB_CRYPTO */

564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579
void rt2x00mac_sw_scan_start(struct ieee80211_hw *hw)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
	__set_bit(DEVICE_STATE_SCANNING, &rt2x00dev->flags);
	rt2x00link_stop_tuner(rt2x00dev);
}
EXPORT_SYMBOL_GPL(rt2x00mac_sw_scan_start);

void rt2x00mac_sw_scan_complete(struct ieee80211_hw *hw)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
	__clear_bit(DEVICE_STATE_SCANNING, &rt2x00dev->flags);
	rt2x00link_start_tuner(rt2x00dev);
}
EXPORT_SYMBOL_GPL(rt2x00mac_sw_scan_complete);

580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595
int rt2x00mac_get_stats(struct ieee80211_hw *hw,
			struct ieee80211_low_level_stats *stats)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;

	/*
	 * The dot11ACKFailureCount, dot11RTSFailureCount and
	 * dot11RTSSuccessCount are updated in interrupt time.
	 * dot11FCSErrorCount is updated in the link tuner.
	 */
	memcpy(stats, &rt2x00dev->low_level_stats, sizeof(*stats));

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_get_stats);

596 597 598 599
void rt2x00mac_bss_info_changed(struct ieee80211_hw *hw,
				struct ieee80211_vif *vif,
				struct ieee80211_bss_conf *bss_conf,
				u32 changes)
600 601
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
602
	struct rt2x00_intf *intf = vif_to_intf(vif);
603 604

	/*
L
Luis Correia 已提交
605
	 * mac80211 might be calling this function while we are trying
606 607 608 609 610 611
	 * to remove the device or perhaps suspending it.
	 */
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
		return;

	/*
612
	 * Update the BSSID.
613 614 615
	 */
	if (changes & BSS_CHANGED_BSSID)
		rt2x00lib_config_intf(rt2x00dev, intf, vif->type, NULL,
I
Ivo van Doorn 已提交
616
				      bss_conf->bssid);
617 618

	/*
619 620
	 * Update the beacon. This is only required on USB devices. PCI
	 * devices fetch beacons periodically.
621
	 */
622
	if (changes & BSS_CHANGED_BEACON && rt2x00_is_usb(rt2x00dev))
623 624 625 626 627 628 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
		rt2x00queue_update_beacon(rt2x00dev, vif);

	/*
	 * Start/stop beaconing.
	 */
	if (changes & BSS_CHANGED_BEACON_ENABLED) {
		if (!bss_conf->enable_beacon && intf->enable_beacon) {
			rt2x00queue_clear_beacon(rt2x00dev, vif);
			rt2x00dev->intf_beaconing--;
			intf->enable_beacon = false;

			if (rt2x00dev->intf_beaconing == 0) {
				/*
				 * Last beaconing interface disabled
				 * -> stop beacon queue.
				 */
				mutex_lock(&intf->beacon_skb_mutex);
				rt2x00queue_stop_queue(rt2x00dev->bcn);
				mutex_unlock(&intf->beacon_skb_mutex);
			}


		} else if (bss_conf->enable_beacon && !intf->enable_beacon) {
			rt2x00dev->intf_beaconing++;
			intf->enable_beacon = true;

			if (rt2x00dev->intf_beaconing == 1) {
				/*
				 * First beaconing interface enabled
				 * -> start beacon queue.
				 */
				mutex_lock(&intf->beacon_skb_mutex);
				rt2x00queue_start_queue(rt2x00dev->bcn);
				mutex_unlock(&intf->beacon_skb_mutex);
			}
		}
	}
660 661

	/*
662 663 664 665
	 * When the association status has changed we must reset the link
	 * tuner counter. This is because some drivers determine if they
	 * should perform link tuning based on the number of seconds
	 * while associated or not associated.
666
	 */
667 668
	if (changes & BSS_CHANGED_ASSOC) {
		rt2x00dev->link.count = 0;
669

670 671 672 673
		if (bss_conf->assoc)
			rt2x00dev->intf_associated++;
		else
			rt2x00dev->intf_associated--;
674

675
		rt2x00leds_led_assoc(rt2x00dev, !!rt2x00dev->intf_associated);
676
	}
677

678
	/*
679 680
	 * When the erp information has changed, we should perform
	 * additional configuration steps. For all other changes we are done.
681
	 */
682 683
	if (changes & (BSS_CHANGED_ERP_CTS_PROT | BSS_CHANGED_ERP_PREAMBLE |
		       BSS_CHANGED_ERP_SLOT | BSS_CHANGED_BASIC_RATES |
684
		       BSS_CHANGED_BEACON_INT | BSS_CHANGED_HT))
685
		rt2x00lib_config_erp(rt2x00dev, intf, bss_conf, changes);
686
}
687
EXPORT_SYMBOL_GPL(rt2x00mac_bss_info_changed);
688

J
Johannes Berg 已提交
689
int rt2x00mac_conf_tx(struct ieee80211_hw *hw, u16 queue_idx,
690 691 692
		      const struct ieee80211_tx_queue_params *params)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
I
Ivo van Doorn 已提交
693
	struct data_queue *queue;
694

I
Ivo van Doorn 已提交
695 696
	queue = rt2x00queue_get_queue(rt2x00dev, queue_idx);
	if (unlikely(!queue))
697 698 699 700 701 702
		return -EINVAL;

	/*
	 * The passed variables are stored as real value ((2^n)-1).
	 * Ralink registers require to know the bit number 'n'.
	 */
703
	if (params->cw_min > 0)
I
Ivo van Doorn 已提交
704
		queue->cw_min = fls(params->cw_min);
705
	else
I
Ivo van Doorn 已提交
706
		queue->cw_min = 5; /* cw_min: 2^5 = 32. */
707

708
	if (params->cw_max > 0)
I
Ivo van Doorn 已提交
709
		queue->cw_max = fls(params->cw_max);
710
	else
I
Ivo van Doorn 已提交
711
		queue->cw_max = 10; /* cw_min: 2^10 = 1024. */
712

713
	queue->aifs = params->aifs;
714
	queue->txop = params->txop;
715 716

	INFO(rt2x00dev,
717 718
	     "Configured TX queue %d - CWmin: %d, CWmax: %d, Aifs: %d, TXop: %d.\n",
	     queue_idx, queue->cw_min, queue->cw_max, queue->aifs, queue->txop);
719 720 721 722

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_conf_tx);
723 724 725 726

void rt2x00mac_rfkill_poll(struct ieee80211_hw *hw)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
I
Ivo van Doorn 已提交
727
	bool active = !!rt2x00dev->ops->lib->rfkill_poll(rt2x00dev);
728

I
Ivo van Doorn 已提交
729
	wiphy_rfkill_set_hw_state(hw->wiphy, !active);
730 731
}
EXPORT_SYMBOL_GPL(rt2x00mac_rfkill_poll);
I
Ivo van Doorn 已提交
732 733 734 735 736 737

void rt2x00mac_flush(struct ieee80211_hw *hw, bool drop)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
	struct data_queue *queue;

I
Ivo van Doorn 已提交
738 739
	tx_queue_for_each(rt2x00dev, queue)
		rt2x00queue_flush_queue(queue, drop);
I
Ivo van Doorn 已提交
740 741
}
EXPORT_SYMBOL_GPL(rt2x00mac_flush);