main.c 53.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 23 24 25 26 27 28 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
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;
	}
}

S
Sujith 已提交
56
bool ath9k_setpower(struct ath_softc *sc, enum ath9k_power_mode mode)
57 58 59 60
{
	unsigned long flags;
	bool ret;

61 62 63
	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	ret = ath9k_hw_setpower(sc->sc_ah, mode);
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
64 65 66 67

	return ret;
}

68 69
void ath9k_ps_wakeup(struct ath_softc *sc)
{
70
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
71
	unsigned long flags;
72
	enum ath9k_power_mode power_mode;
73 74 75 76 77

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

78
	power_mode = sc->sc_ah->power_mode;
79
	ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
80

81 82 83 84 85
	/*
	 * 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.
	 */
86 87 88 89 90 91
	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);
	}
92

93 94 95 96 97 98
 unlock:
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
}

void ath9k_ps_restore(struct ath_softc *sc)
{
99
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
100 101 102 103 104 105
	unsigned long flags;

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

106 107 108 109
	spin_lock(&common->cc_lock);
	ath_hw_cycle_counters_update(common);
	spin_unlock(&common->cc_lock);

110 111 112 113
	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 已提交
114 115 116
			      PS_WAIT_FOR_CAB |
			      PS_WAIT_FOR_PSPOLL_DATA |
			      PS_WAIT_FOR_TX_ACK)))
117
		ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_NETWORK_SLEEP);
118 119 120 121 122

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

123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143
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));
}

144 145 146 147 148 149 150 151 152 153 154 155
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;
	}
}

156 157 158 159 160 161
/*
 * Updates the survey statistics and returns the busy time since last
 * update in %, if the measurement duration was long enough for the
 * result to be useful, -1 otherwise.
 */
static int ath_update_survey_stats(struct ath_softc *sc)
162 163 164 165 166 167 168
{
	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;
169
	int ret = 0;
170

171
	if (!ah->curchan)
172
		return -1;
173

174 175
	if (ah->power_mode == ATH9K_PM_AWAKE)
		ath_hw_cycle_counters_update(common);
176 177 178 179 180 181 182 183 184 185 186

	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;
	}
187 188 189 190 191 192 193

	if (cc->cycles < div)
		return -1;

	if (cc->cycles > 0)
		ret = cc->rx_busy * 100 / cc->cycles;

194 195 196
	memset(cc, 0, sizeof(*cc));

	ath_update_survey_nf(sc, pos);
197 198

	return ret;
199 200
}

S
Sujith 已提交
201 202 203 204 205
/*
 * 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.
*/
206 207
int ath_set_channel(struct ath_softc *sc, struct ieee80211_hw *hw,
		    struct ath9k_channel *hchan)
S
Sujith 已提交
208
{
209
	struct ath_hw *ah = sc->sc_ah;
210
	struct ath_common *common = ath9k_hw_common(ah);
L
Luis R. Rodriguez 已提交
211
	struct ieee80211_conf *conf = &common->hw->conf;
S
Sujith 已提交
212
	bool fastcc = true, stopped;
213
	struct ieee80211_channel *channel = hw->conf.channel;
214
	struct ath9k_hw_cal_data *caldata = NULL;
215
	int r;
S
Sujith 已提交
216 217 218 219

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

220 221
	sc->hw_busy_count = 0;

222 223 224 225
	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);
226
	cancel_delayed_work_sync(&sc->hw_pll_work);
227

228 229
	ath9k_ps_wakeup(sc);

230 231
	spin_lock_bh(&sc->sc_pcu_lock);

232 233 234 235 236 237 238 239 240
	/*
	 * 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.
	 */
241
	ath9k_hw_disable_interrupts(ah);
242
	stopped = ath_drain_all_txq(sc, false);
243

244 245
	if (!ath_stoprecv(sc))
		stopped = false;
S
Sujith 已提交
246

247 248 249
	if (!ath9k_hw_check_alive(ah))
		stopped = false;

250 251 252
	/* XXX: do not flush receive queue here. We don't want
	 * to flush data frames already in queue because of
	 * changing channel. */
S
Sujith 已提交
253

254
	if (!stopped || !(sc->sc_flags & SC_OP_OFFCHANNEL))
255 256
		fastcc = false;

257
	if (!(sc->sc_flags & SC_OP_OFFCHANNEL))
258
		caldata = &sc->caldata;
259

J
Joe Perches 已提交
260 261 262 263 264
	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 已提交
265

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

	if (ath_startrecv(sc) != 0) {
275
		ath_err(common, "Unable to restart recv logic\n");
276 277
		r = -EIO;
		goto ps_restore;
278 279
	}

280 281
	ath9k_cmn_update_txpow(ah, sc->curtxpow,
			       sc->config.txpowlimit, &sc->curtxpow);
P
Pavel Roskin 已提交
282
	ath9k_hw_set_interrupts(ah, ah->imask);
283

284
	if (!(sc->sc_flags & (SC_OP_OFFCHANNEL))) {
285 286
		if (sc->sc_flags & SC_OP_BEACONS)
			ath_beacon_config(sc, NULL);
287
		ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
288
		ieee80211_queue_delayed_work(sc->hw, &sc->hw_pll_work, HZ/2);
289
		ath_start_ani(common);
290 291
	}

292
 ps_restore:
293 294
	ieee80211_wake_queues(hw);

295 296
	spin_unlock_bh(&sc->sc_pcu_lock);

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

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

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

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

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

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

324 325 326 327
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);
328 329
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346
	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);
347 348 349 350

	if (ath_tx_start(hw, skb, &txctl) != 0) {
		ath_dbg(common, ATH_DBG_XMIT, "PAPRD TX failed\n");
		dev_kfree_skb_any(skb);
351
		return false;
352
	}
353 354 355 356 357 358 359 360 361 362 363 364 365

	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;
}

366 367 368 369 370 371 372
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;
373
	struct ath9k_hw_cal_data *caldata = ah->caldata;
374
	struct ath_common *common = ath9k_hw_common(ah);
375
	int ftype;
376 377 378 379
	int chain_ok = 0;
	int chain;
	int len = 1800;

380 381 382
	if (!caldata)
		return;

383 384 385
	if (ar9003_paprd_init_table(ah) < 0)
		return;

386 387 388 389 390 391 392 393 394
	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);
395
	hdr->duration_id = cpu_to_le16(10);
396 397 398 399
	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);

400
	ath9k_ps_wakeup(sc);
401
	for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
402
		if (!(common->tx_chainmask & BIT(chain)))
403 404 405 406
			continue;

		chain_ok = 0;

407 408 409 410 411
		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;
412 413 414

		ar9003_paprd_setup_gain_table(ah, chain);

415 416 417
		ath_dbg(common, ATH_DBG_CALIBRATE,
			"Sending PAPRD training frame on chain %d\n", chain);
		if (!ath_paprd_send_frame(sc, skb, chain))
418
			goto fail_paprd;
419 420 421 422

		if (!ar9003_paprd_is_done(ah))
			break;

423
		if (ar9003_paprd_create_curve(ah, caldata, chain) != 0)
424 425 426 427 428 429 430
			break;

		chain_ok = 1;
	}
	kfree_skb(skb);

	if (chain_ok) {
431
		caldata->paprd_done = true;
432 433 434
		ath_paprd_activate(sc);
	}

435
fail_paprd:
436 437 438
	ath9k_ps_restore(sc);
}

