rt2x00mac.c 19.1 KB
Newer Older
1
/*
2
	Copyright (C) 2004 - 2009 rt2x00 SourceForge Project
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
	rts_info->flags &= ~IEEE80211_TX_CTL_REQ_TX_STATUS;

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

I
Ivo van Doorn 已提交
76 77 78 79 80 81
	skb->do_not_encrypt = 1;

	/*
	 * 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 94
	retval = rt2x00queue_write_tx_frame(queue, skb);
	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
	struct ieee80211_hdr *ieee80211hdr = (struct ieee80211_hdr *)skb->data;
107
	enum data_queue_qid qid = skb_get_queue_mapping(skb);
I
Ivo van Doorn 已提交
108
	struct data_queue *queue;
109 110
	u16 frame_control;

111 112 113 114 115 116
	/*
	 * 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.
	 */
117
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
118
		goto exit_fail;
119

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

	/*
136 137 138
	 * 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.
139 140
	 * Note that when the driver has set the set_rts_threshold()
	 * callback function it doesn't need software generation of
141
	 * either RTS or CTS-to-self frame and handles everything
142
	 * inside the hardware.
143 144
	 */
	frame_control = le16_to_cpu(ieee80211hdr->frame_control);
145 146
	if ((tx_info->control.rates[0].flags & (IEEE80211_TX_RC_USE_RTS_CTS |
						IEEE80211_TX_RC_USE_CTS_PROTECT)) &&
147
	    !rt2x00dev->ops->hw->set_rts_threshold) {
148 149
		if (rt2x00queue_available(queue) <= 1)
			goto exit_fail;
150

151 152
		if (rt2x00mac_tx_rts_cts(rt2x00dev, queue, skb))
			goto exit_fail;
153 154
	}

155 156 157
	if (rt2x00queue_write_tx_frame(queue, skb))
		goto exit_fail;

158
	if (rt2x00queue_threshold(queue))
159
		ieee80211_stop_queue(rt2x00dev->hw, qid);
160 161

	return NETDEV_TX_OK;
162 163 164 165 166

 exit_fail:
	ieee80211_stop_queue(rt2x00dev->hw, qid);
	dev_kfree_skb_any(skb);
	return NETDEV_TX_OK;
167 168 169 170 171 172 173
}
EXPORT_SYMBOL_GPL(rt2x00mac_tx);

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

174
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
175 176
		return 0;

177
	return rt2x00lib_start(rt2x00dev);
178 179 180 181 182 183 184
}
EXPORT_SYMBOL_GPL(rt2x00mac_start);

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

185
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
186 187
		return;

188
	rt2x00lib_stop(rt2x00dev);
189 190 191 192 193 194 195
}
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;
196
	struct rt2x00_intf *intf = vif_to_intf(conf->vif);
197
	struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, QID_BEACON);
198 199
	struct queue_entry *entry = NULL;
	unsigned int i;
200 201

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

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

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

	if (unlikely(i == queue->limit))
262 263
		return -ENOBUFS;

264 265 266 267 268
	/*
	 * We are now absolutely sure the interface can be created,
	 * increase interface count and start initialization.
	 */

269
	if (conf->type == NL80211_IFTYPE_AP)
270 271 272 273 274
		rt2x00dev->intf_ap_count++;
	else
		rt2x00dev->intf_sta_count++;

	spin_lock_init(&intf->lock);
275
	spin_lock_init(&intf->seqlock);
276 277
	intf->beacon = entry;

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

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

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

296 297 298 299 300 301 302 303
	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;
304
	struct rt2x00_intf *intf = vif_to_intf(conf->vif);
305 306

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

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

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

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

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

	/*
343 344
	 * Mac80211 might be calling this function while we are trying
	 * to remove the device or perhaps suspending it.
345
	 */
346
	if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
347 348 349
		return 0;

	/*
350 351 352 353 354
	 * Only change device state when the radio is enabled. It does not
	 * matter what parameters we have configured when the radio is disabled
	 * because we won't be able to send or receive anyway. Also note that
	 * some configuration parameters (e.g. channel and antenna values) can
	 * only be set when the radio is enabled.
355
	 */
356 357 358
	if (conf->radio_enabled) {
		/* For programming the values, we have to turn RX off */
		rt2x00lib_toggle_rx(rt2x00dev, STATE_RADIO_RX_OFF);
359

360 361 362 363
		/* Enable the radio */
		status = rt2x00lib_enable_radio(rt2x00dev);
		if (unlikely(status))
			return status;
364

365 366 367 368
		/*
		 * When we've just turned on the radio, we want to reprogram
		 * everything to ensure a consistent state
		 */
369
		rt2x00lib_config(rt2x00dev, conf, changed);
370

371 372 373 374 375 376 377 378 379 380 381
		/*
		 * The radio was enabled, configure the antenna to the
		 * default settings, the link tuner will later start
		 * continue configuring the antenna based on the software
		 * diversity. But for non-diversity configurations, we need
		 * to have configured the correct state now.
		 */
		if (changed & IEEE80211_CONF_CHANGE_RADIO_ENABLED)
			rt2x00lib_config_antenna(rt2x00dev,
						 &rt2x00dev->default_ant);

382
		/* Turn RX back on */
383
		rt2x00lib_toggle_rx(rt2x00dev, STATE_RADIO_RX_ON);
384 385 386 387
	} else {
		/* Disable the radio */
		rt2x00lib_disable_radio(rt2x00dev);
	}
