main.c 54.8 KB
Newer Older
1
/*
2
 * Copyright (c) 2008-2009 Atheros Communications Inc.
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include <linux/nl80211.h>
S
Sujith 已提交
18
#include "ath9k.h"
19
#include "btcoex.h"
20

S
Sujith 已提交
21 22
static void ath_update_txpow(struct ath_softc *sc)
{
23
	struct ath_hw *ah = sc->sc_ah;
S
Sujith 已提交
24

S
Sujith 已提交
25
	if (sc->curtxpow != sc->config.txpowlimit) {
26
		ath9k_hw_set_txpowerlimit(ah, sc->config.txpowlimit, false);
S
Sujith 已提交
27
		/* read back in case value is clamped */
F
Felix Fietkau 已提交
28
		sc->curtxpow = ath9k_hw_regulatory(ah)->power_limit;
S
Sujith 已提交
29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
	}
}

static u8 parse_mpdudensity(u8 mpdudensity)
{
	/*
	 * 802.11n D2.0 defined values for "Minimum MPDU Start Spacing":
	 *   0 for no restriction
	 *   1 for 1/4 us
	 *   2 for 1/2 us
	 *   3 for 1 us
	 *   4 for 2 us
	 *   5 for 4 us
	 *   6 for 8 us
	 *   7 for 16 us
	 */
	switch (mpdudensity) {
	case 0:
		return 0;
	case 1:
	case 2:
	case 3:
		/* Our lower layer calculations limit our precision to
		   1 microsecond */
		return 1;
	case 4:
		return 2;
	case 5:
		return 4;
	case 6:
		return 8;
	case 7:
		return 16;
	default:
		return 0;
	}
}

67 68 69 70 71 72 73 74 75 76 77 78 79
static struct ath9k_channel *ath_get_curchannel(struct ath_softc *sc,
						struct ieee80211_hw *hw)
{
	struct ieee80211_channel *curchan = hw->conf.channel;
	struct ath9k_channel *channel;
	u8 chan_idx;

	chan_idx = curchan->hw_value;
	channel = &sc->sc_ah->channels[chan_idx];
	ath9k_update_ichannel(sc, hw, channel);
	return channel;
}

S
Sujith 已提交
80
bool ath9k_setpower(struct ath_softc *sc, enum ath9k_power_mode mode)
81 82 83 84
{
	unsigned long flags;
	bool ret;

85 86 87
	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	ret = ath9k_hw_setpower(sc->sc_ah, mode);
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
88 89 90 91

	return ret;
}

92 93
void ath9k_ps_wakeup(struct ath_softc *sc)
{
94
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
95
	unsigned long flags;
96
	enum ath9k_power_mode power_mode;
97 98 99 100 101

	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	if (++sc->ps_usecount != 1)
		goto unlock;

102
	power_mode = sc->sc_ah->power_mode;
103
	ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
104

105 106 107 108 109
	/*
	 * While the hardware is asleep, the cycle counters contain no
	 * useful data. Better clear them now so that they don't mess up
	 * survey data results.
	 */
110 111 112 113 114 115
	if (power_mode != ATH9K_PM_AWAKE) {
		spin_lock(&common->cc_lock);
		ath_hw_cycle_counters_update(common);
		memset(&common->cc_survey, 0, sizeof(common->cc_survey));
		spin_unlock(&common->cc_lock);
	}
116

117 118 119 120 121 122
 unlock:
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
}

void ath9k_ps_restore(struct ath_softc *sc)
{
123
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
124 125 126 127 128 129
	unsigned long flags;

	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	if (--sc->ps_usecount != 0)
		goto unlock;

130 131 132 133
	spin_lock(&common->cc_lock);
	ath_hw_cycle_counters_update(common);
	spin_unlock(&common->cc_lock);

134 135 136 137
	if (sc->ps_idle)
		ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_FULL_SLEEP);
	else if (sc->ps_enabled &&
		 !(sc->ps_flags & (PS_WAIT_FOR_BEACON |
S
Sujith 已提交
138 139 140
			      PS_WAIT_FOR_CAB |
			      PS_WAIT_FOR_PSPOLL_DATA |
			      PS_WAIT_FOR_TX_ACK)))
141
		ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_NETWORK_SLEEP);
142 143 144 145 146

 unlock:
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
}

147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167
static void ath_start_ani(struct ath_common *common)
{
	struct ath_hw *ah = common->ah;
	unsigned long timestamp = jiffies_to_msecs(jiffies);
	struct ath_softc *sc = (struct ath_softc *) common->priv;

	if (!(sc->sc_flags & SC_OP_ANI_RUN))
		return;

	if (sc->sc_flags & SC_OP_OFFCHANNEL)
		return;

	common->ani.longcal_timer = timestamp;
	common->ani.shortcal_timer = timestamp;
	common->ani.checkani_timer = timestamp;

	mod_timer(&common->ani.timer,
		  jiffies +
			msecs_to_jiffies((u32)ah->config.ani_poll_interval));
}

168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188
static void ath_update_survey_nf(struct ath_softc *sc, int channel)
{
	struct ath_hw *ah = sc->sc_ah;
	struct ath9k_channel *chan = &ah->channels[channel];
	struct survey_info *survey = &sc->survey[channel];

	if (chan->noisefloor) {
		survey->filled |= SURVEY_INFO_NOISE_DBM;
		survey->noise = chan->noisefloor;
	}
}

static void ath_update_survey_stats(struct ath_softc *sc)
{
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	int pos = ah->curchan - &ah->channels[0];
	struct survey_info *survey = &sc->survey[pos];
	struct ath_cycle_counters *cc = &common->cc_survey;
	unsigned int div = common->clockrate * 1000;

189 190 191
	if (!ah->curchan)
		return;

192 193
	if (ah->power_mode == ATH9K_PM_AWAKE)
		ath_hw_cycle_counters_update(common);
194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209

	if (cc->cycles > 0) {
		survey->filled |= SURVEY_INFO_CHANNEL_TIME |
			SURVEY_INFO_CHANNEL_TIME_BUSY |
			SURVEY_INFO_CHANNEL_TIME_RX |
			SURVEY_INFO_CHANNEL_TIME_TX;
		survey->channel_time += cc->cycles / div;
		survey->channel_time_busy += cc->rx_busy / div;
		survey->channel_time_rx += cc->rx_frame / div;
		survey->channel_time_tx += cc->tx_frame / div;
	}
	memset(cc, 0, sizeof(*cc));

	ath_update_survey_nf(sc, pos);
}

S
Sujith 已提交
210 211 212 213 214
/*
 * Set/change channels.  If the channel is really being changed, it's done
 * by reseting the chip.  To accomplish this we must first cleanup any pending
 * DMA, then restart stuff.
*/
215 216
int ath_set_channel(struct ath_softc *sc, struct ieee80211_hw *hw,
		    struct ath9k_channel *hchan)
S
Sujith 已提交
217
{
218
	struct ath_wiphy *aphy = hw->priv;
219
	struct ath_hw *ah = sc->sc_ah;
220
	struct ath_common *common = ath9k_hw_common(ah);
L
Luis R. Rodriguez 已提交
221
	struct ieee80211_conf *conf = &common->hw->conf;
S
Sujith 已提交
222
	bool fastcc = true, stopped;
223
	struct ieee80211_channel *channel = hw->conf.channel;
224
	struct ath9k_hw_cal_data *caldata = NULL;
225
	int r;
S
Sujith 已提交
226 227 228 229

	if (sc->sc_flags & SC_OP_INVALID)
		return -EIO;

230 231 232 233 234
	del_timer_sync(&common->ani.timer);
	cancel_work_sync(&sc->paprd_work);
	cancel_work_sync(&sc->hw_check_work);
	cancel_delayed_work_sync(&sc->tx_complete_work);

235 236
	ath9k_ps_wakeup(sc);

237 238
	spin_lock_bh(&sc->sc_pcu_lock);

239 240 241 242 243 244 245 246 247
	/*
	 * This is only performed if the channel settings have
	 * actually changed.
	 *
	 * To switch channels clear any pending DMA operations;
	 * wait long enough for the RX fifo to drain, reset the
	 * hardware at the new frequency, and then re-enable
	 * the relevant bits of the h/w.
	 */
248
	ath9k_hw_disable_interrupts(ah);
249
	stopped = ath_drain_all_txq(sc, false);
250

251 252
	if (!ath_stoprecv(sc))
		stopped = false;
S
Sujith 已提交
253

254 255 256
	/* XXX: do not flush receive queue here. We don't want
	 * to flush data frames already in queue because of
	 * changing channel. */
S
Sujith 已提交
257

258
	if (!stopped || !(sc->sc_flags & SC_OP_OFFCHANNEL))
259 260
		fastcc = false;

261 262 263
	if (!(sc->sc_flags & SC_OP_OFFCHANNEL))
		caldata = &aphy->caldata;

J
Joe Perches 已提交
264 265 266 267 268
	ath_dbg(common, ATH_DBG_CONFIG,
		"(%u MHz) -> (%u MHz), conf_is_ht40: %d fastcc: %d\n",
		sc->sc_ah->curchan->channel,
		channel->center_freq, conf_is_ht40(conf),
		fastcc);
S
Sujith 已提交
269

270
	r = ath9k_hw_reset(ah, hchan, caldata, fastcc);
271
	if (r) {
272 273 274
		ath_err(common,
			"Unable to reset channel (%u MHz), reset status %d\n",
			channel->center_freq, r);
275
		goto ps_restore;
S
Sujith 已提交
276
	}
277 278

	if (ath_startrecv(sc) != 0) {
279
		ath_err(common, "Unable to restart recv logic\n");
280 281
		r = -EIO;
		goto ps_restore;
282 283 284
	}

	ath_update_txpow(sc);
P
Pavel Roskin 已提交
285
	ath9k_hw_set_interrupts(ah, ah->imask);
286

287 288
	if (!(sc->sc_flags & (SC_OP_OFFCHANNEL))) {
		ath_beacon_config(sc, NULL);
289
		ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
290
		ath_start_ani(common);
291 292
	}

293
 ps_restore:
294 295
	spin_unlock_bh(&sc->sc_pcu_lock);

296
	ath9k_ps_restore(sc);
297
	return r;
S
Sujith 已提交
298 299
}

300 301 302
static void ath_paprd_activate(struct ath_softc *sc)
{
	struct ath_hw *ah = sc->sc_ah;
303
	struct ath9k_hw_cal_data *caldata = ah->caldata;
304
	struct ath_common *common = ath9k_hw_common(ah);
305 306
	int chain;

307
	if (!caldata || !caldata->paprd_done)
308 309 310
		return;

	ath9k_ps_wakeup(sc);
311
	ar9003_paprd_enable(ah, false);
312
	for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
313
		if (!(common->tx_chainmask & BIT(chain)))
314 315
			continue;

316
		ar9003_paprd_populate_single_table(ah, caldata, chain);
317 318 319 320 321 322
	}

	ar9003_paprd_enable(ah, true);
	ath9k_ps_restore(sc);
}