S
Sujith 已提交
439 440 441 442 443 444 445
/*
 *  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 已提交
446
void ath_ani_calibrate(unsigned long data)
S
Sujith 已提交
447
{
448 449
	struct ath_softc *sc = (struct ath_softc *)data;
	struct ath_hw *ah = sc->sc_ah;
450
	struct ath_common *common = ath9k_hw_common(ah);
S
Sujith 已提交
451 452 453 454
	bool longcal = false;
	bool shortcal = false;
	bool aniflag = false;
	unsigned int timestamp = jiffies_to_msecs(jiffies);
455
	u32 cal_interval, short_cal_interval, long_cal_interval;
456
	unsigned long flags;
457 458 459 460 461

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

463 464
	short_cal_interval = (ah->opmode == NL80211_IFTYPE_AP) ?
		ATH_AP_SHORT_CALINTERVAL : ATH_STA_SHORT_CALINTERVAL;
S
Sujith 已提交
465

466 467 468 469 470 471
	/* Only calibrate if awake */
	if (sc->sc_ah->power_mode != ATH9K_PM_AWAKE)
		goto set_timer;

	ath9k_ps_wakeup(sc);

S
Sujith 已提交
472
	/* Long calibration runs independently of short calibration. */
473
	if ((timestamp - common->ani.longcal_timer) >= long_cal_interval) {
S
Sujith 已提交
474
		longcal = true;
J
Joe Perches 已提交
475
		ath_dbg(common, ATH_DBG_ANI, "longcal @%lu\n", jiffies);
476
		common->ani.longcal_timer = timestamp;
S
Sujith 已提交
477 478
	}

S
Sujith 已提交
479
	/* Short calibration applies only while caldone is false */
480 481
	if (!common->ani.caldone) {
		if ((timestamp - common->ani.shortcal_timer) >= short_cal_interval) {
S
Sujith 已提交
482
			shortcal = true;
J
Joe Perches 已提交
483 484
			ath_dbg(common, ATH_DBG_ANI,
				"shortcal @%lu\n", jiffies);
485 486
			common->ani.shortcal_timer = timestamp;
			common->ani.resetcal_timer = timestamp;
S
Sujith 已提交
487 488
		}
	} else {
489
		if ((timestamp - common->ani.resetcal_timer) >=
S
Sujith 已提交
490
		    ATH_RESTART_CALINTERVAL) {
491 492 493
			common->ani.caldone = ath9k_hw_reset_calvalid(ah);
			if (common->ani.caldone)
				common->ani.resetcal_timer = timestamp;
S
Sujith 已提交
494 495 496 497
		}
	}

	/* Verify whether we must check ANI */
498 499
	if ((timestamp - common->ani.checkani_timer) >=
	     ah->config.ani_poll_interval) {
S
Sujith 已提交
500
		aniflag = true;
501
		common->ani.checkani_timer = timestamp;
S
Sujith 已提交
502 503 504 505 506
	}

	/* Skip all processing if there's nothing to do. */
	if (longcal || shortcal || aniflag) {
		/* Call ANI routine if necessary */
507 508
		if (aniflag) {
			spin_lock_irqsave(&common->cc_lock, flags);
509
			ath9k_hw_ani_monitor(ah, ah->curchan);
510
			ath_update_survey_stats(sc);
511 512
			spin_unlock_irqrestore(&common->cc_lock, flags);
		}
S
Sujith 已提交
513 514 515

		/* Perform calibration if necessary */
		if (longcal || shortcal) {
516
			common->ani.caldone =
517 518 519 520
				ath9k_hw_calibrate(ah,
						   ah->curchan,
						   common->rx_chainmask,
						   longcal);
S
Sujith 已提交
521 522 523
		}
	}

524 525
	ath9k_ps_restore(sc);

526
set_timer:
S
Sujith 已提交
527 528 529 530 531
	/*
	* Set timer interval based on previous results.
	* The interval must be the shortest necessary to satisfy ANI,
	* short calibration and long calibration.
	*/
532
	cal_interval = ATH_LONG_CALINTERVAL;
533
	if (sc->sc_ah->config.enable_ani)
534 535
		cal_interval = min(cal_interval,
				   (u32)ah->config.ani_poll_interval);
536
	if (!common->ani.caldone)
537
		cal_interval = min(cal_interval, (u32)short_cal_interval);
S
Sujith 已提交
538

539
	mod_timer(&common->ani.timer, jiffies + msecs_to_jiffies(cal_interval));
540 541
	if ((sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_PAPRD) && ah->caldata) {
		if (!ah->caldata->paprd_done)
542
			ieee80211_queue_work(sc->hw, &sc->paprd_work);
543
		else if (!ah->paprd_table_write_done)
544 545
			ath_paprd_activate(sc);
	}
S
Sujith 已提交
546 547 548 549 550
}

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

554 555 556 557 558 559
#ifdef CONFIG_ATH9K_DEBUGFS
	spin_lock(&sc->nodes_lock);
	list_add(&an->list, &sc->nodes);
	spin_unlock(&sc->nodes_lock);
	an->sta = sta;
#endif
560 561 562
	if ((ah->caps.hw_caps) & ATH9K_HW_CAP_APM)
		sc->sc_flags |= SC_OP_ENABLE_APM;

563
	if (sc->sc_flags & SC_OP_TXAGGR) {
S
Sujith 已提交
564
		ath_tx_node_init(sc, an);
S
Sujith 已提交
565
		an->maxampdu = 1 << (IEEE80211_HT_MAX_AMPDU_FACTOR +
566 567 568
				     sta->ht_cap.ampdu_factor);
		an->mpdudensity = parse_mpdudensity(sta->ht_cap.ampdu_density);
	}
S
Sujith 已提交
569 570 571 572 573 574
}

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

575 576 577 578 579 580 581
#ifdef CONFIG_ATH9K_DEBUGFS
	spin_lock(&sc->nodes_lock);
	list_del(&an->list);
	spin_unlock(&sc->nodes_lock);
	an->sta = NULL;
#endif

S
Sujith 已提交
582 583 584 585
	if (sc->sc_flags & SC_OP_TXAGGR)
		ath_tx_node_cleanup(sc, an);
}

586 587 588
void ath_hw_check(struct work_struct *work)
{
	struct ath_softc *sc = container_of(work, struct ath_softc, hw_check_work);
589 590 591
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	unsigned long flags;
	int busy;
592 593

	ath9k_ps_wakeup(sc);
594 595
	if (ath9k_hw_check_alive(sc->sc_ah))
		goto out;
596

597 598 599
	spin_lock_irqsave(&common->cc_lock, flags);
	busy = ath_update_survey_stats(sc);
	spin_unlock_irqrestore(&common->cc_lock, flags);
600

601 602 603 604 605 606 607
	ath_dbg(common, ATH_DBG_RESET, "Possible baseband hang, "
		"busy=%d (try %d)\n", busy, sc->hw_busy_count + 1);
	if (busy >= 99) {
		if (++sc->hw_busy_count >= 3)
			ath_reset(sc, true);
	} else if (busy >= 0)
		sc->hw_busy_count = 0;
608 609 610 611 612

out:
	ath9k_ps_restore(sc);
}

S
Sujith 已提交
613
void ath9k_tasklet(unsigned long data)
S
Sujith 已提交
614 615
{
	struct ath_softc *sc = (struct ath_softc *)data;
616
	struct ath_hw *ah = sc->sc_ah;
617
	struct ath_common *common = ath9k_hw_common(ah);
618

S
Sujith 已提交
619
	u32 status = sc->intrstatus;
F
Felix Fietkau 已提交
620
	u32 rxmask;
S
Sujith 已提交
621

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

627
	ath9k_ps_wakeup(sc);
628
	spin_lock(&sc->sc_pcu_lock);
629

630 631 632 633 634 635 636 637 638
	/*
	 * Only run the baseband hang check if beacons stop working in AP or
	 * IBSS mode, because it has a high false positive rate. For station
	 * mode it should not be necessary, since the upper layers will detect
	 * this through a beacon miss automatically and the following channel
	 * change will trigger a hardware reset anyway
	 */
	if (ath9k_hw_numtxpending(ah, sc->beacon.beaconq) != 0 &&
	    !ath9k_hw_check_alive(ah))
639 640
		ieee80211_queue_work(sc->hw, &sc->hw_check_work);

F
Felix Fietkau 已提交
641 642 643 644 645 646 647 648 649 650 651 652 653
	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 已提交
654 655
	}

