rt2x00mac.c 19.1 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
int 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);
I
Ivo van Doorn 已提交
107
	struct data_queue *queue;
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
	if ((tx_info->control.rates[0].flags & (IEEE80211_TX_RC_USE_RTS_CTS |
						IEEE80211_TX_RC_USE_CTS_PROTECT)) &&
144
	    !rt2x00dev->ops->hw->set_rts_threshold) {
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
		ieee80211_stop_queue(rt2x00dev->hw, qid);
157 158

	return NETDEV_TX_OK;
159 160 161 162 163

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

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

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

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

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

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

185
	rt2x00lib_stop(rt2x00dev);
186 187 188 189 190 191 192
}
EXPORT_SYMBOL_GPL(rt2x00mac_stop);

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

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

206
	switch (conf->type) {
207
	case NL80211_IFTYPE_AP:
208 209 210 211 212 213 214 215 216 217 218 219 220 221 222
		/*
		 * 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;
223 224
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_ADHOC:
A
Andrey Yurovsky 已提交
225
	case NL80211_IFTYPE_MESH_POINT:
I
Ivo van Doorn 已提交
226
	case NL80211_IFTYPE_WDS:
227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
		/*
		 * 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;
	}
245 246 247 248 249 250 251 252 253

	/*
	 * 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];
254
		if (!test_and_set_bit(ENTRY_BCN_ASSIGNED, &entry->flags))
255 256 257 258
			break;
	}

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

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

266
	if (conf->type == NL80211_IFTYPE_AP)
267 268 269 270 271
		rt2x00dev->intf_ap_count++;
	else
		rt2x00dev->intf_sta_count++;

	spin_lock_init(&intf->lock);
272
	spin_lock_init(&intf->seqlock);
273
	mutex_init(&intf->beacon_skb_mutex);
274 275
	intf->beacon = entry;

276
	if (conf->type == NL80211_IFTYPE_AP)
277 278
		memcpy(&intf->bssid, conf->mac_addr, ETH_ALEN);
	memcpy(&intf->mac, conf->mac_addr, ETH_ALEN);
279 280 281

	/*
	 * The MAC adddress must be configured after the device
282 283
	 * has been initialized. Otherwise the device can reset
	 * the MAC registers.
284
	 */
285
	rt2x00lib_config_intf(rt2x00dev, intf, conf->type, intf->mac, NULL);
286

287 288 289 290 291 292 293
	/*
	 * 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;

294 295 296 297 298 299 300 301
	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_add_interface);

void rt2x00mac_remove_interface(struct ieee80211_hw *hw,
				struct ieee80211_if_init_conf *conf)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
302
	struct rt2x00_intf *intf = vif_to_intf(conf->vif);
303 304

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

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

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

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

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

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

	/*
347 348 349
	 * Some configuration parameters (e.g. channel and antenna values) can
	 * only be set when the radio is enabled, but do require the RX to
	 * be off.
350
	 */
351
	rt2x00lib_toggle_rx(rt2x00dev, STATE_RADIO_RX_OFF);
352

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

359 360 361 362 363 364 365 366
	/*
	 * 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);
367

368 369
	/* Turn RX back on */
	rt2x00lib_toggle_rx(rt2x00dev, STATE_RADIO_RX_ON);
370 371 372 373 374

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_config);

I
Ivo van Doorn 已提交
375 376 377
void rt2x00mac_configure_filter(struct ieee80211_hw *hw,
				unsigned int changed_flags,
				unsigned int *total_flags,
378
				u64 multicast)
I
Ivo van Doorn 已提交
379 380 381 382 383 384 385 386 387 388 389 390
{
	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 |
391
	    FIF_PSPOLL |
I
Ivo van Doorn 已提交
392 393 394 395 396 397 398 399 400 401 402 403 404 405
	    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;

406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421
	/*
	 * 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 已提交
422 423 424 425 426 427 428
	/*
	 * Check if there is any work left for us.
	 */
	if (rt2x00dev->packet_filter == *total_flags)
		return;
	rt2x00dev->packet_filter = *total_flags;

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

433 434 435 436 437 438 439 440 441 442
int rt2x00mac_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
		      bool set)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;

	rt2x00lib_beacondone(rt2x00dev);
	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_set_tim);

I
Ivo van Doorn 已提交
443
#ifdef CONFIG_RT2X00_LIB_CRYPTO
444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
static void memcpy_tkip(struct rt2x00lib_crypto *crypto, u8 *key, u8 key_len)
{
	if (key_len > NL80211_TKIP_DATA_OFFSET_ENCR_KEY)
		memcpy(&crypto->key,
		       &key[NL80211_TKIP_DATA_OFFSET_ENCR_KEY],
		       sizeof(crypto->key));

	if (key_len > NL80211_TKIP_DATA_OFFSET_TX_MIC_KEY)
		memcpy(&crypto->tx_mic,
		       &key[NL80211_TKIP_DATA_OFFSET_TX_MIC_KEY],
		       sizeof(crypto->tx_mic));

	if (key_len > NL80211_TKIP_DATA_OFFSET_RX_MIC_KEY)
		memcpy(&crypto->rx_mic,
		       &key[NL80211_TKIP_DATA_OFFSET_RX_MIC_KEY],
		       sizeof(crypto->rx_mic));
}

I
Ivo van Doorn 已提交
462
int rt2x00mac_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
463
		      struct ieee80211_vif *vif, struct ieee80211_sta *sta,
I
Ivo van Doorn 已提交
464 465 466
		      struct ieee80211_key_conf *key)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
467
	struct rt2x00_intf *intf = vif_to_intf(vif);