323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358
static bool ath_paprd_send_frame(struct ath_softc *sc, struct sk_buff *skb, int chain)
{
	struct ieee80211_hw *hw = sc->hw;
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
	struct ath_tx_control txctl;
	int time_left;

	memset(&txctl, 0, sizeof(txctl));
	txctl.txq = sc->tx.txq_map[WME_AC_BE];

	memset(tx_info, 0, sizeof(*tx_info));
	tx_info->band = hw->conf.channel->band;
	tx_info->flags |= IEEE80211_TX_CTL_NO_ACK;
	tx_info->control.rates[0].idx = 0;
	tx_info->control.rates[0].count = 1;
	tx_info->control.rates[0].flags = IEEE80211_TX_RC_MCS;
	tx_info->control.rates[1].idx = -1;

	init_completion(&sc->paprd_complete);
	sc->paprd_pending = true;
	txctl.paprd = BIT(chain);
	if (ath_tx_start(hw, skb, &txctl) != 0)
		return false;

	time_left = wait_for_completion_timeout(&sc->paprd_complete,
			msecs_to_jiffies(ATH_PAPRD_TIMEOUT));
	sc->paprd_pending = false;

	if (!time_left)
		ath_dbg(ath9k_hw_common(sc->sc_ah), ATH_DBG_CALIBRATE,
			"Timeout waiting for paprd training on TX chain %d\n",
			chain);

	return !!time_left;
}

359 360 361 362 363 364 365
void ath_paprd_calibrate(struct work_struct *work)
{
	struct ath_softc *sc = container_of(work, struct ath_softc, paprd_work);
	struct ieee80211_hw *hw = sc->hw;
	struct ath_hw *ah = sc->sc_ah;
	struct ieee80211_hdr *hdr;
	struct sk_buff *skb = NULL;
366
	struct ath9k_hw_cal_data *caldata = ah->caldata;
367
	struct ath_common *common = ath9k_hw_common(ah);
368
	int ftype;
369 370 371 372
	int chain_ok = 0;
	int chain;
	int len = 1800;

373 374 375
	if (!caldata)
		return;

376 377 378 379 380 381 382 383 384
	skb = alloc_skb(len, GFP_KERNEL);
	if (!skb)
		return;

	skb_put(skb, len);
	memset(skb->data, 0, len);
	hdr = (struct ieee80211_hdr *)skb->data;
	ftype = IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC;
	hdr->frame_control = cpu_to_le16(ftype);
385
	hdr->duration_id = cpu_to_le16(10);
386 387 388 389
	memcpy(hdr->addr1, hw->wiphy->perm_addr, ETH_ALEN);
	memcpy(hdr->addr2, hw->wiphy->perm_addr, ETH_ALEN);
	memcpy(hdr->addr3, hw->wiphy->perm_addr, ETH_ALEN);

390
	ath9k_ps_wakeup(sc);
391 392
	ar9003_paprd_init_table(ah);
	for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
393
		if (!(common->tx_chainmask & BIT(chain)))
394 395 396 397
			continue;

		chain_ok = 0;

398 399 400 401 402
		ath_dbg(common, ATH_DBG_CALIBRATE,
			"Sending PAPRD frame for thermal measurement "
			"on chain %d\n", chain);
		if (!ath_paprd_send_frame(sc, skb, chain))
			goto fail_paprd;
403 404 405

		ar9003_paprd_setup_gain_table(ah, chain);

406 407 408
		ath_dbg(common, ATH_DBG_CALIBRATE,
			"Sending PAPRD training frame on chain %d\n", chain);
		if (!ath_paprd_send_frame(sc, skb, chain))
409
			goto fail_paprd;
410 411 412 413

		if (!ar9003_paprd_is_done(ah))
			break;

414
		if (ar9003_paprd_create_curve(ah, caldata, chain) != 0)
415 416 417 418 419 420 421
			break;

		chain_ok = 1;
	}
	kfree_skb(skb);

	if (chain_ok) {
422
		caldata->paprd_done = true;
423 424 425
		ath_paprd_activate(sc);
	}

426
fail_paprd:
427 428 429
	ath9k_ps_restore(sc);
}

S
Sujith 已提交
430 431 432 433 434 435 436
/*
 *  This routine performs the periodic noise floor calibration function
 *  that is used to adjust and optimize the chip performance.  This
 *  takes environmental changes (location, temperature) into account.
 *  When the task is complete, it reschedules itself depending on the
 *  appropriate interval that was calculated.
 */
S
Sujith 已提交
437
void ath_ani_calibrate(unsigned long data)
S
Sujith 已提交
438
{
439 440
	struct ath_softc *sc = (struct ath_softc *)data;
	struct ath_hw *ah = sc->sc_ah;
441
	struct ath_common *common = ath9k_hw_common(ah);
S
Sujith 已提交
442 443 444 445
	bool longcal = false;
	bool shortcal = false;
	bool aniflag = false;
	unsigned int timestamp = jiffies_to_msecs(jiffies);
446
	u32 cal_interval, short_cal_interval, long_cal_interval;
447
	unsigned long flags;
448 449 450 451 452

	if (ah->caldata && ah->caldata->nfcal_interference)
		long_cal_interval = ATH_LONG_CALINTERVAL_INT;
	else
		long_cal_interval = ATH_LONG_CALINTERVAL;
S
Sujith 已提交
453

454 455
	short_cal_interval = (ah->opmode == NL80211_IFTYPE_AP) ?
		ATH_AP_SHORT_CALINTERVAL : ATH_STA_SHORT_CALINTERVAL;
S
Sujith 已提交
456

457 458 459 460 461 462
	/* Only calibrate if awake */
	if (sc->sc_ah->power_mode != ATH9K_PM_AWAKE)
		goto set_timer;

	ath9k_ps_wakeup(sc);

S
Sujith 已提交
463
	/* Long calibration runs independently of short calibration. */
464
	if ((timestamp - common->ani.longcal_timer) >= long_cal_interval) {
S
Sujith 已提交
465
		longcal = true;
J
Joe Perches 已提交
466
		ath_dbg(common, ATH_DBG_ANI, "longcal @%lu\n", jiffies);
467
		common->ani.longcal_timer = timestamp;
S
Sujith 已提交
468 469
	}

S
Sujith 已提交
470
	/* Short calibration applies only while caldone is false */
471 472
	if (!common->ani.caldone) {
		if ((timestamp - common->ani.shortcal_timer) >= short_cal_interval) {
S
Sujith 已提交
473
			shortcal = true;
J
Joe Perches 已提交
474 475
			ath_dbg(common, ATH_DBG_ANI,
				"shortcal @%lu\n", jiffies);
476 477
			common->ani.shortcal_timer = timestamp;
			common->ani.resetcal_timer = timestamp;
S
Sujith 已提交
478 479
		}
	} else {
480
		if ((timestamp - common->ani.resetcal_timer) >=
S
Sujith 已提交
481
		    ATH_RESTART_CALINTERVAL) {
482 483 484
			common->ani.caldone = ath9k_hw_reset_calvalid(ah);
			if (common->ani.caldone)
				common->ani.resetcal_timer = timestamp;
S
Sujith 已提交
485 486 487 488
		}
	}

	/* Verify whether we must check ANI */
489 490
	if ((timestamp - common->ani.checkani_timer) >=
	     ah->config.ani_poll_interval) {
S
Sujith 已提交
491
		aniflag = true;
492
		common->ani.checkani_timer = timestamp;
S
Sujith 已提交
493 494 495 496 497
	}

	/* Skip all processing if there's nothing to do. */
	if (longcal || shortcal || aniflag) {
		/* Call ANI routine if necessary */
498 499
		if (aniflag) {
			spin_lock_irqsave(&common->cc_lock, flags);
500
			ath9k_hw_ani_monitor(ah, ah->curchan);
501
			ath_update_survey_stats(sc);
502 503
			spin_unlock_irqrestore(&common->cc_lock, flags);
		}
S
Sujith 已提交
504 505 506

		/* Perform calibration if necessary */
		if (longcal || shortcal) {
507
			common->ani.caldone =
508 509 510 511
				ath9k_hw_calibrate(ah,
						   ah->curchan,
						   common->rx_chainmask,
						   longcal);
S
Sujith 已提交
512 513 514
		}
	}

515 516
	ath9k_ps_restore(sc);

517
set_timer:
S
Sujith 已提交
518 519 520 521 522
	/*
	* Set timer interval based on previous results.
	* The interval must be the shortest necessary to satisfy ANI,
	* short calibration and long calibration.
	*/
523
	cal_interval = ATH_LONG_CALINTERVAL;
524
	if (sc->sc_ah->config.enable_ani)
525 526
		cal_interval = min(cal_interval,
				   (u32)ah->config.ani_poll_interval);
527
	if (!common->ani.caldone)
528
		cal_interval = min(cal_interval, (u32)short_cal_interval);
S
Sujith 已提交
529

530
	mod_timer(&common->ani.timer, jiffies + msecs_to_jiffies(cal_interval));
531 532
	if ((sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_PAPRD) && ah->caldata) {
		if (!ah->caldata->paprd_done)
533 534 535 536
			ieee80211_queue_work(sc->hw, &sc->paprd_work);
		else
			ath_paprd_activate(sc);
	}
S
Sujith 已提交
537 538 539 540 541
}

/*
 * Update tx/rx chainmask. For legacy association,
 * hard code chainmask to 1x1, for 11n association, use
542 543
 * the chainmask configuration, for bt coexistence, use
 * the chainmask configuration even in legacy mode.
S
Sujith 已提交
544
 */
545
void ath_update_chainmask(struct ath_softc *sc, int is_ht)
S
Sujith 已提交
546
{
547
	struct ath_hw *ah = sc->sc_ah;
548
	struct ath_common *common = ath9k_hw_common(ah);
549

550
	if ((sc->sc_flags & SC_OP_OFFCHANNEL) || is_ht ||
551
	    (ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE)) {
552 553
		common->tx_chainmask = ah->caps.tx_chainmask;
		common->rx_chainmask = ah->caps.rx_chainmask;
S
Sujith 已提交
554
	} else {
555 556
		common->tx_chainmask = 1;
		common->rx_chainmask = 1;
S
Sujith 已提交
557 558
	}

J
Joe Perches 已提交
559 560 561 562
	ath_dbg(common, ATH_DBG_CONFIG,
		"tx chmask: %d, rx chmask: %d\n",
		common->tx_chainmask,
		common->rx_chainmask);
S
Sujith 已提交
563 564 565 566 567
}

static void ath_node_attach(struct ath_softc *sc, struct ieee80211_sta *sta)
{
	struct ath_node *an;
568
	struct ath_hw *ah = sc->sc_ah;
S
Sujith 已提交
569 570
	an = (struct ath_node *)sta->drv_priv;

571 572 573
	if ((ah->caps.hw_caps) & ATH9K_HW_CAP_APM)
		sc->sc_flags |= SC_OP_ENABLE_APM;

574
	if (sc->sc_flags & SC_OP_TXAGGR) {
S
Sujith 已提交
575
		ath_tx_node_init(sc, an);
S
Sujith 已提交
576
		an->maxampdu = 1 << (IEEE80211_HT_MAX_AMPDU_FACTOR +
577 578 579
				     sta->ht_cap.ampdu_factor);
		an->mpdudensity = parse_mpdudensity(sta->ht_cap.ampdu_density);
	}
S
Sujith 已提交
580 581 582 583 584 585 586 587 588 589
}