656 657 658 659 660 661
	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 已提交
662

663
	if ((status & ATH9K_INT_TSFOOR) && sc->ps_enabled) {
664 665 666 667
		/*
		 * TSF sync does not look correct; remain awake to sync with
		 * the next Beacon.
		 */
J
Joe Perches 已提交
668 669
		ath_dbg(common, ATH_DBG_PS,
			"TSFOOR - Sync with next Beacon\n");
S
Sujith 已提交
670
		sc->ps_flags |= PS_WAIT_FOR_BEACON | PS_BEACON_SYNC;
671 672
	}

673
	if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
674 675 676
		if (status & ATH9K_INT_GENTIMER)
			ath_gen_timer_isr(sc->sc_ah);

S
Sujith 已提交
677
	/* re-enable hardware interrupt */
678
	ath9k_hw_enable_interrupts(ah);
679

680
	spin_unlock(&sc->sc_pcu_lock);
681
	ath9k_ps_restore(sc);
S
Sujith 已提交
682 683
}

684
irqreturn_t ath_isr(int irq, void *dev)
S
Sujith 已提交
685
{
S
Sujith 已提交
686 687 688 689 690
#define SCHED_INTR (				\
		ATH9K_INT_FATAL |		\
		ATH9K_INT_RXORN |		\
		ATH9K_INT_RXEOL |		\
		ATH9K_INT_RX |			\
F
Felix Fietkau 已提交
691 692
		ATH9K_INT_RXLP |		\
		ATH9K_INT_RXHP |		\
S
Sujith 已提交
693 694 695
		ATH9K_INT_TX |			\
		ATH9K_INT_BMISS |		\
		ATH9K_INT_CST |			\
696 697
		ATH9K_INT_TSFOOR |		\
		ATH9K_INT_GENTIMER)
S
Sujith 已提交
698

S
Sujith 已提交
699
	struct ath_softc *sc = dev;
700
	struct ath_hw *ah = sc->sc_ah;
701
	struct ath_common *common = ath9k_hw_common(ah);
S
Sujith 已提交
702 703 704
	enum ath9k_int status;
	bool sched = false;

S
Sujith 已提交
705 706 707 708 709 710 711
	/*
	 * 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 已提交
712

S
Sujith 已提交
713 714 715

	/* shared irq, not for us */

716
	if (!ath9k_hw_intrpend(ah))
S
Sujith 已提交
717 718 719 720 721 722 723 724 725
		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 已提交
726
	status &= ah->imask;	/* discard unasked-for bits */
S
Sujith 已提交
727

S
Sujith 已提交
728 729 730 731
	/*
	 * If there are no status bits set, then this interrupt was not
	 * for me (should have been caught above).
	 */
732
	if (!status)
S
Sujith 已提交
733
		return IRQ_NONE;
S
Sujith 已提交
734

S
Sujith 已提交
735 736 737 738 739 740 741 742 743 744
	/* 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 已提交
745 746
	if ((status & ATH9K_INT_FATAL) || ((status & ATH9K_INT_RXORN) &&
	    !(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)))
S
Sujith 已提交
747 748
		goto chip_reset;

749 750
	if ((ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) &&
	    (status & ATH9K_INT_BB_WATCHDOG)) {
751 752 753

		spin_lock(&common->cc_lock);
		ath_hw_cycle_counters_update(common);
754
		ar9003_hw_bb_watchdog_dbg_info(ah);
755 756
		spin_unlock(&common->cc_lock);

757 758 759
		goto chip_reset;
	}

S
Sujith 已提交
760 761 762 763 764 765
	if (status & ATH9K_INT_SWBA)
		tasklet_schedule(&sc->bcon_tasklet);

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

F
Felix Fietkau 已提交
766 767 768 769 770 771 772
	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 已提交
773
	if (status & ATH9K_INT_MIB) {
S
Sujith 已提交
774
		/*
S
Sujith 已提交
775 776 777
		 * Disable interrupts until we service the MIB
		 * interrupt; otherwise it will continue to
		 * fire.
S
Sujith 已提交
778
		 */
779
		ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
780 781 782 783 784
		/*
		 * Let the hal handle the event. We assume
		 * it will clear whatever condition caused
		 * the interrupt.
		 */
785
		spin_lock(&common->cc_lock);
786
		ath9k_hw_proc_mib_event(ah);
787
		spin_unlock(&common->cc_lock);
788
		ath9k_hw_enable_interrupts(ah);
S
Sujith 已提交
789
	}
S
Sujith 已提交
790

791 792
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
		if (status & ATH9K_INT_TIM_TIMER) {
793 794
			if (ATH_DBG_WARN_ON_ONCE(sc->ps_idle))
				goto chip_reset;
S
Sujith 已提交
795 796
			/* Clear RxAbort bit so that we can
			 * receive frames */
797
			ath9k_setpower(sc, ATH9K_PM_AWAKE);
798
			ath9k_hw_setrxabort(sc->sc_ah, 0);
S
Sujith 已提交
799
			sc->ps_flags |= PS_WAIT_FOR_BEACON;
S
Sujith 已提交
800
		}
S
Sujith 已提交
801 802

chip_reset:
S
Sujith 已提交
803

804 805
	ath_debug_stat_interrupt(sc, status);

S
Sujith 已提交
806
	if (sched) {
807 808
		/* turn off every interrupt */
		ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
809 810 811 812
		tasklet_schedule(&sc->intr_tq);
	}

	return IRQ_HANDLED;
S
Sujith 已提交
813 814

#undef SCHED_INTR
S
Sujith 已提交
815 816
}

817
static void ath9k_bss_assoc_info(struct ath_softc *sc,
818
				 struct ieee80211_hw *hw,
S
Sujith 已提交
819
				 struct ieee80211_vif *vif,
820
				 struct ieee80211_bss_conf *bss_conf)
821
{
822
	struct ath_hw *ah = sc->sc_ah;
823
	struct ath_common *common = ath9k_hw_common(ah);
824

825
	if (bss_conf->assoc) {
J
Joe Perches 已提交
826 827 828
		ath_dbg(common, ATH_DBG_CONFIG,
			"Bss Info ASSOC %d, bssid: %pM\n",
			bss_conf->aid, common->curbssid);
829

830
		/* New association, store aid */
831
		common->curaid = bss_conf->aid;
832
		ath9k_hw_write_associd(ah);
833 834 835 836 837 838

		/*
		 * 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 已提交
839
		sc->ps_flags |= PS_BEACON_SYNC;
840

841
		/* Configure the beacon */
842
		ath_beacon_config(sc, vif);
843

844
		/* Reset rssi stats */
845
		sc->last_rssi = ATH_RSSI_DUMMY_MARKER;
846
		sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
847

848
		sc->sc_flags |= SC_OP_ANI_RUN;
849
		ath_start_ani(common);
850
	} else {
J
Joe Perches 已提交
851
		ath_dbg(common, ATH_DBG_CONFIG, "Bss Info DISASSOC\n");
852
		common->curaid = 0;
853
		/* Stop ANI */
854
		sc->sc_flags &= ~SC_OP_ANI_RUN;
855
		del_timer_sync(&common->ani.timer);
856
	}
857
}
858