388 389 390 391 392

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_config);

I
Ivo van Doorn 已提交
393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431
void rt2x00mac_configure_filter(struct ieee80211_hw *hw,
				unsigned int changed_flags,
				unsigned int *total_flags,
				int mc_count, struct dev_addr_list *mc_list)
{
	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 |
	    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;

	/*
	 * Check if there is any work left for us.
	 */
	if (rt2x00dev->packet_filter == *total_flags)
		return;
	rt2x00dev->packet_filter = *total_flags;

	if (!test_bit(DRIVER_REQUIRE_SCHEDULED, &rt2x00dev->flags))
		rt2x00dev->ops->lib->config_filter(rt2x00dev, *total_flags);
432
	else
433
		queue_work(rt2x00dev->hw->workqueue, &rt2x00dev->filter_work);
I
Ivo van Doorn 已提交
434 435 436
}
EXPORT_SYMBOL_GPL(rt2x00mac_configure_filter);

I
Ivo van Doorn 已提交
437
#ifdef CONFIG_RT2X00_LIB_CRYPTO
438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455
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 已提交
456
int rt2x00mac_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
457
		      struct ieee80211_vif *vif, struct ieee80211_sta *sta,
I
Ivo van Doorn 已提交
458 459 460
		      struct ieee80211_key_conf *key)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
461
	struct rt2x00_intf *intf = vif_to_intf(vif);
I
Ivo van Doorn 已提交
462 463 464 465
	int (*set_key) (struct rt2x00_dev *rt2x00dev,
			struct rt2x00lib_crypto *crypto,
			struct ieee80211_key_conf *key);
	struct rt2x00lib_crypto crypto;
466 467
	static const u8 bcast_addr[ETH_ALEN] =
		{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, };
I
Ivo van Doorn 已提交
468

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

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

	crypto.cmd = cmd;
492 493 494 495 496 497 498

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

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

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

536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557
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;

558
	for (i = 0; i < rt2x00dev->ops->tx_queues; i++) {
559 560 561
		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 已提交
562
	}
563 564 565 566 567

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_get_tx_stats);

568 569 570 571
void rt2x00mac_bss_info_changed(struct ieee80211_hw *hw,
				struct ieee80211_vif *vif,
				struct ieee80211_bss_conf *bss_conf,
				u32 changes)
572 573
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
574
	struct rt2x00_intf *intf = vif_to_intf(vif);
I
Ivo van Doorn 已提交
575
	unsigned int delayed = 0;
576 577 578 579 580 581 582 583 584 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
	int update_bssid = 0;

	/*
	 * Mac80211 might be calling this function while we are trying
	 * 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);
614 615

	/*
616 617 618 619
	 * 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.
620
	 */
621 622
	if (changes & BSS_CHANGED_ASSOC) {
		rt2x00dev->link.count = 0;
623

624 625 626 627
		if (bss_conf->assoc)
			rt2x00dev->intf_associated++;
		else
			rt2x00dev->intf_associated--;
628 629 630 631 632 633

		if (!test_bit(DRIVER_REQUIRE_SCHEDULED, &rt2x00dev->flags))
			rt2x00leds_led_assoc(rt2x00dev,
					     !!rt2x00dev->intf_associated);
		else
			delayed |= DELAYED_LED_ASSOC;
634
	}
635

636
	/*
637 638
	 * When the erp information has changed, we should perform
	 * additional configuration steps. For all other changes we are done.
639
	 */
640
	if (changes & ~(BSS_CHANGED_ASSOC | BSS_CHANGED_HT)) {
I
Ivo van Doorn 已提交
641 642 643 644 645
		if (!test_bit(DRIVER_REQUIRE_SCHEDULED, &rt2x00dev->flags))
			rt2x00lib_config_erp(rt2x00dev, intf, bss_conf);
		else
			delayed |= DELAYED_CONFIG_ERP;
	}
646

647
	spin_lock(&intf->lock);
I
Ivo van Doorn 已提交
648 649
	if (delayed) {
		intf->delayed_flags |= delayed;
650
		schedule_work(&rt2x00dev->intf_work);
I
Ivo van Doorn 已提交
651
	}
652
	spin_unlock(&intf->lock);
653
}
654
EXPORT_SYMBOL_GPL(rt2x00mac_bss_info_changed);
655

J
Johannes Berg 已提交
656
int rt2x00mac_conf_tx(struct ieee80211_hw *hw, u16 queue_idx,
657 658 659
		      const struct ieee80211_tx_queue_params *params)
{
	struct rt2x00_dev *rt2x00dev = hw->priv;
I
Ivo van Doorn 已提交
660
	struct data_queue *queue;
661

I
Ivo van Doorn 已提交
662 663
	queue = rt2x00queue_get_queue(rt2x00dev, queue_idx);
	if (unlikely(!queue))
664 665 666 667 668 669
		return -EINVAL;

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

675
	if (params->cw_max > 0)
I
Ivo van Doorn 已提交
676
		queue->cw_max = fls(params->cw_max);
677
	else
I
Ivo van Doorn 已提交
678
		queue->cw_max = 10; /* cw_min: 2^10 = 1024. */
679

680
	queue->aifs = params->aifs;
681
	queue->txop = params->txop;
682 683

	INFO(rt2x00dev,
684 685
	     "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);
686 687 688 689

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00mac_conf_tx);