static void ath_node_detach(struct ath_softc *sc, struct ieee80211_sta *sta)
{
	struct ath_node *an = (struct ath_node *)sta->drv_priv;

	if (sc->sc_flags & SC_OP_TXAGGR)
		ath_tx_node_cleanup(sc, an);
}

590 591 592 593 594 595 596 597 598 599 600 601 602
void ath_hw_check(struct work_struct *work)
{
	struct ath_softc *sc = container_of(work, struct ath_softc, hw_check_work);
	int i;

	ath9k_ps_wakeup(sc);

	for (i = 0; i < 3; i++) {
		if (ath9k_hw_check_alive(sc->sc_ah))
			goto out;

		msleep(1);
	}
603
	ath_reset(sc, true);
604 605 606 607 608

out:
	ath9k_ps_restore(sc);
}

S
Sujith 已提交
609
void ath9k_tasklet(unsigned long data)
S
Sujith 已提交
610 611
{
	struct ath_softc *sc = (struct ath_softc *)data;
612
	struct ath_hw *ah = sc->sc_ah;
613
	struct ath_common *common = ath9k_hw_common(ah);
614

S
Sujith 已提交
615
	u32 status = sc->intrstatus;
F
Felix Fietkau 已提交
616
	u32 rxmask;
S
Sujith 已提交
617

618 619
	ath9k_ps_wakeup(sc);

620
	if (status & ATH9K_INT_FATAL) {
621
		ath_reset(sc, true);
622
		ath9k_ps_restore(sc);
S
Sujith 已提交
623
		return;
S
Sujith 已提交
624
	}
S
Sujith 已提交
625

626 627
	spin_lock_bh(&sc->sc_pcu_lock);

628 629 630
	if (!ath9k_hw_check_alive(ah))
		ieee80211_queue_work(sc->hw, &sc->hw_check_work);

F
Felix Fietkau 已提交
631 632 633 634 635 636 637 638 639 640 641 642 643
	if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
		rxmask = (ATH9K_INT_RXHP | ATH9K_INT_RXLP | ATH9K_INT_RXEOL |
			  ATH9K_INT_RXORN);
	else
		rxmask = (ATH9K_INT_RX | ATH9K_INT_RXEOL | ATH9K_INT_RXORN);

	if (status & rxmask) {
		/* Check for high priority Rx first */
		if ((ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) &&
		    (status & ATH9K_INT_RXHP))
			ath_rx_tasklet(sc, 0, true);

		ath_rx_tasklet(sc, 0, false);
S
Sujith 已提交
644 645
	}

646 647 648 649 650 651
	if (status & ATH9K_INT_TX) {
		if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
			ath_tx_edma_tasklet(sc);
		else
			ath_tx_tasklet(sc);
	}
S
Sujith 已提交
652

653
	if ((status & ATH9K_INT_TSFOOR) && sc->ps_enabled) {
654 655 656 657
		/*
		 * TSF sync does not look correct; remain awake to sync with
		 * the next Beacon.
		 */
J
Joe Perches 已提交
658 659
		ath_dbg(common, ATH_DBG_PS,
			"TSFOOR - Sync with next Beacon\n");
S
Sujith 已提交
660
		sc->ps_flags |= PS_WAIT_FOR_BEACON | PS_BEACON_SYNC;
661 662
	}

663
	if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
664 665 666
		if (status & ATH9K_INT_GENTIMER)
			ath_gen_timer_isr(sc->sc_ah);

S
Sujith 已提交
667
	/* re-enable hardware interrupt */
668
	ath9k_hw_enable_interrupts(ah);
669 670

	spin_unlock_bh(&sc->sc_pcu_lock);
671
	ath9k_ps_restore(sc);
S
Sujith 已提交
672 673
}

674
irqreturn_t ath_isr(int irq, void *dev)
S
Sujith 已提交
675
{
S
Sujith 已提交
676 677 678 679 680
#define SCHED_INTR (				\
		ATH9K_INT_FATAL |		\
		ATH9K_INT_RXORN |		\
		ATH9K_INT_RXEOL |		\
		ATH9K_INT_RX |			\
F
Felix Fietkau 已提交
681 682
		ATH9K_INT_RXLP |		\
		ATH9K_INT_RXHP |		\
S
Sujith 已提交
683 684 685
		ATH9K_INT_TX |			\
		ATH9K_INT_BMISS |		\
		ATH9K_INT_CST |			\
686 687
		ATH9K_INT_TSFOOR |		\
		ATH9K_INT_GENTIMER)
S
Sujith 已提交
688

S
Sujith 已提交
689
	struct ath_softc *sc = dev;
690
	struct ath_hw *ah = sc->sc_ah;
691
	struct ath_common *common = ath9k_hw_common(ah);
S
Sujith 已提交
692 693 694
	enum ath9k_int status;
	bool sched = false;

S
Sujith 已提交
695 696 697 698 699 700 701
	/*
	 * The hardware is not ready/present, don't
	 * touch anything. Note this can happen early
	 * on if the IRQ is shared.
	 */
	if (sc->sc_flags & SC_OP_INVALID)
		return IRQ_NONE;
S
Sujith 已提交
702

S
Sujith 已提交
703 704 705

	/* shared irq, not for us */

706
	if (!ath9k_hw_intrpend(ah))
S
Sujith 已提交
707 708 709 710 711 712 713 714 715
		return IRQ_NONE;

	/*
	 * Figure out the reason(s) for the interrupt.  Note
	 * that the hal returns a pseudo-ISR that may include
	 * bits we haven't explicitly enabled so we mask the
	 * value to insure we only process bits we requested.
	 */
	ath9k_hw_getisr(ah, &status);	/* NB: clears ISR too */
P
Pavel Roskin 已提交
716
	status &= ah->imask;	/* discard unasked-for bits */
S
Sujith 已提交
717

S
Sujith 已提交
718 719 720 721
	/*
	 * If there are no status bits set, then this interrupt was not
	 * for me (should have been caught above).
	 */
722
	if (!status)
S
Sujith 已提交
723
		return IRQ_NONE;
S
Sujith 已提交
724

S
Sujith 已提交
725 726 727 728 729 730 731 732 733 734
	/* Cache the status */
	sc->intrstatus = status;

	if (status & SCHED_INTR)
		sched = true;

	/*
	 * If a FATAL or RXORN interrupt is received, we have to reset the
	 * chip immediately.
	 */
F
Felix Fietkau 已提交
735 736
	if ((status & ATH9K_INT_FATAL) || ((status & ATH9K_INT_RXORN) &&
	    !(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)))
S
Sujith 已提交
737 738
		goto chip_reset;

739 740
	if ((ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) &&
	    (status & ATH9K_INT_BB_WATCHDOG)) {
741 742 743

		spin_lock(&common->cc_lock);
		ath_hw_cycle_counters_update(common);
744
		ar9003_hw_bb_watchdog_dbg_info(ah);
745 746
		spin_unlock(&common->cc_lock);

747 748 749
		goto chip_reset;
	}

S
Sujith 已提交
750 751 752 753 754 755
	if (status & ATH9K_INT_SWBA)
		tasklet_schedule(&sc->bcon_tasklet);

	if (status & ATH9K_INT_TXURN)
		ath9k_hw_updatetxtriglevel(ah, true);

F
Felix Fietkau 已提交
756 757 758 759 760 761 762
	if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
		if (status & ATH9K_INT_RXEOL) {
			ah->imask &= ~(ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
			ath9k_hw_set_interrupts(ah, ah->imask);
		}
	}

S
Sujith 已提交
763
	if (status & ATH9K_INT_MIB) {
S
Sujith 已提交
764
		/*
S
Sujith 已提交
765 766 767
		 * Disable interrupts until we service the MIB
		 * interrupt; otherwise it will continue to
		 * fire.
S
Sujith 已提交
768
		 */
769
		ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
770 771 772 773 774
		/*
		 * Let the hal handle the event. We assume
		 * it will clear whatever condition caused
		 * the interrupt.
		 */
775
		spin_lock(&common->cc_lock);
776
		ath9k_hw_proc_mib_event(ah);
777
		spin_unlock(&common->cc_lock);
778
		ath9k_hw_enable_interrupts(ah);
S
Sujith 已提交
779
	}
S
Sujith 已提交
780

781 782
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
		if (status & ATH9K_INT_TIM_TIMER) {
783 784
			if (ATH_DBG_WARN_ON_ONCE(sc->ps_idle))
				goto chip_reset;
S
Sujith 已提交
785 786
			/* Clear RxAbort bit so that we can
			 * receive frames */
787
			ath9k_setpower(sc, ATH9K_PM_AWAKE);
788
			ath9k_hw_setrxabort(sc->sc_ah, 0);
S
Sujith 已提交
789
			sc->ps_flags |= PS_WAIT_FOR_BEACON;
S
Sujith 已提交
790
		}
S
Sujith 已提交
791 792

chip_reset:
S
Sujith 已提交
793

794 795
	ath_debug_stat_interrupt(sc, status);

S
Sujith 已提交
796
	if (sched) {
797 798
		/* turn off every interrupt */
		ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
799 800 801 802
		tasklet_schedule(&sc->intr_tq);
	}

	return IRQ_HANDLED;
S
Sujith 已提交
803 804

#undef SCHED_INTR
S
Sujith 已提交
805 806
}

807
static u32 ath_get_extchanmode(struct ath_softc *sc,
808
			       struct ieee80211_channel *chan,
S
Sujith 已提交
809
			       enum nl80211_channel_type channel_type)
810 811 812 813 814
{
	u32 chanmode = 0;

	switch (chan->band) {
	case IEEE80211_BAND_2GHZ:
S
Sujith 已提交
815 816 817
		switch(channel_type) {
		case NL80211_CHAN_NO_HT:
		case NL80211_CHAN_HT20:
818
			chanmode = CHANNEL_G_HT20;
S
Sujith 已提交
819 820
			break;
		case NL80211_CHAN_HT40PLUS:
821
			chanmode = CHANNEL_G_HT40PLUS;
S
Sujith 已提交
822 823
			break;
		case NL80211_CHAN_HT40MINUS:
824
			chanmode = CHANNEL_G_HT40MINUS;
S
Sujith 已提交
825 826
			break;
		}
827 828
		break;
	case IEEE80211_BAND_5GHZ:
S
Sujith 已提交
829 830 831
		switch(channel_type) {
		case NL80211_CHAN_NO_HT:
		case NL80211_CHAN_HT20:
832
			chanmode = CHANNEL_A_HT20;
S
Sujith 已提交
833 834
			break;
		case NL80211_CHAN_HT40PLUS:
835
			chanmode = CHANNEL_A_HT40PLUS;
S
Sujith 已提交
836 837
			break;
		case NL80211_CHAN_HT40MINUS:
838
			chanmode = CHANNEL_A_HT40MINUS;
S
Sujith 已提交
839 840
			break;
		}
841 842 843 844 845 846 847 848
		break;
	default:
		break;
	}

	return chanmode;
}