859
void ath_radio_enable(struct ath_softc *sc, struct ieee80211_hw *hw)
860
{
861
	struct ath_hw *ah = sc->sc_ah;
862
	struct ath_common *common = ath9k_hw_common(ah);
863
	struct ieee80211_channel *channel = hw->conf.channel;
864
	int r;
865

866
	ath9k_ps_wakeup(sc);
867 868
	spin_lock_bh(&sc->sc_pcu_lock);

V
Vivek Natarajan 已提交
869
	ath9k_hw_configpcipowersave(ah, 0, 0);
870

871
	if (!ah->curchan)
872
		ah->curchan = ath9k_cmn_get_curchannel(sc->hw, ah);
873

874
	r = ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
875
	if (r) {
876 877 878
		ath_err(common,
			"Unable to reset channel (%u MHz), reset status %d\n",
			channel->center_freq, r);
879 880
	}

881 882
	ath9k_cmn_update_txpow(ah, sc->curtxpow,
			       sc->config.txpowlimit, &sc->curtxpow);
883
	if (ath_startrecv(sc) != 0) {
884
		ath_err(common, "Unable to restart recv logic\n");
885
		goto out;
886 887
	}
	if (sc->sc_flags & SC_OP_BEACONS)
888
		ath_beacon_config(sc, NULL);	/* restart beacons */
889 890

	/* Re-Enable  interrupts */
P
Pavel Roskin 已提交
891
	ath9k_hw_set_interrupts(ah, ah->imask);
892 893

	/* Enable LED */
894
	ath9k_hw_cfg_output(ah, ah->led_pin,
895
			    AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
896
	ath9k_hw_set_gpio(ah, ah->led_pin, 0);
897

898
	ieee80211_wake_queues(hw);
899
out:
900 901
	spin_unlock_bh(&sc->sc_pcu_lock);

902
	ath9k_ps_restore(sc);
903 904
}

905
void ath_radio_disable(struct ath_softc *sc, struct ieee80211_hw *hw)
906
{
907
	struct ath_hw *ah = sc->sc_ah;
908
	struct ieee80211_channel *channel = hw->conf.channel;
909
	int r;
910

911
	ath9k_ps_wakeup(sc);
912 913
	spin_lock_bh(&sc->sc_pcu_lock);

914
	ieee80211_stop_queues(hw);
915

916 917 918 919 920 921 922 923
	/*
	 * 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);
	}
924 925

	/* Disable interrupts */
926
	ath9k_hw_disable_interrupts(ah);
927

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

930 931 932
	ath_stoprecv(sc);		/* turn off frame recv */
	ath_flushrecv(sc);		/* flush recv queue */

933
	if (!ah->curchan)
934
		ah->curchan = ath9k_cmn_get_curchannel(hw, ah);
935

936
	r = ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
937
	if (r) {
938 939 940
		ath_err(ath9k_hw_common(sc->sc_ah),
			"Unable to reset channel (%u MHz), reset status %d\n",
			channel->center_freq, r);
941 942 943
	}

	ath9k_hw_phy_disable(ah);
944

V
Vivek Natarajan 已提交
945
	ath9k_hw_configpcipowersave(ah, 1, 1);
946 947

	spin_unlock_bh(&sc->sc_pcu_lock);
948
	ath9k_ps_restore(sc);
949 950
}

S
Sujith 已提交
951 952
int ath_reset(struct ath_softc *sc, bool retry_tx)
{
953
	struct ath_hw *ah = sc->sc_ah;
954
	struct ath_common *common = ath9k_hw_common(ah);
955
	struct ieee80211_hw *hw = sc->hw;
956
	int r;
S
Sujith 已提交
957

958 959
	sc->hw_busy_count = 0;

S
Sujith 已提交
960 961 962
	/* Stop ANI */
	del_timer_sync(&common->ani.timer);

963
	ath9k_ps_wakeup(sc);
964 965
	spin_lock_bh(&sc->sc_pcu_lock);

S
Sujith 已提交
966 967
	ieee80211_stop_queues(hw);

968
	ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
969
	ath_drain_all_txq(sc, retry_tx);
970

S
Sujith 已提交
971 972 973
	ath_stoprecv(sc);
	ath_flushrecv(sc);

974
	r = ath9k_hw_reset(ah, sc->sc_ah->curchan, ah->caldata, false);
975
	if (r)
976 977
		ath_err(common,
			"Unable to reset hardware; reset status %d\n", r);
S
Sujith 已提交
978 979

	if (ath_startrecv(sc) != 0)
980
		ath_err(common, "Unable to start recv logic\n");
S
Sujith 已提交
981 982 983 984 985 986

	/*
	 * 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.
	 */
987 988
	ath9k_cmn_update_txpow(ah, sc->curtxpow,
			       sc->config.txpowlimit, &sc->curtxpow);
S
Sujith 已提交
989

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

P
Pavel Roskin 已提交
993
	ath9k_hw_set_interrupts(ah, ah->imask);
S
Sujith 已提交
994 995 996 997 998

	if (retry_tx) {
		int i;
		for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
			if (ATH_TXQ_SETUP(sc, i)) {
S
Sujith 已提交
999 1000 1001
				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 已提交
1002 1003 1004 1005
			}
		}
	}

S
Sujith 已提交
1006
	ieee80211_wake_queues(hw);
1007
	spin_unlock_bh(&sc->sc_pcu_lock);
S
Sujith 已提交
1008

S
Sujith 已提交
1009 1010
	/* Start ANI */
	ath_start_ani(common);
1011
	ath9k_ps_restore(sc);
S
Sujith 已提交
1012

1013
	return r;
S
Sujith 已提交
1014 1015 1016 1017 1018 1019
}

/**********************/
/* mac80211 callbacks */
/**********************/

1020
static int ath9k_start(struct ieee80211_hw *hw)
1021
{
1022
	struct ath_softc *sc = hw->priv;
1023
	struct ath_hw *ah = sc->sc_ah;
1024
	struct ath_common *common = ath9k_hw_common(ah);
1025
	struct ieee80211_channel *curchan = hw->conf.channel;
S
Sujith 已提交
1026
	struct ath9k_channel *init_channel;
1027
	int r;
1028

J
Joe Perches 已提交
1029 1030 1031
	ath_dbg(common, ATH_DBG_CONFIG,
		"Starting driver with initial channel: %d MHz\n",
		curchan->center_freq);
1032

1033 1034
	mutex_lock(&sc->mutex);

1035
	/* setup initial channel */
1036
	sc->chan_idx = curchan->hw_value;
1037

1038
	init_channel = ath9k_cmn_get_curchannel(hw, ah);
S
Sujith 已提交
1039 1040

	/* Reset SERDES registers */
1041
	ath9k_hw_configpcipowersave(ah, 0, 0);
S
Sujith 已提交
1042 1043 1044 1045 1046 1047 1048 1049

	/*
	 * 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.
	 */
1050
	spin_lock_bh(&sc->sc_pcu_lock);
1051
	r = ath9k_hw_reset(ah, init_channel, ah->caldata, false);
1052
	if (r) {
1053 1054 1055
		ath_err(common,
			"Unable to reset hardware; reset status %d (freq %u MHz)\n",
			r, curchan->center_freq);
1056
		spin_unlock_bh(&sc->sc_pcu_lock);
1057
		goto mutex_unlock;
S
Sujith 已提交
1058 1059 1060 1061 1062 1063
	}

	/*
	 * This is needed only to setup initial state
	 * but it's best done after a reset.
	 */
1064 1065
	ath9k_cmn_update_txpow(ah, sc->curtxpow,
			sc->config.txpowlimit, &sc->curtxpow);
1066

S
Sujith 已提交
1067 1068 1069 1070 1071 1072 1073 1074
	/*
	 * 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) {
1075
		ath_err(common, "Unable to start recv logic\n");
1076
		r = -EIO;
1077
		spin_unlock_bh(&sc->sc_pcu_lock);
1078
		goto mutex_unlock;
1079
	}
1080
	spin_unlock_bh(&sc->sc_pcu_lock);
1081

S
Sujith 已提交
1082
	/* Setup our intr mask. */
F
Felix Fietkau 已提交
1083 1084 1085 1086 1087
	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)