I
Ivo van Doorn 已提交
468 469 470 471
	int (*set_key) (struct rt2x00_dev *rt2x00dev,
			struct rt2x00lib_crypto *crypto,
			struct ieee80211_key_conf *key);
	struct rt2x00lib_crypto crypto;
472 473
	static const u8 bcast_addr[ETH_ALEN] =
		{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, };
I
Ivo van Doorn 已提交
474

475 476 477
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
		return 0;
	else if (!test_bit(CONFIG_SUPPORT_HW_CRYPTO, &rt2x00dev->flags))
I
Ivo van Doorn 已提交
478 479 480 481 482 483 484 485 486 487 488 489 490
		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
491
		crypto.bssidx = intf->mac[5] & (rt2x00dev->ops->max_ap_intf - 1);
I
Ivo van Doorn 已提交
492 493 494 495 496 497

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

	crypto.cmd = cmd;
498 499 500 501 502 503 504

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

506 507 508
	if (crypto.cipher == CIPHER_TKIP)
		memcpy_tkip(&crypto, &key->key[0], key->keylen);
	else
I
Ivo van Doorn 已提交
509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525
		memcpy(&crypto.key, &key->key[0], key->keylen);
	/*
	 * 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).
	 */
526 527
	if (cmd == SET_KEY)
		key->hw_key_idx = 0;
I
Ivo van Doorn 已提交
528 529 530 531 532 533 534 535 536 537 538 539 540 541

	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 */

542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563
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);

int rt2x00mac_get_tx_stats(struct ieee80211_hw *hw,
			   struct ieee80211_tx_queue_stats *stats)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
	unsigned int i;

564
	for (i = 0; i < rt2x00dev->ops->tx_queues; i++) {
565 566 567
		stats[i].len = rt2x00dev->tx[i].length;
		stats[i].limit = rt2x00dev->tx[i].limit;
		stats[i].count = rt2x00dev->tx[i].count;
I
Ivo van Doorn 已提交
568
	}
569 570 571 572 573

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_get_tx_stats);

574 575 576 577
void rt2x00mac_bss_info_changed(struct ieee80211_hw *hw,
				struct ieee80211_vif *vif,
				struct ieee80211_bss_conf *bss_conf,
				u32 changes)
578 579
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
580
	struct rt2x00_intf *intf = vif_to_intf(vif);
581 582 583
	int update_bssid = 0;

	/*
L
Luis Correia 已提交
584
	 * mac80211 might be calling this function while we are trying
585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618
	 * to remove the device or perhaps suspending it.
	 */
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
		return;

	spin_lock(&intf->lock);

	/*
	 * conf->bssid can be NULL if coming from the internal
	 * beacon update routine.
	 */
	if (changes & BSS_CHANGED_BSSID) {
		update_bssid = 1;
		memcpy(&intf->bssid, bss_conf->bssid, ETH_ALEN);
	}

	spin_unlock(&intf->lock);

	/*
	 * Call rt2x00_config_intf() outside of the spinlock context since
	 * the call will sleep for USB drivers. By using the ieee80211_if_conf
	 * values as arguments we make keep access to rt2x00_intf thread safe
	 * even without the lock.
	 */
	if (changes & BSS_CHANGED_BSSID)
		rt2x00lib_config_intf(rt2x00dev, intf, vif->type, NULL,
				      update_bssid ? bss_conf->bssid : NULL);

	/*
	 * Update the beacon.
	 */
	if (changes & (BSS_CHANGED_BEACON | BSS_CHANGED_BEACON_ENABLED))
		rt2x00queue_update_beacon(rt2x00dev, vif,
					  bss_conf->enable_beacon);
619 620

	/*
621 622 623 624
	 * 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.
625
	 */
626 627
	if (changes & BSS_CHANGED_ASSOC) {
		rt2x00dev->link.count = 0;
628

629 630 631 632
		if (bss_conf->assoc)
			rt2x00dev->intf_associated++;
		else
			rt2x00dev->intf_associated--;
633

634
		rt2x00leds_led_assoc(rt2x00dev, !!rt2x00dev->intf_associated);
635
	}
636

637
	/*
638 639
	 * When the erp information has changed, we should perform
	 * additional configuration steps. For all other changes we are done.
640
	 */
641 642
	if (changes & ~(BSS_CHANGED_ASSOC | BSS_CHANGED_HT))
		rt2x00lib_config_erp(rt2x00dev, intf, bss_conf);
643
}
644
EXPORT_SYMBOL_GPL(rt2x00mac_bss_info_changed);
645

J
Johannes Berg 已提交
646
int rt2x00mac_conf_tx(struct ieee80211_hw *hw, u16 queue_idx,
647 648 649
		      const struct ieee80211_tx_queue_params *params)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
I
Ivo van Doorn 已提交
650
	struct data_queue *queue;
651

I
Ivo van Doorn 已提交
652 653
	queue = rt2x00queue_get_queue(rt2x00dev, queue_idx);
	if (unlikely(!queue))
654 655 656 657 658 659
		return -EINVAL;

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

665
	if (params->cw_max > 0)
I
Ivo van Doorn 已提交
666
		queue->cw_max = fls(params->cw_max);
667
	else
I
Ivo van Doorn 已提交
668
		queue->cw_max = 10; /* cw_min: 2^10 = 1024. */
669

670
	queue->aifs = params->aifs;
671
	queue->txop = params->txop;
672 673

	INFO(rt2x00dev,
674 675
	     "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);
676 677 678 679

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_conf_tx);
680 681 682 683

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

I
Ivo van Doorn 已提交
686
	wiphy_rfkill_set_hw_state(hw->wiphy, !active);
687 688
}
EXPORT_SYMBOL_GPL(rt2x00mac_rfkill_poll);