849
static void ath9k_bss_assoc_info(struct ath_softc *sc,
850
				 struct ieee80211_hw *hw,
S
Sujith 已提交
851
				 struct ieee80211_vif *vif,
852
				 struct ieee80211_bss_conf *bss_conf)
853
{
854
	struct ath_wiphy *aphy = hw->priv;
855
	struct ath_hw *ah = sc->sc_ah;
856
	struct ath_common *common = ath9k_hw_common(ah);
857

858
	if (bss_conf->assoc) {
J
Joe Perches 已提交
859 860 861
		ath_dbg(common, ATH_DBG_CONFIG,
			"Bss Info ASSOC %d, bssid: %pM\n",
			bss_conf->aid, common->curbssid);
862

863
		/* New association, store aid */
864
		common->curaid = bss_conf->aid;
865
		ath9k_hw_write_associd(ah);
866 867 868 869 870 871

		/*
		 * Request a re-configuration of Beacon related timers
		 * on the receipt of the first Beacon frame (i.e.,
		 * after time sync with the AP).
		 */
S
Sujith 已提交
872
		sc->ps_flags |= PS_BEACON_SYNC;
873

874
		/* Configure the beacon */
875
		ath_beacon_config(sc, vif);
876

877
		/* Reset rssi stats */
878
		aphy->last_rssi = ATH_RSSI_DUMMY_MARKER;
879
		sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
880

881
		sc->sc_flags |= SC_OP_ANI_RUN;
882
		ath_start_ani(common);
883
	} else {
J
Joe Perches 已提交
884
		ath_dbg(common, ATH_DBG_CONFIG, "Bss Info DISASSOC\n");
885
		common->curaid = 0;
886
		/* Stop ANI */
887
		sc->sc_flags &= ~SC_OP_ANI_RUN;
888
		del_timer_sync(&common->ani.timer);
889
	}
890
}
891

892
void ath_radio_enable(struct ath_softc *sc, struct ieee80211_hw *hw)
893
{
894
	struct ath_hw *ah = sc->sc_ah;
895
	struct ath_common *common = ath9k_hw_common(ah);
896
	struct ieee80211_channel *channel = hw->conf.channel;
897
	int r;
898

899
	ath9k_ps_wakeup(sc);
900 901
	spin_lock_bh(&sc->sc_pcu_lock);

V
Vivek Natarajan 已提交
902
	ath9k_hw_configpcipowersave(ah, 0, 0);
903

904 905 906
	if (!ah->curchan)
		ah->curchan = ath_get_curchannel(sc, sc->hw);

907
	r = ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
908
	if (r) {
909 910 911
		ath_err(common,
			"Unable to reset channel (%u MHz), reset status %d\n",
			channel->center_freq, r);
912 913 914 915
	}

	ath_update_txpow(sc);
	if (ath_startrecv(sc) != 0) {
916
		ath_err(common, "Unable to restart recv logic\n");
917
		goto out;
918 919
	}
	if (sc->sc_flags & SC_OP_BEACONS)
920
		ath_beacon_config(sc, NULL);	/* restart beacons */
921 922

	/* Re-Enable  interrupts */
P
Pavel Roskin 已提交
923
	ath9k_hw_set_interrupts(ah, ah->imask);
924 925

	/* Enable LED */
926
	ath9k_hw_cfg_output(ah, ah->led_pin,
927
			    AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
928
	ath9k_hw_set_gpio(ah, ah->led_pin, 0);
929

930
	ieee80211_wake_queues(hw);
931
out:
932 933
	spin_unlock_bh(&sc->sc_pcu_lock);

934
	ath9k_ps_restore(sc);
935 936
}

937
void ath_radio_disable(struct ath_softc *sc, struct ieee80211_hw *hw)
938
{
939
	struct ath_hw *ah = sc->sc_ah;
940
	struct ieee80211_channel *channel = hw->conf.channel;
941
	int r;
942

943
	ath9k_ps_wakeup(sc);
944 945
	spin_lock_bh(&sc->sc_pcu_lock);

946
	ieee80211_stop_queues(hw);
947

948 949 950 951 952 953 954 955
	/*
	 * Keep the LED on when the radio is disabled
	 * during idle unassociated state.
	 */
	if (!sc->ps_idle) {
		ath9k_hw_set_gpio(ah, ah->led_pin, 1);
		ath9k_hw_cfg_gpio_input(ah, ah->led_pin);
	}
956 957

	/* Disable interrupts */
958
	ath9k_hw_disable_interrupts(ah);
959

S
Sujith 已提交
960
	ath_drain_all_txq(sc, false);	/* clear pending tx frames */
961

962 963 964
	ath_stoprecv(sc);		/* turn off frame recv */
	ath_flushrecv(sc);		/* flush recv queue */

965
	if (!ah->curchan)
966
		ah->curchan = ath_get_curchannel(sc, hw);
967

968
	r = ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
969
	if (r) {
970 971 972
		ath_err(ath9k_hw_common(sc->sc_ah),
			"Unable to reset channel (%u MHz), reset status %d\n",
			channel->center_freq, r);
973 974 975
	}

	ath9k_hw_phy_disable(ah);
976

V
Vivek Natarajan 已提交
977
	ath9k_hw_configpcipowersave(ah, 1, 1);
978 979

	spin_unlock_bh(&sc->sc_pcu_lock);
980
	ath9k_ps_restore(sc);
981

982
	ath9k_setpower(sc, ATH9K_PM_FULL_SLEEP);
983 984
}

S
Sujith 已提交
985 986
int ath_reset(struct ath_softc *sc, bool retry_tx)
{
987
	struct ath_hw *ah = sc->sc_ah;
988
	struct ath_common *common = ath9k_hw_common(ah);
989
	struct ieee80211_hw *hw = sc->hw;
990
	int r;
S
Sujith 已提交
991

S
Sujith 已提交
992 993 994
	/* Stop ANI */
	del_timer_sync(&common->ani.timer);

995 996
	spin_lock_bh(&sc->sc_pcu_lock);

S
Sujith 已提交
997 998
	ieee80211_stop_queues(hw);

999
	ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
1000
	ath_drain_all_txq(sc, retry_tx);
1001

S
Sujith 已提交
1002 1003 1004
	ath_stoprecv(sc);
	ath_flushrecv(sc);

1005
	r = ath9k_hw_reset(ah, sc->sc_ah->curchan, ah->caldata, false);
1006
	if (r)
1007 1008
		ath_err(common,
			"Unable to reset hardware; reset status %d\n", r);
S
Sujith 已提交
1009 1010

	if (ath_startrecv(sc) != 0)
1011
		ath_err(common, "Unable to start recv logic\n");
S
Sujith 已提交
1012 1013 1014 1015 1016 1017 1018 1019

	/*
	 * We may be doing a reset in response to a request
	 * that changes the channel so update any state that
	 * might change as a result.
	 */
	ath_update_txpow(sc);

1020
	if ((sc->sc_flags & SC_OP_BEACONS) || !(sc->sc_flags & (SC_OP_OFFCHANNEL)))
1021
		ath_beacon_config(sc, NULL);	/* restart beacons */
S
Sujith 已提交
1022

P
Pavel Roskin 已提交
1023
	ath9k_hw_set_interrupts(ah, ah->imask);
S
Sujith 已提交
1024 1025 1026 1027 1028

	if (retry_tx) {
		int i;
		for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
			if (ATH_TXQ_SETUP(sc, i)) {
S
Sujith 已提交
1029 1030 1031
				spin_lock_bh(&sc->tx.txq[i].axq_lock);
				ath_txq_schedule(sc, &sc->tx.txq[i]);
				spin_unlock_bh(&sc->tx.txq[i].axq_lock);
S
Sujith 已提交
1032 1033 1034 1035
			}
		}
	}

S
Sujith 已提交
1036
	ieee80211_wake_queues(hw);
1037
	spin_unlock_bh(&sc->sc_pcu_lock);
S
Sujith 已提交
1038

S
Sujith 已提交
1039 1040 1041
	/* Start ANI */
	ath_start_ani(common);

1042
	return r;
S
Sujith 已提交
1043 1044
}

1045 1046
/* XXX: Remove me once we don't depend on ath9k_channel for all
 * this redundant data */
1047 1048
void ath9k_update_ichannel(struct ath_softc *sc, struct ieee80211_hw *hw,
			   struct ath9k_channel *ichan)
1049 1050 1051 1052 1053 1054 1055 1056 1057
{
	struct ieee80211_channel *chan = hw->conf.channel;
	struct ieee80211_conf *conf = &hw->conf;

	ichan->channel = chan->center_freq;
	ichan->chan = chan;

	if (chan->band == IEEE80211_BAND_2GHZ) {
		ichan->chanmode = CHANNEL_G;
S
Sujith 已提交
1058
		ichan->channelFlags = CHANNEL_2GHZ | CHANNEL_OFDM | CHANNEL_G;
1059 1060 1061 1062 1063
	} else {
		ichan->chanmode = CHANNEL_A;
		ichan->channelFlags = CHANNEL_5GHZ | CHANNEL_OFDM;
	}

L
Luis R. Rodriguez 已提交
1064
	if (conf_is_ht(conf))
1065 1066 1067 1068
		ichan->chanmode = ath_get_extchanmode(sc, chan,
					    conf->channel_type);
}

S
Sujith 已提交
1069 1070 1071 1072
/**********************/
/* mac80211 callbacks */
/**********************/