1088 1089 1090
		ah->imask |= ATH9K_INT_RXHP |
			     ATH9K_INT_RXLP |
			     ATH9K_INT_BB_WATCHDOG;
F
Felix Fietkau 已提交
1091 1092
	else
		ah->imask |= ATH9K_INT_RX;
S
Sujith 已提交
1093

1094
	ah->imask |= ATH9K_INT_GTT;
S
Sujith 已提交
1095

1096
	if (ah->caps.hw_caps & ATH9K_HW_CAP_HT)
P
Pavel Roskin 已提交
1097
		ah->imask |= ATH9K_INT_CST;
S
Sujith 已提交
1098 1099

	sc->sc_flags &= ~SC_OP_INVALID;
1100
	sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
1101 1102

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

1106
	ieee80211_wake_queues(hw);
S
Sujith 已提交
1107

1108
	ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
1109

1110 1111
	if ((ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE) &&
	    !ah->btcoex_hw.enabled) {
1112 1113
		ath9k_hw_btcoex_set_weight(ah, AR_BT_COEX_WGHT,
					   AR_STOMP_LOW_WLAN_WGHT);
1114
		ath9k_hw_btcoex_enable(ah);
1115

1116 1117
		if (common->bus_ops->bt_coex_prep)
			common->bus_ops->bt_coex_prep(common);
1118
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1119
			ath9k_btcoex_timer_resume(sc);
1120 1121
	}

1122 1123 1124 1125
	/* User has the option to provide pm-qos value as a module
	 * parameter rather than using the default value of
	 * 'ATH9K_PM_QOS_DEFAULT_VALUE'.
	 */
1126
	pm_qos_update_request(&sc->pm_qos_req, ath9k_pm_qos_value);
1127

1128 1129 1130
	if (ah->caps.pcie_lcr_extsync_en && common->bus_ops->extn_synch_en)
		common->bus_ops->extn_synch_en(common);

1131 1132 1133
mutex_unlock:
	mutex_unlock(&sc->mutex);

1134
	return r;
1135 1136
}

1137 1138
static int ath9k_tx(struct ieee80211_hw *hw,
		    struct sk_buff *skb)
1139
{
1140
	struct ath_softc *sc = hw->priv;
1141
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
S
Sujith 已提交
1142
	struct ath_tx_control txctl;
1143
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
S
Sujith 已提交
1144

1145
	if (sc->ps_enabled) {
1146 1147 1148 1149 1150 1151 1152
		/*
		 * 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 已提交
1153 1154
			ath_dbg(common, ATH_DBG_PS,
				"Add PM=1 for a TX frame while in PS mode\n");
1155 1156 1157 1158
			hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
		}
	}

1159 1160 1161 1162 1163 1164 1165
	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);
1166 1167
		if (!(sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
			ath9k_hw_setrxabort(sc->sc_ah, 0);
1168
		if (ieee80211_is_pspoll(hdr->frame_control)) {
J
Joe Perches 已提交
1169 1170
			ath_dbg(common, ATH_DBG_PS,
				"Sending PS-Poll to pick a buffered frame\n");
S
Sujith 已提交
1171
			sc->ps_flags |= PS_WAIT_FOR_PSPOLL_DATA;
1172
		} else {
J
Joe Perches 已提交
1173 1174
			ath_dbg(common, ATH_DBG_PS,
				"Wake up to complete TX\n");
S
Sujith 已提交
1175
			sc->ps_flags |= PS_WAIT_FOR_TX_ACK;
1176 1177 1178 1179 1180 1181 1182 1183 1184
		}
		/*
		 * 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 已提交
1185
	memset(&txctl, 0, sizeof(struct ath_tx_control));
1186
	txctl.txq = sc->tx.txq_map[skb_get_queue_mapping(skb)];
S
Sujith 已提交
1187

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

1190
	if (ath_tx_start(hw, skb, &txctl) != 0) {
J
Joe Perches 已提交
1191
		ath_dbg(common, ATH_DBG_XMIT, "TX failed\n");
S
Sujith 已提交
1192
		goto exit;
1193 1194
	}

S
Sujith 已提交
1195 1196 1197
	return 0;
exit:
	dev_kfree_skb_any(skb);
1198
	return 0;
1199 1200
}

1201
static void ath9k_stop(struct ieee80211_hw *hw)
1202
{
1203
	struct ath_softc *sc = hw->priv;
1204
	struct ath_hw *ah = sc->sc_ah;
1205
	struct ath_common *common = ath9k_hw_common(ah);
1206

S
Sujith 已提交
1207 1208
	mutex_lock(&sc->mutex);

1209 1210 1211
	if (led_blink)
		cancel_delayed_work_sync(&sc->ath_led_blink_work);

1212
	cancel_delayed_work_sync(&sc->tx_complete_work);
1213
	cancel_delayed_work_sync(&sc->hw_pll_work);
1214
	cancel_work_sync(&sc->paprd_work);
1215
	cancel_work_sync(&sc->hw_check_work);
1216

S
Sujith 已提交
1217
	if (sc->sc_flags & SC_OP_INVALID) {
J
Joe Perches 已提交
1218
		ath_dbg(common, ATH_DBG_ANY, "Device not present\n");
S
Sujith 已提交
1219
		mutex_unlock(&sc->mutex);
S
Sujith 已提交
1220 1221
		return;
	}
1222

1223 1224 1225
	/* Ensure HW is awake when we try to shut it down. */
	ath9k_ps_wakeup(sc);

1226
	if (ah->btcoex_hw.enabled) {
1227
		ath9k_hw_btcoex_disable(ah);
1228
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1229
			ath9k_btcoex_timer_pause(sc);
1230 1231
	}

1232 1233
	spin_lock_bh(&sc->sc_pcu_lock);

1234 1235 1236
	/* prevent tasklets to enable interrupts once we disable them */
	ah->imask &= ~ATH9K_INT_GLOBAL;

S
Sujith 已提交
1237 1238
	/* make sure h/w will not generate any interrupt
	 * before setting the invalid flag. */
1239
	ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
1240 1241

	if (!(sc->sc_flags & SC_OP_INVALID)) {
S
Sujith 已提交
1242
		ath_drain_all_txq(sc, false);
S
Sujith 已提交
1243
		ath_stoprecv(sc);
1244
		ath9k_hw_phy_disable(ah);
1245
	} else
S
Sujith 已提交
1246
		sc->rx.rxlink = NULL;
S
Sujith 已提交
1247

1248 1249 1250 1251 1252
	if (sc->rx.frag) {
		dev_kfree_skb_any(sc->rx.frag);
		sc->rx.frag = NULL;
	}

S
Sujith 已提交
1253
	/* disable HAL and put h/w to sleep */
1254 1255
	ath9k_hw_disable(ah);
	ath9k_hw_configpcipowersave(ah, 1, 1);
1256 1257 1258

	spin_unlock_bh(&sc->sc_pcu_lock);

1259 1260 1261 1262 1263 1264
	/* we can now sync irq and kill any running tasklets, since we already
	 * disabled interrupts and not holding a spin lock */
	synchronize_irq(sc->irq);
	tasklet_kill(&sc->intr_tq);
	tasklet_kill(&sc->bcon_tasklet);

1265 1266
	ath9k_ps_restore(sc);

1267 1268
	sc->ps_idle = true;
	ath_radio_disable(sc, hw);
S
Sujith 已提交
1269 1270

	sc->sc_flags |= SC_OP_INVALID;
1271

1272
	pm_qos_update_request(&sc->pm_qos_req, PM_QOS_DEFAULT_VALUE);
1273

1274 1275
	mutex_unlock(&sc->mutex);

J
Joe Perches 已提交
1276
	ath_dbg(common, ATH_DBG_CONFIG, "Driver halt\n");
1277 1278
}

1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292
bool ath9k_uses_beacons(int type)
{
	switch (type) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_MESH_POINT:
		return true;
	default:
		return false;
	}
}

static void ath9k_reclaim_beacon(struct ath_softc *sc,
				 struct ieee80211_vif *vif)
1293
{
1294
	struct ath_vif *avp = (void *)vif->drv_priv;
1295

1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324
	/* 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 void ath9k_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
{
	struct ath9k_vif_iter_data *iter_data = data;
	int i;

	if (iter_data->hw_macaddr)
		for (i = 0; i < ETH_ALEN; i++)
			iter_data->mask[i] &=
				~(iter_data->hw_macaddr[i] ^ mac[i]);
1325

1326
	switch (vif->type) {
1327 1328
	case NL80211_IFTYPE_AP:
		iter_data->naps++;
1329
		break;
1330 1331
	case NL80211_IFTYPE_STATION:
		iter_data->nstations++;
B
Bill Jordan 已提交
1332
		break;
1333
	case NL80211_IFTYPE_ADHOC:
1334 1335
		iter_data->nadhocs++;
		break;
1336
	case NL80211_IFTYPE_MESH_POINT:
1337 1338 1339 1340
		iter_data->nmeshes++;
		break;
	case NL80211_IFTYPE_WDS:
		iter_data->nwds++;
1341 1342
		break;
	default:
1343 1344
		iter_data->nothers++;
		break;
1345
	}
1346
}
1347

1348 1349 1350 1351 1352
/* Called with sc->mutex held. */
void ath9k_calculate_iter_data(struct ieee80211_hw *hw,
			       struct ieee80211_vif *vif,
			       struct ath9k_vif_iter_data *iter_data)
{
1353
	struct ath_softc *sc = hw->priv;
1354 1355
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1356

1357 1358 1359 1360 1361 1362 1363
	/*
	 * Use the hardware MAC address as reference, the hardware uses it
	 * together with the BSSID mask when matching addresses.
	 */
	memset(iter_data, 0, sizeof(*iter_data));
	iter_data->hw_macaddr = common->macaddr;
	memset(&iter_data->mask, 0xff, ETH_ALEN);
S
Sujith 已提交
1364

1365 1366 1367 1368 1369 1370 1371
	if (vif)
		ath9k_vif_iter(iter_data, vif->addr, vif);

	/* Get list of all active MAC addresses */
	ieee80211_iterate_active_interfaces_atomic(sc->hw, ath9k_vif_iter,
						   iter_data);
}
1372

1373 1374 1375 1376
/* Called with sc->mutex held. */
static void ath9k_calculate_summary_state(struct ieee80211_hw *hw,
					  struct ieee80211_vif *vif)
{
1377
	struct ath_softc *sc = hw->priv;
1378 1379 1380
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	struct ath9k_vif_iter_data iter_data;
1381

1382
	ath9k_calculate_iter_data(hw, vif, &iter_data);
1383

1384
	ath9k_ps_wakeup(sc);
1385 1386 1387 1388 1389 1390
	/* Set BSSID mask. */
	memcpy(common->bssidmask, iter_data.mask, ETH_ALEN);
	ath_hw_setbssidmask(common);

	/* Set op-mode & TSF */
	if (iter_data.naps > 0) {
P
Pavel Roskin 已提交
1391
		ath9k_hw_set_tsfadjust(ah, 1);
S
Sujith 已提交
1392
		sc->sc_flags |= SC_OP_TSF_RESET;
1393 1394 1395 1396
		ah->opmode = NL80211_IFTYPE_AP;
	} else {
		ath9k_hw_set_tsfadjust(ah, 0);
		sc->sc_flags &= ~SC_OP_TSF_RESET;
S
Sujith 已提交
1397

1398 1399 1400 1401 1402 1403 1404
		if (iter_data.nwds + iter_data.nmeshes)
			ah->opmode = NL80211_IFTYPE_AP;
		else if (iter_data.nadhocs)
			ah->opmode = NL80211_IFTYPE_ADHOC;
		else
			ah->opmode = NL80211_IFTYPE_STATION;
	}
S
Sujith 已提交
1405

1406 1407 1408
	/*
	 * Enable MIB interrupts when there are hardware phy counters.
	 */
1409
	if ((iter_data.nstations + iter_data.nadhocs + iter_data.nmeshes) > 0) {
1410 1411
		if (ah->config.enable_ani)
			ah->imask |= ATH9K_INT_MIB;
P
Pavel Roskin 已提交
1412
		ah->imask |= ATH9K_INT_TSFOOR;
1413 1414 1415
	} else {
		ah->imask &= ~ATH9K_INT_MIB;
		ah->imask &= ~ATH9K_INT_TSFOOR;
1416 1417
	}

P
Pavel Roskin 已提交
1418
	ath9k_hw_set_interrupts(ah, ah->imask);
1419
	ath9k_ps_restore(sc);
1420

1421 1422
	/* Set up ANI */
	if ((iter_data.naps + iter_data.nadhocs) > 0) {
1423
		sc->sc_flags |= SC_OP_ANI_RUN;
1424
		ath_start_ani(common);
1425 1426 1427
	} else {
		sc->sc_flags &= ~SC_OP_ANI_RUN;
		del_timer_sync(&common->ani.timer);
1428
	}
1429
}
1430

1431 1432 1433 1434
/* Called with sc->mutex held, vif counts set up properly. */
static void ath9k_do_vif_add_setup(struct ieee80211_hw *hw,
				   struct ieee80211_vif *vif)
{
1435
	struct ath_softc *sc = hw->priv;
1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447

	ath9k_calculate_summary_state(hw, vif);

	if (ath9k_uses_beacons(vif->type)) {
		int error;
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
		/* This may fail because upper levels do not have beacons
		 * properly configured yet.  That's OK, we assume it
		 * will be properly configured and then we will be notified
		 * in the info_changed method and set up beacons properly
		 * there.
		 */
1448
		error = ath_beacon_alloc(sc, vif);
1449
		if (!error)
1450 1451
			ath_beacon_config(sc, vif);
	}
1452 1453
}

1454 1455 1456

static int ath9k_add_interface(struct ieee80211_hw *hw,
			       struct ieee80211_vif *vif)
1457
{
1458
	struct ath_softc *sc = hw->priv;
1459 1460
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1461
	struct ath_vif *avp = (void *)vif->drv_priv;
1462
	int ret = 0;
1463

1464
	mutex_lock(&sc->mutex);
1465

1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478
	switch (vif->type) {
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_WDS:
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_MESH_POINT:
		break;
	default:
		ath_err(common, "Interface type %d not yet supported\n",
			vif->type);
		ret = -EOPNOTSUPP;
		goto out;
	}
1479

1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495
	if (ath9k_uses_beacons(vif->type)) {
		if (sc->nbcnvifs >= ATH_BCBUF) {
			ath_err(common, "Not enough beacon buffers when adding"
				" new interface of type: %i\n",
				vif->type);
			ret = -ENOBUFS;
			goto out;
		}
	}

	if ((vif->type == NL80211_IFTYPE_ADHOC) &&
	    sc->nvifs > 0) {
		ath_err(common, "Cannot create ADHOC interface when other"
			" interfaces already exist.\n");
		ret = -EINVAL;
		goto out;
1496
	}
1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510

	ath_dbg(common, ATH_DBG_CONFIG,
		"Attach a VIF of type: %d\n", vif->type);

	/* Set the VIF opmode */
	avp->av_opmode = vif->type;
	avp->av_bslot = -1;

	sc->nvifs++;

	ath9k_do_vif_add_setup(hw, vif);
out:
	mutex_unlock(&sc->mutex);
	return ret;
1511 1512 1513 1514 1515 1516 1517
}

static int ath9k_change_interface(struct ieee80211_hw *hw,
				  struct ieee80211_vif *vif,
				  enum nl80211_iftype new_type,
				  bool p2p)
{
1518
	struct ath_softc *sc = hw->priv;
1519
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1520
	int ret = 0;
1521 1522 1523 1524

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

1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
	/* See if new interface type is valid. */
	if ((new_type == NL80211_IFTYPE_ADHOC) &&
	    (sc->nvifs > 1)) {
		ath_err(common, "When using ADHOC, it must be the only"
			" interface.\n");
		ret = -EINVAL;
		goto out;
	}

	if (ath9k_uses_beacons(new_type) &&
	    !ath9k_uses_beacons(vif->type)) {
1536 1537
		if (sc->nbcnvifs >= ATH_BCBUF) {
			ath_err(common, "No beacon slot available\n");
1538 1539
			ret = -ENOBUFS;
			goto out;
1540 1541
		}
	}
1542 1543 1544 1545 1546 1547

	/* Clean up old vif stuff */
	if (ath9k_uses_beacons(vif->type))
		ath9k_reclaim_beacon(sc, vif);

	/* Add new settings */
1548 1549 1550
	vif->type = new_type;
	vif->p2p = p2p;

1551
	ath9k_do_vif_add_setup(hw, vif);
1552
out:
1553
	mutex_unlock(&sc->mutex);
1554
	return ret;
1555 1556
}

1557
static void ath9k_remove_interface(struct ieee80211_hw *hw,
1558
				   struct ieee80211_vif *vif)
1559
{
1560
	struct ath_softc *sc = hw->priv;
1561
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1562

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

1565 1566
	mutex_lock(&sc->mutex);

1567
	sc->nvifs--;
J
Jouni Malinen 已提交
1568

1569
	/* Reclaim beacon resources */
1570
	if (ath9k_uses_beacons(vif->type))
1571
		ath9k_reclaim_beacon(sc, vif);
1572

1573
	ath9k_calculate_summary_state(hw, NULL);
1574 1575

	mutex_unlock(&sc->mutex);
1576 1577
}

1578
static void ath9k_enable_ps(struct ath_softc *sc)
1579
{
P
Pavel Roskin 已提交
1580 1581
	struct ath_hw *ah = sc->sc_ah;

1582
	sc->ps_enabled = true;
P
Pavel Roskin 已提交
1583 1584 1585 1586
	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);
1587
		}