1073
static int ath9k_start(struct ieee80211_hw *hw)
1074
{
1075 1076
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1077
	struct ath_hw *ah = sc->sc_ah;
1078
	struct ath_common *common = ath9k_hw_common(ah);
1079
	struct ieee80211_channel *curchan = hw->conf.channel;
S
Sujith 已提交
1080
	struct ath9k_channel *init_channel;
1081
	int r;
1082

J
Joe Perches 已提交
1083 1084 1085
	ath_dbg(common, ATH_DBG_CONFIG,
		"Starting driver with initial channel: %d MHz\n",
		curchan->center_freq);
1086

1087 1088
	mutex_lock(&sc->mutex);

1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109
	if (ath9k_wiphy_started(sc)) {
		if (sc->chan_idx == curchan->hw_value) {
			/*
			 * Already on the operational channel, the new wiphy
			 * can be marked active.
			 */
			aphy->state = ATH_WIPHY_ACTIVE;
			ieee80211_wake_queues(hw);
		} else {
			/*
			 * Another wiphy is on another channel, start the new
			 * wiphy in paused state.
			 */
			aphy->state = ATH_WIPHY_PAUSED;
			ieee80211_stop_queues(hw);
		}
		mutex_unlock(&sc->mutex);
		return 0;
	}
	aphy->state = ATH_WIPHY_ACTIVE;

1110
	/* setup initial channel */
1111

1112
	sc->chan_idx = curchan->hw_value;
1113

1114
	init_channel = ath_get_curchannel(sc, hw);
S
Sujith 已提交
1115 1116

	/* Reset SERDES registers */
1117
	ath9k_hw_configpcipowersave(ah, 0, 0);
S
Sujith 已提交
1118 1119 1120 1121 1122 1123 1124 1125

	/*
	 * The basic interface to setting the hardware in a good
	 * state is ``reset''.  On return the hardware is known to
	 * be powered up and with interrupts disabled.  This must
	 * be followed by initialization of the appropriate bits
	 * and then setup of the interrupt mask.
	 */
1126
	spin_lock_bh(&sc->sc_pcu_lock);
1127
	r = ath9k_hw_reset(ah, init_channel, ah->caldata, false);
1128
	if (r) {
1129 1130 1131
		ath_err(common,
			"Unable to reset hardware; reset status %d (freq %u MHz)\n",
			r, curchan->center_freq);
1132
		spin_unlock_bh(&sc->sc_pcu_lock);
1133
		goto mutex_unlock;
S
Sujith 已提交
1134 1135 1136 1137 1138 1139 1140
	}

	/*
	 * This is needed only to setup initial state
	 * but it's best done after a reset.
	 */
	ath_update_txpow(sc);
1141

S
Sujith 已提交
1142 1143 1144 1145 1146 1147 1148 1149
	/*
	 * Setup the hardware after reset:
	 * The receive engine is set going.
	 * Frame transmit is handled entirely
	 * in the frame output path; there's nothing to do
	 * here except setup the interrupt mask.
	 */
	if (ath_startrecv(sc) != 0) {
1150
		ath_err(common, "Unable to start recv logic\n");
1151
		r = -EIO;
1152
		spin_unlock_bh(&sc->sc_pcu_lock);
1153
		goto mutex_unlock;
1154
	}
1155
	spin_unlock_bh(&sc->sc_pcu_lock);
1156

S
Sujith 已提交
1157
	/* Setup our intr mask. */
F
Felix Fietkau 已提交
1158 1159 1160 1161 1162
	ah->imask = ATH9K_INT_TX | ATH9K_INT_RXEOL |
		    ATH9K_INT_RXORN | ATH9K_INT_FATAL |
		    ATH9K_INT_GLOBAL;

	if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
1163 1164 1165
		ah->imask |= ATH9K_INT_RXHP |
			     ATH9K_INT_RXLP |
			     ATH9K_INT_BB_WATCHDOG;
F
Felix Fietkau 已提交
1166 1167
	else
		ah->imask |= ATH9K_INT_RX;
S
Sujith 已提交
1168

1169
	ah->imask |= ATH9K_INT_GTT;
S
Sujith 已提交
1170

1171
	if (ah->caps.hw_caps & ATH9K_HW_CAP_HT)
P
Pavel Roskin 已提交
1172
		ah->imask |= ATH9K_INT_CST;
S
Sujith 已提交
1173 1174

	sc->sc_flags &= ~SC_OP_INVALID;
1175
	sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
1176 1177

	/* Disable BMISS interrupt when we're not associated */
P
Pavel Roskin 已提交
1178 1179
	ah->imask &= ~(ATH9K_INT_SWBA | ATH9K_INT_BMISS);
	ath9k_hw_set_interrupts(ah, ah->imask);
S
Sujith 已提交
1180

1181
	ieee80211_wake_queues(hw);
S
Sujith 已提交
1182

1183
	ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
1184

1185 1186
	if ((ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE) &&
	    !ah->btcoex_hw.enabled) {
1187 1188
		ath9k_hw_btcoex_set_weight(ah, AR_BT_COEX_WGHT,
					   AR_STOMP_LOW_WLAN_WGHT);
1189
		ath9k_hw_btcoex_enable(ah);
1190

1191 1192
		if (common->bus_ops->bt_coex_prep)
			common->bus_ops->bt_coex_prep(common);
1193
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1194
			ath9k_btcoex_timer_resume(sc);
1195 1196
	}

1197
	pm_qos_update_request(&sc->pm_qos_req, 55);
1198

1199 1200 1201
	if (ah->caps.pcie_lcr_extsync_en && common->bus_ops->extn_synch_en)
		common->bus_ops->extn_synch_en(common);

1202 1203 1204
mutex_unlock:
	mutex_unlock(&sc->mutex);

1205
	return r;
1206 1207
}

1208 1209
static int ath9k_tx(struct ieee80211_hw *hw,
		    struct sk_buff *skb)
1210
{
1211 1212
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1213
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
S
Sujith 已提交
1214
	struct ath_tx_control txctl;
1215
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
S
Sujith 已提交
1216

1217
	if (aphy->state != ATH_WIPHY_ACTIVE && aphy->state != ATH_WIPHY_SCAN) {
J
Joe Perches 已提交
1218 1219 1220
		ath_dbg(common, ATH_DBG_XMIT,
			"ath9k: %s: TX in unexpected wiphy state %d\n",
			wiphy_name(hw->wiphy), aphy->state);
1221 1222 1223
		goto exit;
	}

1224
	if (sc->ps_enabled) {
1225 1226 1227 1228 1229 1230 1231
		/*
		 * mac80211 does not set PM field for normal data frames, so we
		 * need to update that based on the current PS mode.
		 */
		if (ieee80211_is_data(hdr->frame_control) &&
		    !ieee80211_is_nullfunc(hdr->frame_control) &&
		    !ieee80211_has_pm(hdr->frame_control)) {
J
Joe Perches 已提交
1232 1233
			ath_dbg(common, ATH_DBG_PS,
				"Add PM=1 for a TX frame while in PS mode\n");
1234 1235 1236 1237
			hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
		}
	}

1238 1239 1240 1241 1242 1243 1244
	if (unlikely(sc->sc_ah->power_mode != ATH9K_PM_AWAKE)) {
		/*
		 * We are using PS-Poll and mac80211 can request TX while in
		 * power save mode. Need to wake up hardware for the TX to be
		 * completed and if needed, also for RX of buffered frames.
		 */
		ath9k_ps_wakeup(sc);
1245 1246
		if (!(sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
			ath9k_hw_setrxabort(sc->sc_ah, 0);
1247
		if (ieee80211_is_pspoll(hdr->frame_control)) {
J
Joe Perches 已提交
1248 1249
			ath_dbg(common, ATH_DBG_PS,
				"Sending PS-Poll to pick a buffered frame\n");
S
Sujith 已提交
1250
			sc->ps_flags |= PS_WAIT_FOR_PSPOLL_DATA;
1251
		} else {
J
Joe Perches 已提交
1252 1253
			ath_dbg(common, ATH_DBG_PS,
				"Wake up to complete TX\n");
S
Sujith 已提交
1254
			sc->ps_flags |= PS_WAIT_FOR_TX_ACK;
1255 1256 1257 1258 1259 1260 1261 1262 1263
		}
		/*
		 * The actual restore operation will happen only after
		 * the sc_flags bit is cleared. We are just dropping
		 * the ps_usecount here.
		 */
		ath9k_ps_restore(sc);
	}

S
Sujith 已提交
1264
	memset(&txctl, 0, sizeof(struct ath_tx_control));
1265
	txctl.txq = sc->tx.txq_map[skb_get_queue_mapping(skb)];
S
Sujith 已提交
1266

J
Joe Perches 已提交
1267
	ath_dbg(common, ATH_DBG_XMIT, "transmitting packet, skb: %p\n", skb);
1268

1269
	if (ath_tx_start(hw, skb, &txctl) != 0) {
J
Joe Perches 已提交
1270
		ath_dbg(common, ATH_DBG_XMIT, "TX failed\n");
S
Sujith 已提交
1271
		goto exit;
1272 1273
	}

S
Sujith 已提交
1274 1275 1276
	return 0;
exit:
	dev_kfree_skb_any(skb);
1277
	return 0;
1278 1279
}

1280
static void ath9k_stop(struct ieee80211_hw *hw)
1281
{
1282 1283
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1284
	struct ath_hw *ah = sc->sc_ah;
1285
	struct ath_common *common = ath9k_hw_common(ah);
1286
	int i;
1287

S
Sujith 已提交
1288 1289
	mutex_lock(&sc->mutex);

1290 1291
	aphy->state = ATH_WIPHY_INACTIVE;

1292 1293 1294
	if (led_blink)
		cancel_delayed_work_sync(&sc->ath_led_blink_work);

1295
	cancel_delayed_work_sync(&sc->tx_complete_work);
1296
	cancel_work_sync(&sc->paprd_work);
1297
	cancel_work_sync(&sc->hw_check_work);
1298

1299 1300 1301 1302 1303 1304
	for (i = 0; i < sc->num_sec_wiphy; i++) {
		if (sc->sec_wiphy[i])
			break;
	}

	if (i == sc->num_sec_wiphy) {
1305 1306 1307 1308
		cancel_delayed_work_sync(&sc->wiphy_work);
		cancel_work_sync(&sc->chan_work);
	}

S
Sujith 已提交
1309
	if (sc->sc_flags & SC_OP_INVALID) {
J
Joe Perches 已提交
1310
		ath_dbg(common, ATH_DBG_ANY, "Device not present\n");
S
Sujith 已提交
1311
		mutex_unlock(&sc->mutex);
S
Sujith 已提交
1312 1313
		return;
	}
1314

1315 1316 1317 1318 1319
	if (ath9k_wiphy_started(sc)) {
		mutex_unlock(&sc->mutex);
		return; /* another wiphy still in use */
	}

1320 1321 1322
	/* Ensure HW is awake when we try to shut it down. */
	ath9k_ps_wakeup(sc);

1323
	if (ah->btcoex_hw.enabled) {
1324
		ath9k_hw_btcoex_disable(ah);
1325
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1326
			ath9k_btcoex_timer_pause(sc);
1327 1328
	}

1329 1330
	spin_lock_bh(&sc->sc_pcu_lock);

S
Sujith 已提交
1331 1332
	/* make sure h/w will not generate any interrupt
	 * before setting the invalid flag. */
1333
	ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
1334 1335

	if (!(sc->sc_flags & SC_OP_INVALID)) {
S
Sujith 已提交
1336
		ath_drain_all_txq(sc, false);
S
Sujith 已提交
1337
		ath_stoprecv(sc);
1338
		ath9k_hw_phy_disable(ah);
1339
	} else
S
Sujith 已提交
1340
		sc->rx.rxlink = NULL;
S
Sujith 已提交
1341 1342

	/* disable HAL and put h/w to sleep */
1343 1344
	ath9k_hw_disable(ah);
	ath9k_hw_configpcipowersave(ah, 1, 1);
1345 1346 1347

	spin_unlock_bh(&sc->sc_pcu_lock);

1348 1349
	ath9k_ps_restore(sc);

1350 1351
	sc->ps_idle = true;
	ath_radio_disable(sc, hw);
S
Sujith 已提交
1352 1353

	sc->sc_flags |= SC_OP_INVALID;
1354

1355
	pm_qos_update_request(&sc->pm_qos_req, PM_QOS_DEFAULT_VALUE);
1356

1357 1358
	mutex_unlock(&sc->mutex);

J
Joe Perches 已提交
1359
	ath_dbg(common, ATH_DBG_CONFIG, "Driver halt\n");
1360 1361
}

1362
static int ath9k_add_interface(struct ieee80211_hw *hw,
1363
			       struct ieee80211_vif *vif)
1364
{
1365 1366
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
P
Pavel Roskin 已提交
1367 1368
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1369
	struct ath_vif *avp = (void *)vif->drv_priv;
1370
	enum nl80211_iftype ic_opmode = NL80211_IFTYPE_UNSPECIFIED;
1371
	int ret = 0;
1372

1373 1374
	mutex_lock(&sc->mutex);

1375
	switch (vif->type) {
1376
	case NL80211_IFTYPE_STATION:
1377
		ic_opmode = NL80211_IFTYPE_STATION;
1378
		break;
B
Bill Jordan 已提交
1379 1380 1381
	case NL80211_IFTYPE_WDS:
		ic_opmode = NL80211_IFTYPE_WDS;
		break;
1382 1383
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_AP:
1384
	case NL80211_IFTYPE_MESH_POINT:
1385 1386 1387 1388
		if (sc->nbcnvifs >= ATH_BCBUF) {
			ret = -ENOBUFS;
			goto out;
		}
1389
		ic_opmode = vif->type;
1390 1391
		break;
	default:
1392 1393
		ath_err(common, "Interface type %d not yet supported\n",
			vif->type);
1394 1395
		ret = -EOPNOTSUPP;
		goto out;
1396 1397
	}

J
Joe Perches 已提交
1398 1399
	ath_dbg(common, ATH_DBG_CONFIG,
		"Attach a VIF of type: %d\n", ic_opmode);
1400

S
Sujith 已提交
1401
	/* Set the VIF opmode */
S
Sujith 已提交
1402 1403 1404
	avp->av_opmode = ic_opmode;
	avp->av_bslot = -1;

1405
	sc->nvifs++;
1406

1407
	ath9k_set_bssid_mask(hw, vif);
1408

1409 1410 1411
	if (sc->nvifs > 1)
		goto out; /* skip global settings for secondary vif */

S
Sujith 已提交
1412
	if (ic_opmode == NL80211_IFTYPE_AP) {
P
Pavel Roskin 已提交
1413
		ath9k_hw_set_tsfadjust(ah, 1);
S
Sujith 已提交
1414 1415
		sc->sc_flags |= SC_OP_TSF_RESET;
	}
S
Sujith 已提交
1416 1417

	/* Set the device opmode */
P
Pavel Roskin 已提交
1418
	ah->opmode = ic_opmode;
S
Sujith 已提交
1419

1420 1421 1422 1423
	/*
	 * Enable MIB interrupts when there are hardware phy counters.
	 * Note we only do this (at the moment) for station mode.
	 */
1424 1425 1426
	if ((vif->type == NL80211_IFTYPE_STATION) ||
	    (vif->type == NL80211_IFTYPE_ADHOC) ||
	    (vif->type == NL80211_IFTYPE_MESH_POINT)) {
1427 1428
		if (ah->config.enable_ani)
			ah->imask |= ATH9K_INT_MIB;
P
Pavel Roskin 已提交
1429
		ah->imask |= ATH9K_INT_TSFOOR;
1430 1431
	}

P
Pavel Roskin 已提交
1432
	ath9k_hw_set_interrupts(ah, ah->imask);
1433

1434
	if (vif->type == NL80211_IFTYPE_AP    ||
1435
	    vif->type == NL80211_IFTYPE_ADHOC) {
1436
		sc->sc_flags |= SC_OP_ANI_RUN;
1437
		ath_start_ani(common);
1438
	}
1439

1440
out:
1441
	mutex_unlock(&sc->mutex);
1442
	return ret;
1443 1444
}

1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510
static void ath9k_reclaim_beacon(struct ath_softc *sc,
				 struct ieee80211_vif *vif)
{
	struct ath_vif *avp = (void *)vif->drv_priv;

	/* Disable SWBA interrupt */
	sc->sc_ah->imask &= ~ATH9K_INT_SWBA;
	ath9k_ps_wakeup(sc);
	ath9k_hw_set_interrupts(sc->sc_ah, sc->sc_ah->imask);
	ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
	tasklet_kill(&sc->bcon_tasklet);
	ath9k_ps_restore(sc);

	ath_beacon_return(sc, avp);
	sc->sc_flags &= ~SC_OP_BEACONS;

	if (sc->nbcnvifs > 0) {
		/* Re-enable beaconing */
		sc->sc_ah->imask |= ATH9K_INT_SWBA;
		ath9k_ps_wakeup(sc);
		ath9k_hw_set_interrupts(sc->sc_ah, sc->sc_ah->imask);
		ath9k_ps_restore(sc);
	}
}

static int ath9k_change_interface(struct ieee80211_hw *hw,
				  struct ieee80211_vif *vif,
				  enum nl80211_iftype new_type,
				  bool p2p)
{
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);

	ath_dbg(common, ATH_DBG_CONFIG, "Change Interface\n");
	mutex_lock(&sc->mutex);

	switch (new_type) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_ADHOC:
		if (sc->nbcnvifs >= ATH_BCBUF) {
			ath_err(common, "No beacon slot available\n");
			return -ENOBUFS;
		}
		break;
	case NL80211_IFTYPE_STATION:
		/* Stop ANI */
		sc->sc_flags &= ~SC_OP_ANI_RUN;
		del_timer_sync(&common->ani.timer);
		if ((vif->type == NL80211_IFTYPE_AP) ||
		    (vif->type == NL80211_IFTYPE_ADHOC))
			ath9k_reclaim_beacon(sc, vif);
		break;
	default:
		ath_err(common, "Interface type %d not yet supported\n",
				vif->type);
		mutex_unlock(&sc->mutex);
		return -ENOTSUPP;
	}
	vif->type = new_type;
	vif->p2p = p2p;

	mutex_unlock(&sc->mutex);
	return 0;
}

1511
static void ath9k_remove_interface(struct ieee80211_hw *hw,
1512
				   struct ieee80211_vif *vif)
1513
{
1514 1515
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1516
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1517

J
Joe Perches 已提交
1518
	ath_dbg(common, ATH_DBG_CONFIG, "Detach Interface\n");
1519

1520 1521
	mutex_lock(&sc->mutex);

1522
	/* Stop ANI */
1523
	sc->sc_flags &= ~SC_OP_ANI_RUN;
1524
	del_timer_sync(&common->ani.timer);
J
Jouni Malinen 已提交
1525

1526
	/* Reclaim beacon resources */
1527 1528
	if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) ||
	    (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC) ||
1529 1530
	    (sc->sc_ah->opmode == NL80211_IFTYPE_MESH_POINT))
		ath9k_reclaim_beacon(sc, vif);
1531

S
Sujith 已提交
1532
	sc->nvifs--;
1533 1534

	mutex_unlock(&sc->mutex);
1535 1536
}

1537
static void ath9k_enable_ps(struct ath_softc *sc)
1538
{
P
Pavel Roskin 已提交
1539 1540
	struct ath_hw *ah = sc->sc_ah;

1541
	sc->ps_enabled = true;
P
Pavel Roskin 已提交
1542 1543 1544 1545
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
		if ((ah->imask & ATH9K_INT_TIM_TIMER) == 0) {
			ah->imask |= ATH9K_INT_TIM_TIMER;
			ath9k_hw_set_interrupts(ah, ah->imask);
1546
		}
1547
		ath9k_hw_setrxabort(ah, 1);
1548 1549 1550
	}
}

1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570
static void ath9k_disable_ps(struct ath_softc *sc)
{
	struct ath_hw *ah = sc->sc_ah;

	sc->ps_enabled = false;
	ath9k_hw_setpower(ah, ATH9K_PM_AWAKE);
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
		ath9k_hw_setrxabort(ah, 0);
		sc->ps_flags &= ~(PS_WAIT_FOR_BEACON |
				  PS_WAIT_FOR_CAB |
				  PS_WAIT_FOR_PSPOLL_DATA |
				  PS_WAIT_FOR_TX_ACK);
		if (ah->imask & ATH9K_INT_TIM_TIMER) {
			ah->imask &= ~ATH9K_INT_TIM_TIMER;
			ath9k_hw_set_interrupts(ah, ah->imask);
		}
	}

}

1571
static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
1572
{
1573 1574
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1575 1576
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1577
	struct ieee80211_conf *conf = &hw->conf;
1578
	bool disable_radio;
1579

1580
	mutex_lock(&sc->mutex);
1581

1582 1583 1584 1585 1586 1587
	/*
	 * Leave this as the first check because we need to turn on the
	 * radio if it was disabled before prior to processing the rest
	 * of the changes. Likewise we must only disable the radio towards
	 * the end.
	 */
1588
	if (changed & IEEE80211_CONF_CHANGE_IDLE) {
1589 1590 1591
		bool enable_radio;
		bool all_wiphys_idle;
		bool idle = !!(conf->flags & IEEE80211_CONF_IDLE);
1592 1593 1594

		spin_lock_bh(&sc->wiphy_lock);
		all_wiphys_idle =  ath9k_all_wiphys_idle(sc);
1595 1596
		ath9k_set_wiphy_idle(aphy, idle);

1597
		enable_radio = (!idle && all_wiphys_idle);
1598 1599 1600 1601 1602 1603 1604

		/*
		 * After we unlock here its possible another wiphy
		 * can be re-renabled so to account for that we will
		 * only disable the radio toward the end of this routine
		 * if by then all wiphys are still idle.
		 */
1605 1606
		spin_unlock_bh(&sc->wiphy_lock);

1607
		if (enable_radio) {
1608
			sc->ps_idle = false;
1609
			ath_radio_enable(sc, hw);
J
Joe Perches 已提交
1610 1611
			ath_dbg(common, ATH_DBG_CONFIG,
				"not-idle: enabling radio\n");
1612 1613 1614
		}
	}

1615 1616 1617 1618 1619 1620
	/*
	 * We just prepare to enable PS. We have to wait until our AP has
	 * ACK'd our null data frame to disable RX otherwise we'll ignore
	 * those ACKs and end up retransmitting the same null data frames.
	 * IEEE80211_CONF_CHANGE_PS is only passed by mac80211 for STA mode.
	 */
1621
	if (changed & IEEE80211_CONF_CHANGE_PS) {
1622 1623
		unsigned long flags;
		spin_lock_irqsave(&sc->sc_pm_lock, flags);
1624 1625
		if (conf->flags & IEEE80211_CONF_PS)
			ath9k_enable_ps(sc);
1626 1627
		else
			ath9k_disable_ps(sc);
1628
		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1629 1630
	}

S
Sujith 已提交
1631 1632
	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
		if (conf->flags & IEEE80211_CONF_MONITOR) {
J
Joe Perches 已提交
1633 1634
			ath_dbg(common, ATH_DBG_CONFIG,
				"Monitor mode is enabled\n");
1635 1636
			sc->sc_ah->is_monitoring = true;
		} else {
J
Joe Perches 已提交
1637 1638
			ath_dbg(common, ATH_DBG_CONFIG,
				"Monitor mode is disabled\n");
1639
			sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
1640 1641 1642
		}
	}