1588
		ath9k_hw_setrxabort(ah, 1);
1589 1590 1591
	}
}

1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611
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);
		}
	}

}

1612
static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
1613
{
1614
	struct ath_softc *sc = hw->priv;
1615 1616
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1617
	struct ieee80211_conf *conf = &hw->conf;
1618
	bool disable_radio = false;
1619

1620
	mutex_lock(&sc->mutex);
1621

1622 1623 1624 1625 1626 1627
	/*
	 * 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.
	 */
1628
	if (changed & IEEE80211_CONF_CHANGE_IDLE) {
1629 1630
		sc->ps_idle = !!(conf->flags & IEEE80211_CONF_IDLE);
		if (!sc->ps_idle) {
1631
			ath_radio_enable(sc, hw);
J
Joe Perches 已提交
1632 1633
			ath_dbg(common, ATH_DBG_CONFIG,
				"not-idle: enabling radio\n");
1634 1635
		} else {
			disable_radio = true;
1636 1637 1638
		}
	}

1639 1640 1641 1642 1643 1644
	/*
	 * 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.
	 */
1645
	if (changed & IEEE80211_CONF_CHANGE_PS) {
1646 1647
		unsigned long flags;
		spin_lock_irqsave(&sc->sc_pm_lock, flags);
1648 1649
		if (conf->flags & IEEE80211_CONF_PS)
			ath9k_enable_ps(sc);
1650 1651
		else
			ath9k_disable_ps(sc);
1652
		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1653 1654
	}

S
Sujith 已提交
1655 1656
	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
		if (conf->flags & IEEE80211_CONF_MONITOR) {
J
Joe Perches 已提交
1657 1658
			ath_dbg(common, ATH_DBG_CONFIG,
				"Monitor mode is enabled\n");
1659 1660
			sc->sc_ah->is_monitoring = true;
		} else {
J
Joe Perches 已提交
1661 1662
			ath_dbg(common, ATH_DBG_CONFIG,
				"Monitor mode is disabled\n");
1663
			sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
1664 1665 1666
		}
	}

1667
	if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
1668
		struct ieee80211_channel *curchan = hw->conf.channel;
1669
		int pos = curchan->hw_value;
1670 1671 1672 1673 1674
		int old_pos = -1;
		unsigned long flags;

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

1676 1677 1678 1679
		if (hw->conf.flags & IEEE80211_CONF_OFFCHANNEL)
			sc->sc_flags |= SC_OP_OFFCHANNEL;
		else
			sc->sc_flags &= ~SC_OP_OFFCHANNEL;
1680

1681 1682 1683
		ath_dbg(common, ATH_DBG_CONFIG,
			"Set channel: %d MHz type: %d\n",
			curchan->center_freq, conf->channel_type);
1684

1685 1686
		ath9k_cmn_update_ichannel(&sc->sc_ah->channels[pos],
					  curchan, conf->channel_type);
1687

1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712
		/* 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));
		}

1713
		if (ath_set_channel(sc, hw, &sc->sc_ah->channels[pos]) < 0) {
1714
			ath_err(common, "Unable to set channel\n");
1715
			mutex_unlock(&sc->mutex);
1716 1717
			return -EINVAL;
		}
1718 1719 1720 1721 1722 1723 1724 1725

		/*
		 * 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 已提交
1726
	}
1727

1728
	if (changed & IEEE80211_CONF_CHANGE_POWER) {
S
Sujith 已提交
1729
		sc->config.txpowlimit = 2 * conf->power_level;
1730
		ath9k_ps_wakeup(sc);
1731 1732
		ath9k_cmn_update_txpow(ah, sc->curtxpow,
				       sc->config.txpowlimit, &sc->curtxpow);
1733
		ath9k_ps_restore(sc);
1734
	}
1735

1736
	if (disable_radio) {
J
Joe Perches 已提交
1737
		ath_dbg(common, ATH_DBG_CONFIG, "idle: disabling radio\n");
1738
		ath_radio_disable(sc, hw);
1739 1740
	}

1741
	mutex_unlock(&sc->mutex);
1742

1743 1744 1745
	return 0;
}

1746 1747 1748 1749
#define SUPPORTED_FILTERS			\
	(FIF_PROMISC_IN_BSS |			\
	FIF_ALLMULTI |				\
	FIF_CONTROL |				\
1750
	FIF_PSPOLL |				\
1751 1752
	FIF_OTHER_BSS |				\
	FIF_BCN_PRBRESP_PROMISC |		\
1753
	FIF_PROBE_REQ |				\
1754
	FIF_FCSFAIL)
1755

1756 1757 1758 1759
/* FIXME: sc->sc_full_reset ? */
static void ath9k_configure_filter(struct ieee80211_hw *hw,
				   unsigned int changed_flags,
				   unsigned int *total_flags,
1760
				   u64 multicast)
1761
{
1762
	struct ath_softc *sc = hw->priv;
1763
	u32 rfilt;
1764

1765 1766
	changed_flags &= SUPPORTED_FILTERS;
	*total_flags &= SUPPORTED_FILTERS;
1767

S
Sujith 已提交
1768
	sc->rx.rxfilter = *total_flags;
1769
	ath9k_ps_wakeup(sc);
1770 1771
	rfilt = ath_calcrxfilter(sc);
	ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1772
	ath9k_ps_restore(sc);
1773

J
Joe Perches 已提交
1774 1775
	ath_dbg(ath9k_hw_common(sc->sc_ah), ATH_DBG_CONFIG,
		"Set HW RX filter: 0x%x\n", rfilt);
1776
}
1777

1778 1779 1780
static int ath9k_sta_add(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta)
1781
{
1782
	struct ath_softc *sc = hw->priv;
1783

1784 1785 1786 1787 1788 1789 1790 1791 1792
	ath_node_attach(sc, sta);

	return 0;
}