1643
	if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
1644
		struct ieee80211_channel *curchan = hw->conf.channel;
1645
		int pos = curchan->hw_value;
1646 1647 1648 1649 1650
		int old_pos = -1;
		unsigned long flags;

		if (ah->curchan)
			old_pos = ah->curchan - &ah->channels[0];
J
Johannes Berg 已提交
1651

1652 1653
		aphy->chan_idx = pos;
		aphy->chan_is_ht = conf_is_ht(conf);
1654 1655 1656 1657
		if (hw->conf.flags & IEEE80211_CONF_OFFCHANNEL)
			sc->sc_flags |= SC_OP_OFFCHANNEL;
		else
			sc->sc_flags &= ~SC_OP_OFFCHANNEL;
1658

1659 1660 1661 1662 1663 1664 1665 1666 1667 1668
		if (aphy->state == ATH_WIPHY_SCAN ||
		    aphy->state == ATH_WIPHY_ACTIVE)
			ath9k_wiphy_pause_all_forced(sc, aphy);
		else {
			/*
			 * Do not change operational channel based on a paused
			 * wiphy changes.
			 */
			goto skip_chan_change;
		}
1669

J
Joe Perches 已提交
1670 1671
		ath_dbg(common, ATH_DBG_CONFIG, "Set channel: %d MHz\n",
			curchan->center_freq);
1672

1673
		/* XXX: remove me eventualy */
1674
		ath9k_update_ichannel(sc, hw, &sc->sc_ah->channels[pos]);
1675

1676
		ath_update_chainmask(sc, conf_is_ht(conf));
S
Sujith 已提交
1677

1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702
		/* update survey stats for the old channel before switching */
		spin_lock_irqsave(&common->cc_lock, flags);
		ath_update_survey_stats(sc);
		spin_unlock_irqrestore(&common->cc_lock, flags);

		/*
		 * If the operating channel changes, change the survey in-use flags
		 * along with it.
		 * Reset the survey data for the new channel, unless we're switching
		 * back to the operating channel from an off-channel operation.
		 */
		if (!(hw->conf.flags & IEEE80211_CONF_OFFCHANNEL) &&
		    sc->cur_survey != &sc->survey[pos]) {

			if (sc->cur_survey)
				sc->cur_survey->filled &= ~SURVEY_INFO_IN_USE;

			sc->cur_survey = &sc->survey[pos];

			memset(sc->cur_survey, 0, sizeof(struct survey_info));
			sc->cur_survey->filled |= SURVEY_INFO_IN_USE;
		} else if (!(sc->survey[pos].filled & SURVEY_INFO_IN_USE)) {
			memset(&sc->survey[pos], 0, sizeof(struct survey_info));
		}

1703
		if (ath_set_channel(sc, hw, &sc->sc_ah->channels[pos]) < 0) {
1704
			ath_err(common, "Unable to set channel\n");
1705
			mutex_unlock(&sc->mutex);
1706 1707
			return -EINVAL;
		}
1708 1709 1710 1711 1712 1713 1714 1715

		/*
		 * The most recent snapshot of channel->noisefloor for the old
		 * channel is only available after the hardware reset. Copy it to
		 * the survey stats now.
		 */
		if (old_pos >= 0)
			ath_update_survey_nf(sc, old_pos);
S
Sujith 已提交
1716
	}
1717

1718
skip_chan_change:
1719
	if (changed & IEEE80211_CONF_CHANGE_POWER) {
S
Sujith 已提交
1720
		sc->config.txpowlimit = 2 * conf->power_level;
1721 1722
		ath_update_txpow(sc);
	}
1723

1724 1725 1726 1727
	spin_lock_bh(&sc->wiphy_lock);
	disable_radio = ath9k_all_wiphys_idle(sc);
	spin_unlock_bh(&sc->wiphy_lock);

1728
	if (disable_radio) {
J
Joe Perches 已提交
1729
		ath_dbg(common, ATH_DBG_CONFIG, "idle: disabling radio\n");
1730
		sc->ps_idle = true;
1731
		ath_radio_disable(sc, hw);
1732 1733
	}

1734
	mutex_unlock(&sc->mutex);
1735

1736 1737 1738
	return 0;
}

1739 1740 1741 1742
#define SUPPORTED_FILTERS			\
	(FIF_PROMISC_IN_BSS |			\
	FIF_ALLMULTI |				\
	FIF_CONTROL |				\
1743
	FIF_PSPOLL |				\
1744 1745
	FIF_OTHER_BSS |				\
	FIF_BCN_PRBRESP_PROMISC |		\
1746
	FIF_PROBE_REQ |				\
1747
	FIF_FCSFAIL)
1748

1749 1750 1751 1752
/* FIXME: sc->sc_full_reset ? */
static void ath9k_configure_filter(struct ieee80211_hw *hw,
				   unsigned int changed_flags,
				   unsigned int *total_flags,
1753
				   u64 multicast)
1754
{
1755 1756
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1757
	u32 rfilt;
1758

1759 1760
	changed_flags &= SUPPORTED_FILTERS;
	*total_flags &= SUPPORTED_FILTERS;
1761

S
Sujith 已提交
1762
	sc->rx.rxfilter = *total_flags;
1763
	ath9k_ps_wakeup(sc);
1764 1765
	rfilt = ath_calcrxfilter(sc);
	ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1766
	ath9k_ps_restore(sc);
1767

J
Joe Perches 已提交
1768 1769
	ath_dbg(ath9k_hw_common(sc->sc_ah), ATH_DBG_CONFIG,
		"Set HW RX filter: 0x%x\n", rfilt);
1770
}
1771

1772 1773 1774
static int ath9k_sta_add(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta)
1775
{
1776 1777
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1778

1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793
	ath_node_attach(sc, sta);

	return 0;
}

static int ath9k_sta_remove(struct ieee80211_hw *hw,
			    struct ieee80211_vif *vif,
			    struct ieee80211_sta *sta)
{
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;

	ath_node_detach(sc, sta);

	return 0;
1794 1795
}

1796
static int ath9k_conf_tx(struct ieee80211_hw *hw, u16 queue,
1797
			 const struct ieee80211_tx_queue_params *params)
1798
{
1799 1800
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1801
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1802
	struct ath_txq *txq;
1803
	struct ath9k_tx_queue_info qi;
1804
	int ret = 0;
1805

1806 1807
	if (queue >= WME_NUM_AC)
		return 0;
1808

1809 1810
	txq = sc->tx.txq_map[queue];

1811 1812
	mutex_lock(&sc->mutex);

1813 1814
	memset(&qi, 0, sizeof(struct ath9k_tx_queue_info));

1815 1816 1817 1818
	qi.tqi_aifs = params->aifs;
	qi.tqi_cwmin = params->cw_min;
	qi.tqi_cwmax = params->cw_max;
	qi.tqi_burstTime = params->txop;
1819

J
Joe Perches 已提交
1820 1821 1822 1823
	ath_dbg(common, ATH_DBG_CONFIG,
		"Configure tx [queue/halq] [%d/%d], aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
		queue, txq->axq_qnum, params->aifs, params->cw_min,
		params->cw_max, params->txop);
1824

1825
	ret = ath_txq_update(sc, txq->axq_qnum, &qi);
1826
	if (ret)
1827
		ath_err(common, "TXQ Update failed\n");
1828

1829
	if (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC)
1830
		if (queue == WME_AC_BE && !ret)
1831 1832
			ath_beaconq_config(sc);

1833 1834
	mutex_unlock(&sc->mutex);

1835 1836
	return ret;
}
1837

1838 1839
static int ath9k_set_key(struct ieee80211_hw *hw,
			 enum set_key_cmd cmd,
1840 1841
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta,
1842 1843
			 struct ieee80211_key_conf *key)
{
1844 1845
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1846
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1847
	int ret = 0;
1848

1849 1850 1851
	if (modparam_nohwcrypt)
		return -ENOSPC;

1852
	mutex_lock(&sc->mutex);
1853
	ath9k_ps_wakeup(sc);
J
Joe Perches 已提交
1854
	ath_dbg(common, ATH_DBG_CONFIG, "Set HW Key\n");
1855

1856 1857
	switch (cmd) {
	case SET_KEY:
1858
		ret = ath_key_config(common, vif, sta, key);
1859 1860
		if (ret >= 0) {
			key->hw_key_idx = ret;
1861 1862
			/* push IV and Michael MIC generation to stack */
			key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
1863
			if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
1864
				key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
1865 1866
			if (sc->sc_ah->sw_mgmt_crypto &&
			    key->cipher == WLAN_CIPHER_SUITE_CCMP)
1867
				key->flags |= IEEE80211_KEY_FLAG_SW_MGMT;
1868
			ret = 0;
1869 1870 1871
		}
		break;
	case DISABLE_KEY:
1872
		ath_key_delete(common, key);
1873 1874 1875 1876
		break;
	default:
		ret = -EINVAL;
	}
1877

1878
	ath9k_ps_restore(sc);
1879 1880
	mutex_unlock(&sc->mutex);

1881 1882
	return ret;
}
1883

1884 1885 1886 1887 1888
static void ath9k_bss_info_changed(struct ieee80211_hw *hw,
				   struct ieee80211_vif *vif,
				   struct ieee80211_bss_conf *bss_conf,
				   u32 changed)
{
1889 1890
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1891
	struct ath_hw *ah = sc->sc_ah;
1892
	struct ath_common *common = ath9k_hw_common(ah);
1893
	struct ath_vif *avp = (void *)vif->drv_priv;
1894
	int slottime;
S
Sujith 已提交
1895
	int error;
1896

1897 1898
	mutex_lock(&sc->mutex);

S
Sujith 已提交
1899 1900 1901 1902
	if (changed & BSS_CHANGED_BSSID) {
		/* Set BSSID */
		memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
		memcpy(avp->bssid, bss_conf->bssid, ETH_ALEN);
1903
		common->curaid = 0;
1904
		ath9k_hw_write_associd(ah);
1905

S
Sujith 已提交
1906 1907
		/* Set aggregation protection mode parameters */
		sc->config.ath_aggr_prot = 0;
1908

S
Sujith 已提交
1909 1910 1911
		/* Only legacy IBSS for now */
		if (vif->type == NL80211_IFTYPE_ADHOC)
			ath_update_chainmask(sc, 0);
1912

J
Joe Perches 已提交
1913 1914
		ath_dbg(common, ATH_DBG_CONFIG, "BSSID: %pM aid: 0x%x\n",
			common->curbssid, common->curaid);
1915

S
Sujith 已提交
1916 1917 1918
		/* need to reconfigure the beacon */
		sc->sc_flags &= ~SC_OP_BEACONS ;
	}
1919

S
Sujith 已提交
1920 1921 1922 1923 1924 1925 1926
	/* Enable transmission of beacons (AP, IBSS, MESH) */
	if ((changed & BSS_CHANGED_BEACON) ||
	    ((changed & BSS_CHANGED_BEACON_ENABLED) && bss_conf->enable_beacon)) {
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
		error = ath_beacon_alloc(aphy, vif);
		if (!error)
			ath_beacon_config(sc, vif);
1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945
	}

	if (changed & BSS_CHANGED_ERP_SLOT) {
		if (bss_conf->use_short_slot)
			slottime = 9;
		else
			slottime = 20;
		if (vif->type == NL80211_IFTYPE_AP) {
			/*
			 * Defer update, so that connected stations can adjust
			 * their settings at the same time.
			 * See beacon.c for more details
			 */
			sc->beacon.slottime = slottime;
			sc->beacon.updateslot = UPDATE;
		} else {
			ah->slottime = slottime;
			ath9k_hw_init_global_settings(ah);
		}
1946 1947
	}

S
Sujith 已提交
1948 1949 1950
	/* Disable transmission of beacons */
	if ((changed & BSS_CHANGED_BEACON_ENABLED) && !bss_conf->enable_beacon)
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
1951

S
Sujith 已提交
1952 1953 1954 1955 1956 1957 1958 1959 1960
	if (changed & BSS_CHANGED_BEACON_INT) {
		sc->beacon_interval = bss_conf->beacon_int;
		/*
		 * In case of AP mode, the HW TSF has to be reset
		 * when the beacon interval changes.
		 */
		if (vif->type == NL80211_IFTYPE_AP) {
			sc->sc_flags |= SC_OP_TSF_RESET;
			ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
1961 1962 1963
			error = ath_beacon_alloc(aphy, vif);
			if (!error)
				ath_beacon_config(sc, vif);
S
Sujith 已提交
1964 1965
		} else {
			ath_beacon_config(sc, vif);
1966 1967 1968
		}
	}

1969
	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
J
Joe Perches 已提交
1970 1971
		ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed PREAMBLE %d\n",
			bss_conf->use_short_preamble);
1972 1973 1974 1975 1976
		if (bss_conf->use_short_preamble)
			sc->sc_flags |= SC_OP_PREAMBLE_SHORT;
		else
			sc->sc_flags &= ~SC_OP_PREAMBLE_SHORT;
	}
1977

1978
	if (changed & BSS_CHANGED_ERP_CTS_PROT) {
J
Joe Perches 已提交
1979 1980
		ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed CTS PROT %d\n",
			bss_conf->use_cts_prot);
1981 1982 1983 1984 1985 1986
		if (bss_conf->use_cts_prot &&
		    hw->conf.channel->band != IEEE80211_BAND_5GHZ)
			sc->sc_flags |= SC_OP_PROTECT_ENABLE;
		else
			sc->sc_flags &= ~SC_OP_PROTECT_ENABLE;
	}
1987

1988
	if (changed & BSS_CHANGED_ASSOC) {
J
Joe Perches 已提交
1989
		ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed ASSOC %d\n",
1990
			bss_conf->assoc);
1991
		ath9k_bss_assoc_info(sc, hw, vif, bss_conf);
1992
	}
1993 1994

	mutex_unlock(&sc->mutex);
1995
}
1996

1997 1998 1999
static u64 ath9k_get_tsf(struct ieee80211_hw *hw)
{
	u64 tsf;
2000 2001
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2002

2003
	mutex_lock(&sc->mutex);
2004
	ath9k_ps_wakeup(sc);
2005
	tsf = ath9k_hw_gettsf64(sc->sc_ah);
2006
	ath9k_ps_restore(sc);
2007
	mutex_unlock(&sc->mutex);
2008

2009 2010
	return tsf;
}
2011

2012 2013
static void ath9k_set_tsf(struct ieee80211_hw *hw, u64 tsf)
{
2014 2015
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2016

2017
	mutex_lock(&sc->mutex);
2018
	ath9k_ps_wakeup(sc);
2019
	ath9k_hw_settsf64(sc->sc_ah, tsf);
2020
	ath9k_ps_restore(sc);
2021
	mutex_unlock(&sc->mutex);
2022 2023
}

2024 2025
static void ath9k_reset_tsf(struct ieee80211_hw *hw)
{
2026 2027
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2028

2029
	mutex_lock(&sc->mutex);
2030 2031

	ath9k_ps_wakeup(sc);
2032
	ath9k_hw_reset_tsf(sc->sc_ah);
2033 2034
	ath9k_ps_restore(sc);

2035
	mutex_unlock(&sc->mutex);
2036
}
2037

2038
static int ath9k_ampdu_action(struct ieee80211_hw *hw,
2039
			      struct ieee80211_vif *vif,
2040 2041 2042
			      enum ieee80211_ampdu_mlme_action action,
			      struct ieee80211_sta *sta,
			      u16 tid, u16 *ssn)
2043
{
2044 2045
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2046
	int ret = 0;
2047

2048 2049
	local_bh_disable();

2050 2051
	switch (action) {
	case IEEE80211_AMPDU_RX_START:
2052 2053
		if (!(sc->sc_flags & SC_OP_RXAGGR))
			ret = -ENOTSUPP;
2054 2055 2056 2057
		break;
	case IEEE80211_AMPDU_RX_STOP:
		break;
	case IEEE80211_AMPDU_TX_START:
2058 2059 2060
		if (!(sc->sc_flags & SC_OP_TXAGGR))
			return -EOPNOTSUPP;

2061
		ath9k_ps_wakeup(sc);
2062 2063 2064
		ret = ath_tx_aggr_start(sc, sta, tid, ssn);
		if (!ret)
			ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2065
		ath9k_ps_restore(sc);
2066 2067
		break;
	case IEEE80211_AMPDU_TX_STOP:
2068
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
2069
		ath_tx_aggr_stop(sc, sta, tid);
2070
		ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2071
		ath9k_ps_restore(sc);
2072
		break;
2073
	case IEEE80211_AMPDU_TX_OPERATIONAL:
2074
		ath9k_ps_wakeup(sc);
2075
		ath_tx_aggr_resume(sc, sta, tid);
2076
		ath9k_ps_restore(sc);
2077
		break;
2078
	default:
2079
		ath_err(ath9k_hw_common(sc->sc_ah), "Unknown AMPDU action\n");
2080 2081
	}

2082 2083
	local_bh_enable();

2084
	return ret;
2085 2086
}

2087 2088 2089 2090 2091
static int ath9k_get_survey(struct ieee80211_hw *hw, int idx,
			     struct survey_info *survey)
{
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2092
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
2093
	struct ieee80211_supported_band *sband;
2094 2095 2096 2097 2098 2099 2100
	struct ieee80211_channel *chan;
	unsigned long flags;
	int pos;

	spin_lock_irqsave(&common->cc_lock, flags);
	if (idx == 0)
		ath_update_survey_stats(sc);
2101 2102 2103 2104 2105 2106

	sband = hw->wiphy->bands[IEEE80211_BAND_2GHZ];
	if (sband && idx >= sband->n_channels) {
		idx -= sband->n_channels;
		sband = NULL;
	}
2107

2108 2109
	if (!sband)
		sband = hw->wiphy->bands[IEEE80211_BAND_5GHZ];
2110

2111 2112 2113
	if (!sband || idx >= sband->n_channels) {
		spin_unlock_irqrestore(&common->cc_lock, flags);
		return -ENOENT;
2114
	}
2115

2116 2117 2118 2119 2120 2121
	chan = &sband->channels[idx];
	pos = chan->hw_value;
	memcpy(survey, &sc->survey[pos], sizeof(*survey));
	survey->channel = chan;
	spin_unlock_irqrestore(&common->cc_lock, flags);

2122 2123 2124
	return 0;
}

2125 2126
static void ath9k_sw_scan_start(struct ieee80211_hw *hw)
{
2127 2128
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2129

2130
	mutex_lock(&sc->mutex);
2131 2132
	if (ath9k_wiphy_scanning(sc)) {
		/*
2133 2134 2135 2136 2137
		 * There is a race here in mac80211 but fixing it requires
		 * we revisit how we handle the scan complete callback.
		 * After mac80211 fixes we will not have configured hardware
		 * to the home channel nor would we have configured the RX
		 * filter yet.
2138
		 */
2139
		mutex_unlock(&sc->mutex);
2140 2141 2142 2143 2144
		return;
	}

	aphy->state = ATH_WIPHY_SCAN;
	ath9k_wiphy_pause_all_forced(sc, aphy);
2145
	mutex_unlock(&sc->mutex);
2146 2147
}

2148 2149 2150 2151
/*
 * XXX: this requires a revisit after the driver
 * scan_complete gets moved to another place/removed in mac80211.
 */
2152 2153
static void ath9k_sw_scan_complete(struct ieee80211_hw *hw)
{
2154 2155
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2156

2157
	mutex_lock(&sc->mutex);
2158
	aphy->state = ATH_WIPHY_ACTIVE;
2159
	mutex_unlock(&sc->mutex);
2160 2161
}

2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173
static void ath9k_set_coverage_class(struct ieee80211_hw *hw, u8 coverage_class)
{
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
	struct ath_hw *ah = sc->sc_ah;

	mutex_lock(&sc->mutex);
	ah->coverage_class = coverage_class;
	ath9k_hw_init_global_settings(ah);
	mutex_unlock(&sc->mutex);
}

2174
struct ieee80211_ops ath9k_ops = {
2175 2176 2177 2178
	.tx 		    = ath9k_tx,
	.start 		    = ath9k_start,
	.stop 		    = ath9k_stop,
	.add_interface 	    = ath9k_add_interface,
2179
	.change_interface   = ath9k_change_interface,
2180 2181 2182
	.remove_interface   = ath9k_remove_interface,
	.config 	    = ath9k_config,
	.configure_filter   = ath9k_configure_filter,
2183 2184
	.sta_add	    = ath9k_sta_add,
	.sta_remove	    = ath9k_sta_remove,
2185 2186 2187 2188
	.conf_tx 	    = ath9k_conf_tx,
	.bss_info_changed   = ath9k_bss_info_changed,
	.set_key            = ath9k_set_key,
	.get_tsf 	    = ath9k_get_tsf,
2189
	.set_tsf 	    = ath9k_set_tsf,
2190
	.reset_tsf 	    = ath9k_reset_tsf,
2191
	.ampdu_action       = ath9k_ampdu_action,
2192
	.get_survey	    = ath9k_get_survey,
2193 2194
	.sw_scan_start      = ath9k_sw_scan_start,
	.sw_scan_complete   = ath9k_sw_scan_complete,
J
Johannes Berg 已提交
2195
	.rfkill_poll        = ath9k_rfkill_poll_state,
2196
	.set_coverage_class = ath9k_set_coverage_class,
2197
};