static int ath9k_sta_remove(struct ieee80211_hw *hw,
			    struct ieee80211_vif *vif,
			    struct ieee80211_sta *sta)
{
1793
	struct ath_softc *sc = hw->priv;
1794 1795 1796 1797

	ath_node_detach(sc, sta);

	return 0;
1798 1799
}

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

1809 1810
	if (queue >= WME_NUM_AC)
		return 0;
1811

1812 1813
	txq = sc->tx.txq_map[queue];

1814 1815
	mutex_lock(&sc->mutex);

1816 1817
	memset(&qi, 0, sizeof(struct ath9k_tx_queue_info));

1818 1819 1820 1821
	qi.tqi_aifs = params->aifs;
	qi.tqi_cwmin = params->cw_min;
	qi.tqi_cwmax = params->cw_max;
	qi.tqi_burstTime = params->txop;
1822

J
Joe Perches 已提交
1823 1824 1825 1826
	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);
1827

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

1832
	if (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC)
1833
		if (queue == WME_AC_BE && !ret)
1834 1835
			ath_beaconq_config(sc);

1836 1837
	mutex_unlock(&sc->mutex);

1838 1839
	return ret;
}
1840

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

1851
	if (ath9k_modparam_nohwcrypt)
1852 1853
		return -ENOSPC;

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

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

1880
	ath9k_ps_restore(sc);
1881 1882
	mutex_unlock(&sc->mutex);

1883 1884
	return ret;
}
1885

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

1898 1899
	mutex_lock(&sc->mutex);

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

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

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

S
Sujith 已提交
1913 1914 1915
		/* need to reconfigure the beacon */
		sc->sc_flags &= ~SC_OP_BEACONS ;
	}
1916

S
Sujith 已提交
1917 1918 1919 1920
	/* 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);
1921
		error = ath_beacon_alloc(sc, vif);
S
Sujith 已提交
1922 1923
		if (!error)
			ath_beacon_config(sc, vif);
1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942
	}

	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);
		}
1943 1944
	}

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

S
Sujith 已提交
1949 1950 1951 1952 1953 1954 1955 1956 1957
	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);
1958
			error = ath_beacon_alloc(sc, vif);
1959 1960
			if (!error)
				ath_beacon_config(sc, vif);
S
Sujith 已提交
1961 1962
		} else {
			ath_beacon_config(sc, vif);
1963 1964 1965
		}
	}

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

1975
	if (changed & BSS_CHANGED_ERP_CTS_PROT) {
J
Joe Perches 已提交
1976 1977
		ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed CTS PROT %d\n",
			bss_conf->use_cts_prot);
1978 1979 1980 1981 1982 1983
		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;
	}
1984

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

	mutex_unlock(&sc->mutex);
1992
}
1993

1994 1995
static u64 ath9k_get_tsf(struct ieee80211_hw *hw)
{
1996
	struct ath_softc *sc = hw->priv;
1997
	u64 tsf;
1998

1999
	mutex_lock(&sc->mutex);
2000
	ath9k_ps_wakeup(sc);
2001
	tsf = ath9k_hw_gettsf64(sc->sc_ah);
2002
	ath9k_ps_restore(sc);
2003
	mutex_unlock(&sc->mutex);
2004

2005 2006
	return tsf;
}
2007

2008 2009
static void ath9k_set_tsf(struct ieee80211_hw *hw, u64 tsf)
{
2010
	struct ath_softc *sc = hw->priv;
2011

2012
	mutex_lock(&sc->mutex);
2013
	ath9k_ps_wakeup(sc);
2014
	ath9k_hw_settsf64(sc->sc_ah, tsf);
2015
	ath9k_ps_restore(sc);
2016
	mutex_unlock(&sc->mutex);
2017 2018
}

2019 2020
static void ath9k_reset_tsf(struct ieee80211_hw *hw)
{
2021
	struct ath_softc *sc = hw->priv;
2022

2023
	mutex_lock(&sc->mutex);
2024 2025

	ath9k_ps_wakeup(sc);
2026
	ath9k_hw_reset_tsf(sc->sc_ah);
2027 2028
	ath9k_ps_restore(sc);

2029
	mutex_unlock(&sc->mutex);
2030
}
2031

2032
static int ath9k_ampdu_action(struct ieee80211_hw *hw,
2033
			      struct ieee80211_vif *vif,
2034 2035
			      enum ieee80211_ampdu_mlme_action action,
			      struct ieee80211_sta *sta,
2036
			      u16 tid, u16 *ssn, u8 buf_size)
2037
{
2038
	struct ath_softc *sc = hw->priv;
2039
	int ret = 0;
2040

2041 2042
	local_bh_disable();

2043 2044
	switch (action) {
	case IEEE80211_AMPDU_RX_START:
2045 2046
		if (!(sc->sc_flags & SC_OP_RXAGGR))
			ret = -ENOTSUPP;
2047 2048 2049 2050
		break;
	case IEEE80211_AMPDU_RX_STOP:
		break;
	case IEEE80211_AMPDU_TX_START:
2051 2052 2053
		if (!(sc->sc_flags & SC_OP_TXAGGR))
			return -EOPNOTSUPP;

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

2075 2076
	local_bh_enable();

2077
	return ret;
2078 2079
}

2080 2081 2082
static int ath9k_get_survey(struct ieee80211_hw *hw, int idx,
			     struct survey_info *survey)
{
2083
	struct ath_softc *sc = hw->priv;
2084
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
2085
	struct ieee80211_supported_band *sband;
2086 2087 2088 2089 2090 2091 2092
	struct ieee80211_channel *chan;
	unsigned long flags;
	int pos;

	spin_lock_irqsave(&common->cc_lock, flags);
	if (idx == 0)
		ath_update_survey_stats(sc);
2093 2094 2095 2096 2097 2098

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

2100 2101
	if (!sband)
		sband = hw->wiphy->bands[IEEE80211_BAND_5GHZ];
2102

2103 2104 2105
	if (!sband || idx >= sband->n_channels) {
		spin_unlock_irqrestore(&common->cc_lock, flags);
		return -ENOENT;
2106
	}
2107

2108 2109 2110 2111 2112 2113
	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);

2114 2115 2116
	return 0;
}

2117 2118
static void ath9k_set_coverage_class(struct ieee80211_hw *hw, u8 coverage_class)
{
2119
	struct ath_softc *sc = hw->priv;
2120 2121 2122 2123 2124 2125 2126 2127
	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);
}

2128
struct ieee80211_ops ath9k_ops = {
2129 2130 2131 2132
	.tx 		    = ath9k_tx,
	.start 		    = ath9k_start,
	.stop 		    = ath9k_stop,
	.add_interface 	    = ath9k_add_interface,
2133
	.change_interface   = ath9k_change_interface,
2134 2135 2136
	.remove_interface   = ath9k_remove_interface,
	.config 	    = ath9k_config,
	.configure_filter   = ath9k_configure_filter,
2137 2138
	.sta_add	    = ath9k_sta_add,
	.sta_remove	    = ath9k_sta_remove,
2139 2140 2141 2142
	.conf_tx 	    = ath9k_conf_tx,
	.bss_info_changed   = ath9k_bss_info_changed,
	.set_key            = ath9k_set_key,
	.get_tsf 	    = ath9k_get_tsf,
2143
	.set_tsf 	    = ath9k_set_tsf,
2144
	.reset_tsf 	    = ath9k_reset_tsf,
2145
	.ampdu_action       = ath9k_ampdu_action,
2146
	.get_survey	    = ath9k_get_survey,
J
Johannes Berg 已提交
2147
	.rfkill_poll        = ath9k_rfkill_poll_state,
2148
	.set_coverage_class = ath9k_set_coverage_class,
2149
};