main.c 54.1 KB
Newer Older
1
/*
2
 * Copyright (c) 2008-2011 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>
18
#include <linux/delay.h>
S
Sujith 已提交
19
#include "ath9k.h"
20
#include "btcoex.h"
21

22 23 24
static void ath9k_set_assoc_state(struct ath_softc *sc,
				  struct ieee80211_vif *vif);

25
u8 ath9k_parse_mpdudensity(u8 mpdudensity)
S
Sujith 已提交
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 56 57 58 59
{
	/*
	 * 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;
	}
}

60 61 62 63 64 65 66 67 68 69 70 71 72
static bool ath9k_has_pending_frames(struct ath_softc *sc, struct ath_txq *txq)
{
	bool pending = false;

	spin_lock_bh(&txq->axq_lock);

	if (txq->axq_depth || !list_empty(&txq->axq_acq))
		pending = true;

	spin_unlock_bh(&txq->axq_lock);
	return pending;
}

73
static bool ath9k_setpower(struct ath_softc *sc, enum ath9k_power_mode mode)
74 75 76 77
{
	unsigned long flags;
	bool ret;

78 79 80
	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	ret = ath9k_hw_setpower(sc->sc_ah, mode);
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
81 82 83 84

	return ret;
}

85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100
void ath_ps_full_sleep(unsigned long data)
{
	struct ath_softc *sc = (struct ath_softc *) data;
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	bool reset;

	spin_lock(&common->cc_lock);
	ath_hw_cycle_counters_update(common);
	spin_unlock(&common->cc_lock);

	ath9k_hw_setrxabort(sc->sc_ah, 1);
	ath9k_hw_stopdmarecv(sc->sc_ah, &reset);

	ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_FULL_SLEEP);
}

101 102
void ath9k_ps_wakeup(struct ath_softc *sc)
{
103
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
104
	unsigned long flags;
105
	enum ath9k_power_mode power_mode;
106 107 108 109 110

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

111
	del_timer_sync(&sc->sleep_timer);
112
	power_mode = sc->sc_ah->power_mode;
113
	ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
114

115 116 117 118 119
	/*
	 * 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.
	 */
120 121 122 123
	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));
124
		memset(&common->cc_ani, 0, sizeof(common->cc_ani));
125 126
		spin_unlock(&common->cc_lock);
	}
127

128 129 130 131 132 133
 unlock:
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
}

void ath9k_ps_restore(struct ath_softc *sc)
{
134
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
F
Felix Fietkau 已提交
135
	enum ath9k_power_mode mode;
136 137 138 139 140 141
	unsigned long flags;

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

S
Sujith Manoharan 已提交
142
	if (sc->ps_idle) {
143 144 145 146 147
		mod_timer(&sc->sleep_timer, jiffies + HZ / 10);
		goto unlock;
	}

	if (sc->ps_enabled &&
S
Sujith Manoharan 已提交
148 149 150
		   !(sc->ps_flags & (PS_WAIT_FOR_BEACON |
				     PS_WAIT_FOR_CAB |
				     PS_WAIT_FOR_PSPOLL_DATA |
151 152
				     PS_WAIT_FOR_TX_ACK |
				     PS_WAIT_FOR_ANI))) {
F
Felix Fietkau 已提交
153
		mode = ATH9K_PM_NETWORK_SLEEP;
154 155
		if (ath9k_hw_btcoex_is_enabled(sc->sc_ah))
			ath9k_btcoex_stop_gen_timer(sc);
S
Sujith Manoharan 已提交
156
	} else {
F
Felix Fietkau 已提交
157
		goto unlock;
S
Sujith Manoharan 已提交
158
	}
F
Felix Fietkau 已提交
159 160 161 162 163

	spin_lock(&common->cc_lock);
	ath_hw_cycle_counters_update(common);
	spin_unlock(&common->cc_lock);

164
	ath9k_hw_setpower(sc->sc_ah, mode);
165 166 167 168 169

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

170
static void __ath_cancel_work(struct ath_softc *sc)
S
Sujith 已提交
171
{
172 173
	cancel_work_sync(&sc->paprd_work);
	cancel_delayed_work_sync(&sc->tx_complete_work);
174
	cancel_delayed_work_sync(&sc->hw_pll_work);
S
Sujith Manoharan 已提交
175

176
#ifdef CONFIG_ATH9K_BTCOEX_SUPPORT
S
Sujith Manoharan 已提交
177 178
	if (ath9k_hw_mci_is_enabled(sc->sc_ah))
		cancel_work_sync(&sc->mci_work);
179
#endif
180
}
181

S
Sujith Manoharan 已提交
182
void ath_cancel_work(struct ath_softc *sc)
183 184 185 186
{
	__ath_cancel_work(sc);
	cancel_work_sync(&sc->hw_reset_work);
}
187

S
Sujith Manoharan 已提交
188
void ath_restart_work(struct ath_softc *sc)
S
Sujith Manoharan 已提交
189 190 191
{
	ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);

192
	if (AR_SREV_9340(sc->sc_ah) || AR_SREV_9330(sc->sc_ah))
S
Sujith Manoharan 已提交
193 194 195
		ieee80211_queue_delayed_work(sc->hw, &sc->hw_pll_work,
				     msecs_to_jiffies(ATH_PLL_WORK_INTERVAL));

S
Sujith Manoharan 已提交
196
	ath_start_ani(sc);
S
Sujith Manoharan 已提交
197 198
}

199
static bool ath_prepare_reset(struct ath_softc *sc)
200 201
{
	struct ath_hw *ah = sc->sc_ah;
202
	bool ret = true;
203

204
	ieee80211_stop_queues(sc->hw);
S
Sujith Manoharan 已提交
205
	ath_stop_ani(sc);
206
	ath9k_hw_disable_interrupts(ah);
207

208
	if (!ath_drain_all_txq(sc))
209
		ret = false;
210

F
Felix Fietkau 已提交
211
	if (!ath_stoprecv(sc))
212 213
		ret = false;

214 215
	return ret;
}
S
Sujith 已提交
216

217 218 219 220
static bool ath_complete_reset(struct ath_softc *sc, bool start)
{
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
221
	unsigned long flags;
222
	int i;
223 224

	if (ath_startrecv(sc) != 0) {
225
		ath_err(common, "Unable to restart recv logic\n");
226
		return false;
227 228
	}

229 230
	ath9k_cmn_update_txpow(ah, sc->curtxpow,
			       sc->config.txpowlimit, &sc->curtxpow);
231

232
	clear_bit(ATH_OP_HW_RESET, &common->op_flags);
233
	ath9k_hw_set_interrupts(ah);
234
	ath9k_hw_enable_interrupts(ah);
235

236
	if (!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL) && start) {
237
		if (!test_bit(ATH_OP_BEACONS, &common->op_flags))
238 239 240
			goto work;

		if (ah->opmode == NL80211_IFTYPE_STATION &&
241
		    test_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags)) {
242 243 244
			spin_lock_irqsave(&sc->sc_pm_lock, flags);
			sc->ps_flags |= PS_BEACON_SYNC | PS_WAIT_FOR_BEACON;
			spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
245 246
		} else {
			ath9k_set_beacon(sc);
247 248
		}
	work:
S
Sujith Manoharan 已提交
249
		ath_restart_work(sc);
250 251 252 253 254 255 256 257 258

		for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
			if (!ATH_TXQ_SETUP(sc, i))
				continue;

			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);
		}
259 260
	}

S
Sujith Manoharan 已提交
261
	sc->gtt_cnt = 0;
262 263
	ieee80211_wake_queues(sc->hw);

264 265
	ath9k_p2p_ps_timer(sc);

266 267 268
	return true;
}

269
static int ath_reset_internal(struct ath_softc *sc, struct ath9k_channel *hchan)
270 271 272 273 274 275 276 277 278
{
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	struct ath9k_hw_cal_data *caldata = NULL;
	bool fastcc = true;
	int r;

	__ath_cancel_work(sc);

279
	tasklet_disable(&sc->intr_tq);
280
	spin_lock_bh(&sc->sc_pcu_lock);
281

282
	if (!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL)) {
283 284 285 286 287 288 289 290 291
		fastcc = false;
		caldata = &sc->caldata;
	}

	if (!hchan) {
		fastcc = false;
		hchan = ah->curchan;
	}

292
	if (!ath_prepare_reset(sc))
293 294
		fastcc = false;

295
	ath_dbg(common, CONFIG, "Reset to %u MHz, HT40: %d fastcc: %d\n",
296
		hchan->channel, IS_CHAN_HT40(hchan), fastcc);
297 298 299 300 301

	r = ath9k_hw_reset(ah, hchan, caldata, fastcc);
	if (r) {
		ath_err(common,
			"Unable to reset channel, reset status %d\n", r);
302 303 304 305

		ath9k_hw_enable_interrupts(ah);
		ath9k_queue_reset(sc, RESET_TYPE_BB_HANG);

306 307 308
		goto out;
	}

309 310 311 312
	if (ath9k_hw_mci_is_enabled(sc->sc_ah) &&
	    (sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL))
		ath9k_mci_set_txpower(sc, true, false);

313 314 315 316
	if (!ath_complete_reset(sc, true))
		r = -EIO;

out:
317
	spin_unlock_bh(&sc->sc_pcu_lock);
318 319
	tasklet_enable(&sc->intr_tq);

320 321 322 323 324 325 326 327 328
	return r;
}


/*
 * 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.
*/
329
static int ath_set_channel(struct ath_softc *sc, struct cfg80211_chan_def *chandef)
330
{
331 332 333 334 335 336 337 338
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	struct ieee80211_hw *hw = sc->hw;
	struct ath9k_channel *hchan;
	struct ieee80211_channel *chan = chandef->chan;
	bool offchannel;
	int pos = chan->hw_value;
	int old_pos = -1;
339 340
	int r;

341
	if (test_bit(ATH_OP_INVALID, &common->op_flags))
342 343
		return -EIO;

344 345 346 347 348 349 350 351 352
	offchannel = !!(hw->conf.flags & IEEE80211_CONF_OFFCHANNEL);

	if (ah->curchan)
		old_pos = ah->curchan - &ah->channels[0];

	ath_dbg(common, CONFIG, "Set channel: %d MHz width: %d\n",
		chan->center_freq, chandef->width);

	/* update survey stats for the old channel before switching */
S
Sujith Manoharan 已提交
353
	spin_lock_bh(&common->cc_lock);
354
	ath_update_survey_stats(sc);
S
Sujith Manoharan 已提交
355
	spin_unlock_bh(&common->cc_lock);
356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377

	ath9k_cmn_get_channel(hw, ah, chandef);

	/*
	 * 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 (!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));
	}

	hchan = &sc->sc_ah->channels[pos];
378
	r = ath_reset_internal(sc, hchan);
379 380
	if (r)
		return r;
381

382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406
	/*
	 * 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);

	/*
	 * Enable radar pulse detection if on a DFS channel. Spectral
	 * scanning and radar detection can not be used concurrently.
	 */
	if (hw->conf.radar_enabled) {
		u32 rxfilter;

		/* set HW specific DFS configuration */
		ath9k_hw_set_radar_params(ah);
		rxfilter = ath9k_hw_getrxfilter(ah);
		rxfilter |= ATH9K_RX_FILTER_PHYRADAR |
				ATH9K_RX_FILTER_PHYERR;
		ath9k_hw_setrxfilter(ah, rxfilter);
		ath_dbg(common, DFS, "DFS enabled at freq %d\n",
			chan->center_freq);
	} else {
		/* perform spectral scan if requested. */
407
		if (test_bit(ATH_OP_SCANNING, &common->op_flags) &&
408 409 410 411 412
			sc->spectral_mode == SPECTRAL_CHANSCAN)
			ath9k_spectral_scan_trigger(hw);
	}

	return 0;
S
Sujith 已提交
413 414
}

415 416
static void ath_node_attach(struct ath_softc *sc, struct ieee80211_sta *sta,
			    struct ieee80211_vif *vif)
S
Sujith 已提交
417 418 419 420
{
	struct ath_node *an;
	an = (struct ath_node *)sta->drv_priv;

421
	an->sc = sc;
422
	an->sta = sta;
423
	an->vif = vif;
424

425
	ath_tx_node_init(sc, an);
S
Sujith 已提交
426 427 428 429 430
}

static void ath_node_detach(struct ath_softc *sc, struct ieee80211_sta *sta)
{
	struct ath_node *an = (struct ath_node *)sta->drv_priv;
431
	ath_tx_node_cleanup(sc, an);
S
Sujith 已提交
432 433
}

S
Sujith 已提交
434
void ath9k_tasklet(unsigned long data)
S
Sujith 已提交
435 436
{
	struct ath_softc *sc = (struct ath_softc *)data;
437
	struct ath_hw *ah = sc->sc_ah;
438
	struct ath_common *common = ath9k_hw_common(ah);
439
	enum ath_reset_type type;
S
Sujith Manoharan 已提交
440
	unsigned long flags;
S
Sujith 已提交
441
	u32 status = sc->intrstatus;
F
Felix Fietkau 已提交
442
	u32 rxmask;
S
Sujith 已提交
443

444 445 446
	ath9k_ps_wakeup(sc);
	spin_lock(&sc->sc_pcu_lock);

447 448
	if (status & ATH9K_INT_FATAL) {
		type = RESET_TYPE_FATAL_INT;
449
		ath9k_queue_reset(sc, type);
450 451 452 453 454 455

		/*
		 * Increment the ref. counter here so that
		 * interrupts are enabled in the reset routine.
		 */
		atomic_inc(&ah->intr_ref_cnt);
456
		ath_dbg(common, RESET, "FATAL: Skipping interrupts\n");
457
		goto out;
S
Sujith 已提交
458
	}
S
Sujith 已提交
459

460 461
	if ((ah->config.hw_hang_checks & HW_BB_WATCHDOG) &&
	    (status & ATH9K_INT_BB_WATCHDOG)) {
462 463 464 465 466
		spin_lock(&common->cc_lock);
		ath_hw_cycle_counters_update(common);
		ar9003_hw_bb_watchdog_dbg_info(ah);
		spin_unlock(&common->cc_lock);

467 468 469 470 471 472 473 474 475
		if (ar9003_hw_bb_watchdog_check(ah)) {
			type = RESET_TYPE_BB_WATCHDOG;
			ath9k_queue_reset(sc, type);

			/*
			 * Increment the ref. counter here so that
			 * interrupts are enabled in the reset routine.
			 */
			atomic_inc(&ah->intr_ref_cnt);
476
			ath_dbg(common, RESET,
477 478 479 480 481
				"BB_WATCHDOG: Skipping interrupts\n");
			goto out;
		}
	}

S
Sujith Manoharan 已提交
482 483 484 485 486 487 488
	if (status & ATH9K_INT_GTT) {
		sc->gtt_cnt++;

		if ((sc->gtt_cnt >= MAX_GTT_CNT) && !ath9k_hw_check_alive(ah)) {
			type = RESET_TYPE_TX_GTT;
			ath9k_queue_reset(sc, type);
			atomic_inc(&ah->intr_ref_cnt);
489
			ath_dbg(common, RESET,
S
Sujith Manoharan 已提交
490 491 492 493 494
				"GTT: Skipping interrupts\n");
			goto out;
		}
	}

S
Sujith Manoharan 已提交
495
	spin_lock_irqsave(&sc->sc_pm_lock, flags);
496 497 498 499 500
	if ((status & ATH9K_INT_TSFOOR) && sc->ps_enabled) {
		/*
		 * TSF sync does not look correct; remain awake to sync with
		 * the next Beacon.
		 */
501
		ath_dbg(common, PS, "TSFOOR - Sync with next Beacon\n");
502
		sc->ps_flags |= PS_WAIT_FOR_BEACON | PS_BEACON_SYNC;
503
	}
S
Sujith Manoharan 已提交
504
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
505

F
Felix Fietkau 已提交
506 507 508 509 510 511 512 513 514 515 516 517 518
	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 已提交
519 520
	}

521
	if (status & ATH9K_INT_TX) {
S
Sujith Manoharan 已提交
522 523 524 525 526 527 528
		if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
			/*
			 * For EDMA chips, TX completion is enabled for the
			 * beacon queue, so if a beacon has been transmitted
			 * successfully after a GTT interrupt, the GTT counter
			 * gets reset to zero here.
			 */
S
Sujith Manoharan 已提交
529
			sc->gtt_cnt = 0;
S
Sujith Manoharan 已提交
530

531
			ath_tx_edma_tasklet(sc);
S
Sujith Manoharan 已提交
532
		} else {
533
			ath_tx_tasklet(sc);
S
Sujith Manoharan 已提交
534
		}
F
Felix Fietkau 已提交
535 536

		wake_up(&sc->tx_wait);
537
	}
S
Sujith 已提交
538

539 540 541
	if (status & ATH9K_INT_GENTIMER)
		ath_gen_timer_isr(sc->sc_ah);

542
	ath9k_btcoex_handle_interrupt(sc, status);
543

S
Sujith 已提交
544
	/* re-enable hardware interrupt */
545
	ath9k_hw_enable_interrupts(ah);
546
out:
547
	spin_unlock(&sc->sc_pcu_lock);
548
	ath9k_ps_restore(sc);
S
Sujith 已提交
549 550
}

551
irqreturn_t ath_isr(int irq, void *dev)
S
Sujith 已提交
552
{
S
Sujith 已提交
553 554
#define SCHED_INTR (				\
		ATH9K_INT_FATAL |		\
555
		ATH9K_INT_BB_WATCHDOG |		\
S
Sujith 已提交
556 557 558
		ATH9K_INT_RXORN |		\
		ATH9K_INT_RXEOL |		\
		ATH9K_INT_RX |			\
F
Felix Fietkau 已提交
559 560
		ATH9K_INT_RXLP |		\
		ATH9K_INT_RXHP |		\
S
Sujith 已提交
561 562 563
		ATH9K_INT_TX |			\
		ATH9K_INT_BMISS |		\
		ATH9K_INT_CST |			\
S
Sujith Manoharan 已提交
564
		ATH9K_INT_GTT |			\
565
		ATH9K_INT_TSFOOR |		\
566 567
		ATH9K_INT_GENTIMER |		\
		ATH9K_INT_MCI)
S
Sujith 已提交
568

S
Sujith 已提交
569
	struct ath_softc *sc = dev;
570
	struct ath_hw *ah = sc->sc_ah;
571
	struct ath_common *common = ath9k_hw_common(ah);
S
Sujith 已提交
572
	enum ath9k_int status;
573
	u32 sync_cause = 0;
S
Sujith 已提交
574 575
	bool sched = false;

S
Sujith 已提交
576 577 578 579 580
	/*
	 * The hardware is not ready/present, don't
	 * touch anything. Note this can happen early
	 * on if the IRQ is shared.
	 */
581
	if (test_bit(ATH_OP_INVALID, &common->op_flags))
S
Sujith 已提交
582
		return IRQ_NONE;
S
Sujith 已提交
583

S
Sujith 已提交
584 585
	/* shared irq, not for us */

586
	if (!ath9k_hw_intrpend(ah))
S
Sujith 已提交
587 588
		return IRQ_NONE;

589
	if (test_bit(ATH_OP_HW_RESET, &common->op_flags)) {
590
		ath9k_hw_kill_interrupts(ah);
591
		return IRQ_HANDLED;
592
	}
593

S
Sujith 已提交
594 595 596 597 598 599
	/*
	 * 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.
	 */
600 601
	ath9k_hw_getisr(ah, &status, &sync_cause); /* NB: clears ISR too */
	ath9k_debug_sync_cause(sc, sync_cause);
P
Pavel Roskin 已提交
602
	status &= ah->imask;	/* discard unasked-for bits */
S
Sujith 已提交
603

S
Sujith 已提交
604 605 606 607
	/*
	 * If there are no status bits set, then this interrupt was not
	 * for me (should have been caught above).
	 */
608
	if (!status)
S
Sujith 已提交
609
		return IRQ_NONE;
S
Sujith 已提交
610

S
Sujith 已提交
611 612 613 614 615 616 617 618 619 620
	/* 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 已提交
621 622
	if ((status & ATH9K_INT_FATAL) || ((status & ATH9K_INT_RXORN) &&
	    !(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)))
S
Sujith 已提交
623 624
		goto chip_reset;

625
	if ((ah->config.hw_hang_checks & HW_BB_WATCHDOG) &&
626
	    (status & ATH9K_INT_BB_WATCHDOG))
627
		goto chip_reset;
S
Sujith Manoharan 已提交
628 629

#ifdef CONFIG_ATH9K_WOW
630 631 632 633 634 635 636
	if (status & ATH9K_INT_BMISS) {
		if (atomic_read(&sc->wow_sleep_proc_intr) == 0) {
			atomic_inc(&sc->wow_got_bmiss_intr);
			atomic_dec(&sc->wow_sleep_proc_intr);
		}
	}
#endif
S
Sujith Manoharan 已提交
637

S
Sujith 已提交
638 639 640 641 642 643
	if (status & ATH9K_INT_SWBA)
		tasklet_schedule(&sc->bcon_tasklet);

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

644 645
	if (status & ATH9K_INT_RXEOL) {
		ah->imask &= ~(ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
646
		ath9k_hw_set_interrupts(ah);
F
Felix Fietkau 已提交
647 648
	}

649 650
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
		if (status & ATH9K_INT_TIM_TIMER) {
651 652
			if (ATH_DBG_WARN_ON_ONCE(sc->ps_idle))
				goto chip_reset;
S
Sujith 已提交
653 654
			/* Clear RxAbort bit so that we can
			 * receive frames */
655
			ath9k_setpower(sc, ATH9K_PM_AWAKE);
S
Sujith Manoharan 已提交
656
			spin_lock(&sc->sc_pm_lock);
657
			ath9k_hw_setrxabort(sc->sc_ah, 0);
S
Sujith 已提交
658
			sc->ps_flags |= PS_WAIT_FOR_BEACON;
S
Sujith Manoharan 已提交
659
			spin_unlock(&sc->sc_pm_lock);
S
Sujith 已提交
660
		}
S
Sujith 已提交
661 662

chip_reset:
S
Sujith 已提交
663

664 665
	ath_debug_stat_interrupt(sc, status);

S
Sujith 已提交
666
	if (sched) {
667 668
		/* turn off every interrupt */
		ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
669 670 671 672
		tasklet_schedule(&sc->intr_tq);
	}

	return IRQ_HANDLED;
S
Sujith 已提交
673 674

#undef SCHED_INTR
S
Sujith 已提交
675 676
}

677
int ath_reset(struct ath_softc *sc)
S
Sujith 已提交
678
{
679
	int r;
S
Sujith 已提交
680

681
	ath9k_ps_wakeup(sc);
682
	r = ath_reset_internal(sc, NULL);
683
	ath9k_ps_restore(sc);
S
Sujith 已提交
684

685
	return r;
S
Sujith 已提交
686 687
}

688 689
void ath9k_queue_reset(struct ath_softc *sc, enum ath_reset_type type)
{
690
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
691 692 693
#ifdef CONFIG_ATH9K_DEBUGFS
	RESET_STAT_INC(sc, type);
#endif
694
	set_bit(ATH_OP_HW_RESET, &common->op_flags);
695 696 697
	ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
}

698 699 700 701
void ath_reset_work(struct work_struct *work)
{
	struct ath_softc *sc = container_of(work, struct ath_softc, hw_reset_work);

702
	ath_reset(sc);
703 704
}

S
Sujith 已提交
705 706 707 708
/**********************/
/* mac80211 callbacks */
/**********************/

709
static int ath9k_start(struct ieee80211_hw *hw)
710
{
711
	struct ath_softc *sc = hw->priv;
712
	struct ath_hw *ah = sc->sc_ah;
713
	struct ath_common *common = ath9k_hw_common(ah);
714
	struct ieee80211_channel *curchan = hw->conf.chandef.chan;
S
Sujith 已提交
715
	struct ath9k_channel *init_channel;
716
	int r;
717

718
	ath_dbg(common, CONFIG,
J
Joe Perches 已提交
719 720
		"Starting driver with initial channel: %d MHz\n",
		curchan->center_freq);
721

722
	ath9k_ps_wakeup(sc);
723 724
	mutex_lock(&sc->mutex);

725
	init_channel = ath9k_cmn_get_channel(hw, ah, &hw->conf.chandef);
S
Sujith 已提交
726 727

	/* Reset SERDES registers */
728
	ath9k_hw_configpcipowersave(ah, false);
S
Sujith 已提交
729 730 731 732 733 734 735 736

	/*
	 * 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.
	 */
737
	spin_lock_bh(&sc->sc_pcu_lock);
F
Felix Fietkau 已提交
738 739 740

	atomic_set(&ah->intr_ref_cnt, -1);

741
	r = ath9k_hw_reset(ah, init_channel, ah->caldata, false);
742
	if (r) {
743 744 745
		ath_err(common,
			"Unable to reset hardware; reset status %d (freq %u MHz)\n",
			r, curchan->center_freq);
746
		ah->reset_power_on = false;
S
Sujith 已提交
747 748 749
	}

	/* Setup our intr mask. */
F
Felix Fietkau 已提交
750 751 752 753 754
	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)
755
		ah->imask |= ATH9K_INT_RXHP |
756
			     ATH9K_INT_RXLP;
F
Felix Fietkau 已提交
757 758
	else
		ah->imask |= ATH9K_INT_RX;
S
Sujith 已提交
759

760 761 762
	if (ah->config.hw_hang_checks & HW_BB_WATCHDOG)
		ah->imask |= ATH9K_INT_BB_WATCHDOG;

S
Sujith Manoharan 已提交
763 764 765 766 767 768
	/*
	 * Enable GTT interrupts only for AR9003/AR9004 chips
	 * for now.
	 */
	if (AR_SREV_9300_20_OR_LATER(ah))
		ah->imask |= ATH9K_INT_GTT;
S
Sujith 已提交
769

770
	if (ah->caps.hw_caps & ATH9K_HW_CAP_HT)
P
Pavel Roskin 已提交
771
		ah->imask |= ATH9K_INT_CST;
S
Sujith 已提交
772

773
	ath_mci_enable(sc);
774

775
	clear_bit(ATH_OP_INVALID, &common->op_flags);
776
	sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
777

778 779
	if (!ath_complete_reset(sc, false))
		ah->reset_power_on = false;
S
Sujith 已提交
780

F
Felix Fietkau 已提交
781 782 783 784 785 786 787 788 789 790 791 792
	if (ah->led_pin >= 0) {
		ath9k_hw_cfg_output(ah, ah->led_pin,
				    AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
		ath9k_hw_set_gpio(ah, ah->led_pin, 0);
	}

	/*
	 * Reset key cache to sane defaults (all entries cleared) instead of
	 * semi-random values after suspend/resume.
	 */
	ath9k_cmn_init_crypto(sc->sc_ah);

793 794
	ath9k_hw_reset_tsf(ah);

795
	spin_unlock_bh(&sc->sc_pcu_lock);
796

797 798
	mutex_unlock(&sc->mutex);

799 800
	ath9k_ps_restore(sc);

801
	return 0;
802 803
}

804 805 806
static void ath9k_tx(struct ieee80211_hw *hw,
		     struct ieee80211_tx_control *control,
		     struct sk_buff *skb)
807
{
808
	struct ath_softc *sc = hw->priv;
809
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
S
Sujith 已提交
810
	struct ath_tx_control txctl;
811
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
S
Sujith Manoharan 已提交
812
	unsigned long flags;
S
Sujith 已提交
813

814
	if (sc->ps_enabled) {
815 816 817 818 819 820 821
		/*
		 * 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)) {
822
			ath_dbg(common, PS,
J
Joe Perches 已提交
823
				"Add PM=1 for a TX frame while in PS mode\n");
824 825 826 827
			hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
		}
	}

S
Sujith Manoharan 已提交
828
	if (unlikely(sc->sc_ah->power_mode == ATH9K_PM_NETWORK_SLEEP)) {
829 830 831 832 833 834
		/*
		 * 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);
S
Sujith Manoharan 已提交
835
		spin_lock_irqsave(&sc->sc_pm_lock, flags);
836 837
		if (!(sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
			ath9k_hw_setrxabort(sc->sc_ah, 0);
838
		if (ieee80211_is_pspoll(hdr->frame_control)) {
839
			ath_dbg(common, PS,
J
Joe Perches 已提交
840
				"Sending PS-Poll to pick a buffered frame\n");
S
Sujith 已提交
841
			sc->ps_flags |= PS_WAIT_FOR_PSPOLL_DATA;
842
		} else {
843
			ath_dbg(common, PS, "Wake up to complete TX\n");
S
Sujith 已提交
844
			sc->ps_flags |= PS_WAIT_FOR_TX_ACK;
845 846 847
		}
		/*
		 * The actual restore operation will happen only after
S
Sujith Manoharan 已提交
848
		 * the ps_flags bit is cleared. We are just dropping
849 850
		 * the ps_usecount here.
		 */
S
Sujith Manoharan 已提交
851
		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
852 853 854
		ath9k_ps_restore(sc);
	}

S
Sujith Manoharan 已提交
855 856 857 858 859 860 861 862 863
	/*
	 * Cannot tx while the hardware is in full sleep, it first needs a full
	 * chip reset to recover from that
	 */
	if (unlikely(sc->sc_ah->power_mode == ATH9K_PM_FULL_SLEEP)) {
		ath_err(common, "TX while HW is in FULL_SLEEP mode\n");
		goto exit;
	}

S
Sujith 已提交
864
	memset(&txctl, 0, sizeof(struct ath_tx_control));
865
	txctl.txq = sc->tx.txq_map[skb_get_queue_mapping(skb)];
866
	txctl.sta = control->sta;
S
Sujith 已提交
867

868
	ath_dbg(common, XMIT, "transmitting packet, skb: %p\n", skb);
869

870
	if (ath_tx_start(hw, skb, &txctl) != 0) {
871
		ath_dbg(common, XMIT, "TX failed\n");
B
Ben Greear 已提交
872
		TX_STAT_INC(txctl.txq->axq_qnum, txfailed);
S
Sujith 已提交
873
		goto exit;
874 875
	}

876
	return;
S
Sujith 已提交
877
exit:
F
Felix Fietkau 已提交
878
	ieee80211_free_txskb(hw, skb);
879 880
}

881
static void ath9k_stop(struct ieee80211_hw *hw)
882
{
883
	struct ath_softc *sc = hw->priv;
884
	struct ath_hw *ah = sc->sc_ah;
885
	struct ath_common *common = ath9k_hw_common(ah);
F
Felix Fietkau 已提交
886
	bool prev_idle;
887

S
Sujith 已提交
888 889
	mutex_lock(&sc->mutex);

890
	ath_cancel_work(sc);
891

892
	if (test_bit(ATH_OP_INVALID, &common->op_flags)) {
893
		ath_dbg(common, ANY, "Device not present\n");
S
Sujith 已提交
894
		mutex_unlock(&sc->mutex);
S
Sujith 已提交
895 896
		return;
	}
897

898 899 900
	/* Ensure HW is awake when we try to shut it down. */
	ath9k_ps_wakeup(sc);

901 902
	spin_lock_bh(&sc->sc_pcu_lock);

903 904 905
	/* prevent tasklets to enable interrupts once we disable them */
	ah->imask &= ~ATH9K_INT_GLOBAL;

S
Sujith 已提交
906 907
	/* make sure h/w will not generate any interrupt
	 * before setting the invalid flag. */
908
	ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
909

F
Felix Fietkau 已提交
910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927
	spin_unlock_bh(&sc->sc_pcu_lock);

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

	prev_idle = sc->ps_idle;
	sc->ps_idle = true;

	spin_lock_bh(&sc->sc_pcu_lock);

	if (ah->led_pin >= 0) {
		ath9k_hw_set_gpio(ah, ah->led_pin, 1);
		ath9k_hw_cfg_gpio_input(ah, ah->led_pin);
	}

928
	ath_prepare_reset(sc);
S
Sujith 已提交
929

930 931 932 933 934
	if (sc->rx.frag) {
		dev_kfree_skb_any(sc->rx.frag);
		sc->rx.frag = NULL;
	}

F
Felix Fietkau 已提交
935
	if (!ah->curchan)
936
		ah->curchan = ath9k_cmn_get_channel(hw, ah, &hw->conf.chandef);
937

F
Felix Fietkau 已提交
938 939
	ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
	ath9k_hw_phy_disable(ah);
940

F
Felix Fietkau 已提交
941
	ath9k_hw_configpcipowersave(ah, true);
942

F
Felix Fietkau 已提交
943
	spin_unlock_bh(&sc->sc_pcu_lock);
944

F
Felix Fietkau 已提交
945
	ath9k_ps_restore(sc);
S
Sujith 已提交
946

947
	set_bit(ATH_OP_INVALID, &common->op_flags);
F
Felix Fietkau 已提交
948
	sc->ps_idle = prev_idle;
949

950 951
	mutex_unlock(&sc->mutex);

952
	ath_dbg(common, CONFIG, "Driver halt\n");
953 954
}

955
static bool ath9k_uses_beacons(int type)
956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971
{
	switch (type) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_MESH_POINT:
		return true;
	default:
		return false;
	}
}

static void ath9k_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
{
	struct ath9k_vif_iter_data *iter_data = data;
	int i;

972
	if (iter_data->has_hw_macaddr) {
973 974 975
		for (i = 0; i < ETH_ALEN; i++)
			iter_data->mask[i] &=
				~(iter_data->hw_macaddr[i] ^ mac[i]);
976 977 978 979
	} else {
		memcpy(iter_data->hw_macaddr, mac, ETH_ALEN);
		iter_data->has_hw_macaddr = true;
	}
980

981
	switch (vif->type) {
982 983
	case NL80211_IFTYPE_AP:
		iter_data->naps++;
984
		break;
985 986
	case NL80211_IFTYPE_STATION:
		iter_data->nstations++;
B
Bill Jordan 已提交
987
		break;
988
	case NL80211_IFTYPE_ADHOC:
989 990
		iter_data->nadhocs++;
		break;
991
	case NL80211_IFTYPE_MESH_POINT:
992 993 994 995
		iter_data->nmeshes++;
		break;
	case NL80211_IFTYPE_WDS:
		iter_data->nwds++;
996 997
		break;
	default:
998
		break;
999
	}
1000
}
1001

1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013
static void ath9k_sta_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
{
	struct ath_softc *sc = data;
	struct ath_vif *avp = (void *)vif->drv_priv;

	if (vif->type != NL80211_IFTYPE_STATION)
		return;

	if (avp->primary_sta_vif)
		ath9k_set_assoc_state(sc, vif);
}

1014 1015 1016 1017 1018
/* 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)
{
1019
	struct ath_softc *sc = hw->priv;
1020 1021
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1022

1023
	/*
1024 1025 1026
	 * Pick the MAC address of the first interface as the new hardware
	 * MAC address. The hardware will use it together with the BSSID mask
	 * when matching addresses.
1027 1028 1029
	 */
	memset(iter_data, 0, sizeof(*iter_data));
	memset(&iter_data->mask, 0xff, ETH_ALEN);
S
Sujith 已提交
1030

1031 1032 1033 1034
	if (vif)
		ath9k_vif_iter(iter_data, vif->addr, vif);

	/* Get list of all active MAC addresses */
1035 1036 1037
	ieee80211_iterate_active_interfaces_atomic(
		sc->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
		ath9k_vif_iter, iter_data);
1038 1039

	memcpy(common->macaddr, iter_data->hw_macaddr, ETH_ALEN);
1040
}
1041

1042 1043 1044 1045
/* Called with sc->mutex held. */
static void ath9k_calculate_summary_state(struct ieee80211_hw *hw,
					  struct ieee80211_vif *vif)
{
1046
	struct ath_softc *sc = hw->priv;
1047 1048 1049
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	struct ath9k_vif_iter_data iter_data;
1050
	enum nl80211_iftype old_opmode = ah->opmode;
1051

1052
	ath9k_calculate_iter_data(hw, vif, &iter_data);
1053

1054 1055 1056 1057
	memcpy(common->bssidmask, iter_data.mask, ETH_ALEN);
	ath_hw_setbssidmask(common);

	if (iter_data.naps > 0) {
1058
		ath9k_hw_set_tsfadjust(ah, true);
1059 1060
		ah->opmode = NL80211_IFTYPE_AP;
	} else {
1061
		ath9k_hw_set_tsfadjust(ah, false);
S
Sujith 已提交
1062

1063 1064 1065
		if (iter_data.nmeshes)
			ah->opmode = NL80211_IFTYPE_MESH_POINT;
		else if (iter_data.nwds)
1066 1067 1068 1069 1070 1071
			ah->opmode = NL80211_IFTYPE_AP;
		else if (iter_data.nadhocs)
			ah->opmode = NL80211_IFTYPE_ADHOC;
		else
			ah->opmode = NL80211_IFTYPE_STATION;
	}
S
Sujith 已提交
1072

1073 1074
	ath9k_hw_setopmode(ah);

1075
	if ((iter_data.nstations + iter_data.nadhocs + iter_data.nmeshes) > 0)
P
Pavel Roskin 已提交
1076
		ah->imask |= ATH9K_INT_TSFOOR;
1077
	else
1078
		ah->imask &= ~ATH9K_INT_TSFOOR;
1079

1080
	ath9k_hw_set_interrupts(ah);
1081 1082 1083 1084 1085 1086 1087

	/*
	 * If we are changing the opmode to STATION,
	 * a beacon sync needs to be done.
	 */
	if (ah->opmode == NL80211_IFTYPE_STATION &&
	    old_opmode == NL80211_IFTYPE_AP &&
1088
	    test_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags)) {
1089 1090 1091
		ieee80211_iterate_active_interfaces_atomic(
			sc->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
			ath9k_sta_vif_iter, sc);
1092
	}
1093
}
1094

1095 1096
static int ath9k_add_interface(struct ieee80211_hw *hw,
			       struct ieee80211_vif *vif)
1097
{
1098
	struct ath_softc *sc = hw->priv;
1099 1100
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1101 1102
	struct ath_vif *avp = (void *)vif->drv_priv;
	struct ath_node *an = &avp->mcast_node;
1103

1104
	mutex_lock(&sc->mutex);
1105

L
Luis R. Rodriguez 已提交
1106 1107 1108 1109 1110 1111 1112 1113
	if (config_enabled(CONFIG_ATH9K_TX99)) {
		if (sc->nvifs >= 1) {
			mutex_unlock(&sc->mutex);
			return -EOPNOTSUPP;
		}
		sc->tx99_vif = vif;
	}

1114
	ath_dbg(common, CONFIG, "Attach a VIF of type: %d\n", vif->type);
1115 1116
	sc->nvifs++;

1117
	ath9k_ps_wakeup(sc);
S
Sujith Manoharan 已提交
1118
	ath9k_calculate_summary_state(hw, vif);
1119 1120
	ath9k_ps_restore(sc);

S
Sujith Manoharan 已提交
1121 1122 1123
	if (ath9k_uses_beacons(vif->type))
		ath9k_beacon_assign_slot(sc, vif);

1124 1125
	avp->vif = vif;

1126 1127 1128 1129 1130 1131
	an->sc = sc;
	an->sta = NULL;
	an->vif = vif;
	an->no_ps_filter = true;
	ath_tx_node_init(sc, an);

1132
	mutex_unlock(&sc->mutex);
1133
	return 0;
1134 1135 1136 1137 1138 1139 1140
}

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

	mutex_lock(&sc->mutex);
1145

L
Luis R. Rodriguez 已提交
1146 1147 1148 1149 1150 1151 1152
	if (config_enabled(CONFIG_ATH9K_TX99)) {
		mutex_unlock(&sc->mutex);
		return -EOPNOTSUPP;
	}

	ath_dbg(common, CONFIG, "Change Interface\n");

1153
	if (ath9k_uses_beacons(vif->type))
S
Sujith Manoharan 已提交
1154
		ath9k_beacon_remove_slot(sc, vif);
1155

1156 1157 1158
	vif->type = new_type;
	vif->p2p = p2p;

1159
	ath9k_ps_wakeup(sc);
S
Sujith Manoharan 已提交
1160
	ath9k_calculate_summary_state(hw, vif);
1161 1162
	ath9k_ps_restore(sc);

S
Sujith Manoharan 已提交
1163 1164 1165
	if (ath9k_uses_beacons(vif->type))
		ath9k_beacon_assign_slot(sc, vif);

1166
	mutex_unlock(&sc->mutex);
1167
	return 0;
1168 1169
}

1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192
static void
ath9k_update_p2p_ps_timer(struct ath_softc *sc, struct ath_vif *avp)
{
	struct ath_hw *ah = sc->sc_ah;
	s32 tsf, target_tsf;

	if (!avp || !avp->noa.has_next_tsf)
		return;

	ath9k_hw_gen_timer_stop(ah, sc->p2p_ps_timer);

	tsf = ath9k_hw_gettsf32(sc->sc_ah);

	target_tsf = avp->noa.next_tsf;
	if (!avp->noa.absent)
		target_tsf -= ATH_P2P_PS_STOP_TIME;

	if (target_tsf - tsf < ATH_P2P_PS_STOP_TIME)
		target_tsf = tsf + ATH_P2P_PS_STOP_TIME;

	ath9k_hw_gen_timer_start(ah, sc->p2p_ps_timer, (u32) target_tsf, 1000000);
}

1193
static void ath9k_remove_interface(struct ieee80211_hw *hw,
1194
				   struct ieee80211_vif *vif)
1195
{
1196
	struct ath_softc *sc = hw->priv;
1197
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1198
	struct ath_vif *avp = (void *)vif->drv_priv;
1199

1200
	ath_dbg(common, CONFIG, "Detach Interface\n");
1201

1202 1203
	mutex_lock(&sc->mutex);

1204 1205 1206 1207 1208 1209 1210
	spin_lock_bh(&sc->sc_pcu_lock);
	if (avp == sc->p2p_ps_vif) {
		sc->p2p_ps_vif = NULL;
		ath9k_update_p2p_ps_timer(sc, NULL);
	}
	spin_unlock_bh(&sc->sc_pcu_lock);

1211
	sc->nvifs--;
L
Luis R. Rodriguez 已提交
1212
	sc->tx99_vif = NULL;
J
Jouni Malinen 已提交
1213

1214
	if (ath9k_uses_beacons(vif->type))
S
Sujith Manoharan 已提交
1215
		ath9k_beacon_remove_slot(sc, vif);
1216

1217
	ath9k_ps_wakeup(sc);
1218
	ath9k_calculate_summary_state(hw, NULL);
1219
	ath9k_ps_restore(sc);
1220

1221 1222
	ath_tx_node_cleanup(sc, &avp->mcast_node);

1223
	mutex_unlock(&sc->mutex);
1224 1225
}

1226
static void ath9k_enable_ps(struct ath_softc *sc)
1227
{
P
Pavel Roskin 已提交
1228
	struct ath_hw *ah = sc->sc_ah;
S
Sujith Manoharan 已提交
1229
	struct ath_common *common = ath9k_hw_common(ah);
P
Pavel Roskin 已提交
1230

L
Luis R. Rodriguez 已提交
1231 1232 1233
	if (config_enabled(CONFIG_ATH9K_TX99))
		return;

1234
	sc->ps_enabled = true;
P
Pavel Roskin 已提交
1235 1236 1237
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
		if ((ah->imask & ATH9K_INT_TIM_TIMER) == 0) {
			ah->imask |= ATH9K_INT_TIM_TIMER;
1238
			ath9k_hw_set_interrupts(ah);
1239
		}
1240
		ath9k_hw_setrxabort(ah, 1);
1241
	}
S
Sujith Manoharan 已提交
1242
	ath_dbg(common, PS, "PowerSave enabled\n");
1243 1244
}

1245 1246 1247
static void ath9k_disable_ps(struct ath_softc *sc)
{
	struct ath_hw *ah = sc->sc_ah;
S
Sujith Manoharan 已提交
1248
	struct ath_common *common = ath9k_hw_common(ah);
1249

L
Luis R. Rodriguez 已提交
1250 1251 1252
	if (config_enabled(CONFIG_ATH9K_TX99))
		return;

1253 1254 1255 1256 1257 1258 1259 1260 1261 1262
	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;
1263
			ath9k_hw_set_interrupts(ah);
1264 1265
		}
	}
S
Sujith Manoharan 已提交
1266
	ath_dbg(common, PS, "PowerSave disabled\n");
1267 1268
}

1269 1270 1271 1272 1273 1274 1275
void ath9k_spectral_scan_trigger(struct ieee80211_hw *hw)
{
	struct ath_softc *sc = hw->priv;
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	u32 rxfilter;

L
Luis R. Rodriguez 已提交
1276 1277 1278
	if (config_enabled(CONFIG_ATH9K_TX99))
		return;

1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313
	if (!ath9k_hw_ops(ah)->spectral_scan_trigger) {
		ath_err(common, "spectrum analyzer not implemented on this hardware\n");
		return;
	}

	ath9k_ps_wakeup(sc);
	rxfilter = ath9k_hw_getrxfilter(ah);
	ath9k_hw_setrxfilter(ah, rxfilter |
				 ATH9K_RX_FILTER_PHYRADAR |
				 ATH9K_RX_FILTER_PHYERR);

	/* TODO: usually this should not be neccesary, but for some reason
	 * (or in some mode?) the trigger must be called after the
	 * configuration, otherwise the register will have its values reset
	 * (on my ar9220 to value 0x01002310)
	 */
	ath9k_spectral_scan_config(hw, sc->spectral_mode);
	ath9k_hw_ops(ah)->spectral_scan_trigger(ah);
	ath9k_ps_restore(sc);
}

int ath9k_spectral_scan_config(struct ieee80211_hw *hw,
			       enum spectral_mode spectral_mode)
{
	struct ath_softc *sc = hw->priv;
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);

	if (!ath9k_hw_ops(ah)->spectral_scan_trigger) {
		ath_err(common, "spectrum analyzer not implemented on this hardware\n");
		return -1;
	}

	switch (spectral_mode) {
	case SPECTRAL_DISABLED:
1314
		sc->spec_config.enabled = 0;
1315 1316 1317 1318 1319
		break;
	case SPECTRAL_BACKGROUND:
		/* send endless samples.
		 * TODO: is this really useful for "background"?
		 */
1320 1321
		sc->spec_config.endless = 1;
		sc->spec_config.enabled = 1;
1322 1323 1324
		break;
	case SPECTRAL_CHANSCAN:
	case SPECTRAL_MANUAL:
1325 1326
		sc->spec_config.endless = 0;
		sc->spec_config.enabled = 1;
1327 1328 1329 1330 1331 1332
		break;
	default:
		return -1;
	}

	ath9k_ps_wakeup(sc);
1333
	ath9k_hw_ops(ah)->spectral_scan_config(ah, &sc->spec_config);
1334 1335 1336 1337 1338 1339 1340
	ath9k_ps_restore(sc);

	sc->spectral_mode = spectral_mode;

	return 0;
}

1341
static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
1342
{
1343
	struct ath_softc *sc = hw->priv;
1344 1345
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1346
	struct ieee80211_conf *conf = &hw->conf;
1347
	bool reset_channel = false;
1348

F
Felix Fietkau 已提交
1349
	ath9k_ps_wakeup(sc);
1350
	mutex_lock(&sc->mutex);
1351

1352
	if (changed & IEEE80211_CONF_CHANGE_IDLE) {
1353
		sc->ps_idle = !!(conf->flags & IEEE80211_CONF_IDLE);
1354
		if (sc->ps_idle) {
1355
			ath_cancel_work(sc);
1356 1357 1358
			ath9k_stop_btcoex(sc);
		} else {
			ath9k_start_btcoex(sc);
1359 1360 1361 1362 1363
			/*
			 * The chip needs a reset to properly wake up from
			 * full sleep
			 */
			reset_channel = ah->chip_fullsleep;
1364
		}
1365
	}
1366

1367 1368 1369 1370 1371 1372
	/*
	 * 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.
	 */
1373
	if (changed & IEEE80211_CONF_CHANGE_PS) {
1374 1375
		unsigned long flags;
		spin_lock_irqsave(&sc->sc_pm_lock, flags);
1376 1377
		if (conf->flags & IEEE80211_CONF_PS)
			ath9k_enable_ps(sc);
1378 1379
		else
			ath9k_disable_ps(sc);
1380
		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1381 1382
	}

S
Sujith 已提交
1383 1384
	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
		if (conf->flags & IEEE80211_CONF_MONITOR) {
1385
			ath_dbg(common, CONFIG, "Monitor mode is enabled\n");
1386 1387
			sc->sc_ah->is_monitoring = true;
		} else {
1388
			ath_dbg(common, CONFIG, "Monitor mode is disabled\n");
1389
			sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
1390 1391 1392
		}
	}

1393
	if ((changed & IEEE80211_CONF_CHANGE_CHANNEL) || reset_channel) {
1394
		if (ath_set_channel(sc, &hw->conf.chandef) < 0) {
1395
			ath_err(common, "Unable to set channel\n");
1396
			mutex_unlock(&sc->mutex);
1397
			ath9k_ps_restore(sc);
1398 1399
			return -EINVAL;
		}
S
Sujith 已提交
1400
	}
1401

1402
	if (changed & IEEE80211_CONF_CHANGE_POWER) {
1403
		ath_dbg(common, CONFIG, "Set power: %d\n", conf->power_level);
S
Sujith 已提交
1404
		sc->config.txpowlimit = 2 * conf->power_level;
1405 1406
		ath9k_cmn_update_txpow(ah, sc->curtxpow,
				       sc->config.txpowlimit, &sc->curtxpow);
1407 1408
	}

1409
	mutex_unlock(&sc->mutex);
F
Felix Fietkau 已提交
1410
	ath9k_ps_restore(sc);
1411

1412 1413 1414
	return 0;
}

1415 1416 1417 1418
#define SUPPORTED_FILTERS			\
	(FIF_PROMISC_IN_BSS |			\
	FIF_ALLMULTI |				\
	FIF_CONTROL |				\
1419
	FIF_PSPOLL |				\
1420 1421
	FIF_OTHER_BSS |				\
	FIF_BCN_PRBRESP_PROMISC |		\
1422
	FIF_PROBE_REQ |				\
1423
	FIF_FCSFAIL)
1424

1425 1426 1427 1428
/* FIXME: sc->sc_full_reset ? */
static void ath9k_configure_filter(struct ieee80211_hw *hw,
				   unsigned int changed_flags,
				   unsigned int *total_flags,
1429
				   u64 multicast)
1430
{
1431
	struct ath_softc *sc = hw->priv;
1432
	u32 rfilt;
1433

1434 1435
	changed_flags &= SUPPORTED_FILTERS;
	*total_flags &= SUPPORTED_FILTERS;
1436

S
Sujith 已提交
1437
	sc->rx.rxfilter = *total_flags;
1438
	ath9k_ps_wakeup(sc);
1439 1440
	rfilt = ath_calcrxfilter(sc);
	ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1441
	ath9k_ps_restore(sc);
1442

1443 1444
	ath_dbg(ath9k_hw_common(sc->sc_ah), CONFIG, "Set HW RX filter: 0x%x\n",
		rfilt);
1445
}
1446

1447 1448 1449
static int ath9k_sta_add(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta)
1450
{
1451
	struct ath_softc *sc = hw->priv;
1452 1453 1454
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	struct ath_node *an = (struct ath_node *) sta->drv_priv;
	struct ieee80211_key_conf ps_key = { };
1455
	int key;
1456

1457
	ath_node_attach(sc, sta, vif);
1458 1459 1460 1461 1462

	if (vif->type != NL80211_IFTYPE_AP &&
	    vif->type != NL80211_IFTYPE_AP_VLAN)
		return 0;

1463 1464 1465
	key = ath_key_config(common, vif, sta, &ps_key);
	if (key > 0)
		an->ps_key = key;
1466 1467 1468 1469

	return 0;
}

1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481
static void ath9k_del_ps_key(struct ath_softc *sc,
			     struct ieee80211_vif *vif,
			     struct ieee80211_sta *sta)
{
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	struct ath_node *an = (struct ath_node *) sta->drv_priv;
	struct ieee80211_key_conf ps_key = { .hw_key_idx = an->ps_key };

	if (!an->ps_key)
	    return;

	ath_key_delete(common, &ps_key);
1482
	an->ps_key = 0;
1483 1484
}

1485 1486 1487 1488
static int ath9k_sta_remove(struct ieee80211_hw *hw,
			    struct ieee80211_vif *vif,
			    struct ieee80211_sta *sta)
{
1489
	struct ath_softc *sc = hw->priv;
1490

1491
	ath9k_del_ps_key(sc, vif, sta);
1492 1493 1494
	ath_node_detach(sc, sta);

	return 0;
1495 1496
}

1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507
static void ath9k_sta_notify(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif,
			 enum sta_notify_cmd cmd,
			 struct ieee80211_sta *sta)
{
	struct ath_softc *sc = hw->priv;
	struct ath_node *an = (struct ath_node *) sta->drv_priv;

	switch (cmd) {
	case STA_NOTIFY_SLEEP:
		an->sleeping = true;
1508
		ath_tx_aggr_sleep(sta, sc, an);
1509 1510
		if (an->ps_key > 0)
			ath9k_hw_set_tx_filter(sc->sc_ah, an->ps_key, true);
1511 1512
		break;
	case STA_NOTIFY_AWAKE:
1513 1514
		if (an->ps_key > 0)
			ath9k_hw_set_tx_filter(sc->sc_ah, an->ps_key, false);
1515 1516 1517 1518 1519 1520
		an->sleeping = false;
		ath_tx_aggr_wakeup(sc, an);
		break;
	}
}

1521 1522
static int ath9k_conf_tx(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif, u16 queue,
1523
			 const struct ieee80211_tx_queue_params *params)
1524
{
1525
	struct ath_softc *sc = hw->priv;
1526
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1527
	struct ath_txq *txq;
1528
	struct ath9k_tx_queue_info qi;
1529
	int ret = 0;
1530

1531
	if (queue >= IEEE80211_NUM_ACS)
1532
		return 0;
1533

1534 1535
	txq = sc->tx.txq_map[queue];

1536
	ath9k_ps_wakeup(sc);
1537 1538
	mutex_lock(&sc->mutex);

1539 1540
	memset(&qi, 0, sizeof(struct ath9k_tx_queue_info));

1541 1542 1543
	qi.tqi_aifs = params->aifs;
	qi.tqi_cwmin = params->cw_min;
	qi.tqi_cwmax = params->cw_max;
1544
	qi.tqi_burstTime = params->txop * 32;
1545

1546
	ath_dbg(common, CONFIG,
J
Joe Perches 已提交
1547 1548 1549
		"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);
1550

1551
	ath_update_max_aggr_framelen(sc, queue, qi.tqi_burstTime);
1552
	ret = ath_txq_update(sc, txq->axq_qnum, &qi);
1553
	if (ret)
1554
		ath_err(common, "TXQ Update failed\n");
1555

1556
	mutex_unlock(&sc->mutex);
1557
	ath9k_ps_restore(sc);
1558

1559 1560
	return ret;
}
1561

1562 1563
static int ath9k_set_key(struct ieee80211_hw *hw,
			 enum set_key_cmd cmd,
1564 1565
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta,
1566 1567
			 struct ieee80211_key_conf *key)
{
1568
	struct ath_softc *sc = hw->priv;
1569
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1570
	int ret = 0;
1571

1572
	if (ath9k_modparam_nohwcrypt)
1573 1574
		return -ENOSPC;

C
Chun-Yeow Yeoh 已提交
1575 1576
	if ((vif->type == NL80211_IFTYPE_ADHOC ||
	     vif->type == NL80211_IFTYPE_MESH_POINT) &&
J
Jouni Malinen 已提交
1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589
	    (key->cipher == WLAN_CIPHER_SUITE_TKIP ||
	     key->cipher == WLAN_CIPHER_SUITE_CCMP) &&
	    !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
		/*
		 * For now, disable hw crypto for the RSN IBSS group keys. This
		 * could be optimized in the future to use a modified key cache
		 * design to support per-STA RX GTK, but until that gets
		 * implemented, use of software crypto for group addressed
		 * frames is a acceptable to allow RSN IBSS to be used.
		 */
		return -EOPNOTSUPP;
	}

1590
	mutex_lock(&sc->mutex);
1591
	ath9k_ps_wakeup(sc);
1592
	ath_dbg(common, CONFIG, "Set HW Key\n");
1593

1594 1595
	switch (cmd) {
	case SET_KEY:
1596 1597 1598
		if (sta)
			ath9k_del_ps_key(sc, vif, sta);

1599
		ret = ath_key_config(common, vif, sta, key);
1600 1601
		if (sta && (ret > 0))
			((struct ath_node *)sta->drv_priv)->ps_key = ret;
1602 1603
		if (ret >= 0) {
			key->hw_key_idx = ret;
1604 1605
			/* push IV and Michael MIC generation to stack */
			key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
1606
			if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
1607
				key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
1608 1609
			if (sc->sc_ah->sw_mgmt_crypto &&
			    key->cipher == WLAN_CIPHER_SUITE_CCMP)
1610
				key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
1611
			ret = 0;
1612 1613 1614
		}
		break;
	case DISABLE_KEY:
1615
		ath_key_delete(common, key);
1616 1617
		if (sta)
			((struct ath_node *)sta->drv_priv)->ps_key = 0;
1618 1619 1620 1621
		break;
	default:
		ret = -EINVAL;
	}
1622

1623
	ath9k_ps_restore(sc);
1624 1625
	mutex_unlock(&sc->mutex);

1626 1627
	return ret;
}
1628 1629 1630

static void ath9k_set_assoc_state(struct ath_softc *sc,
				  struct ieee80211_vif *vif)
1631 1632 1633
{
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	struct ath_vif *avp = (void *)vif->drv_priv;
1634
	struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
S
Sujith Manoharan 已提交
1635
	unsigned long flags;
1636

1637
	set_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags);
1638 1639
	avp->primary_sta_vif = true;

1640
	/*
1641 1642 1643 1644
	 * Set the AID, BSSID and do beacon-sync only when
	 * the HW opmode is STATION.
	 *
	 * But the primary bit is set above in any case.
1645
	 */
1646
	if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
1647 1648
		return;

1649 1650 1651
	memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
	common->curaid = bss_conf->aid;
	ath9k_hw_write_associd(sc->sc_ah);
S
Sujith Manoharan 已提交
1652

1653
	common->last_rssi = ATH_RSSI_DUMMY_MARKER;
1654
	sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
1655

1656 1657 1658
	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	sc->ps_flags |= PS_BEACON_SYNC | PS_WAIT_FOR_BEACON;
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1659

1660 1661 1662
	if (ath9k_hw_mci_is_enabled(sc->sc_ah))
		ath9k_mci_update_wlan_channels(sc, false);

1663 1664 1665
	ath_dbg(common, CONFIG,
		"Primary Station interface: %pM, BSSID: %pM\n",
		vif->addr, common->curbssid);
1666 1667
}

1668
static void ath9k_bss_assoc_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
1669
{
1670
	struct ath_softc *sc = data;
1671
	struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
1672
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1673

1674
	if (test_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags))
1675 1676
		return;

1677 1678
	if (bss_conf->assoc)
		ath9k_set_assoc_state(sc, vif);
1679
}
1680

1681 1682 1683 1684 1685 1686 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 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746
void ath9k_p2p_ps_timer(void *priv)
{
	struct ath_softc *sc = priv;
	struct ath_vif *avp = sc->p2p_ps_vif;
	struct ieee80211_vif *vif;
	struct ieee80211_sta *sta;
	struct ath_node *an;
	u32 tsf;

	if (!avp)
		return;

	tsf = ath9k_hw_gettsf32(sc->sc_ah);
	if (!avp->noa.absent)
		tsf += ATH_P2P_PS_STOP_TIME;

	if (!avp->noa.has_next_tsf ||
	    avp->noa.next_tsf - tsf > BIT(31))
		ieee80211_update_p2p_noa(&avp->noa, tsf);

	ath9k_update_p2p_ps_timer(sc, avp);

	rcu_read_lock();

	vif = avp->vif;
	sta = ieee80211_find_sta(vif, vif->bss_conf.bssid);
	if (!sta)
		goto out;

	an = (void *) sta->drv_priv;
	if (an->sleeping == !!avp->noa.absent)
		goto out;

	an->sleeping = avp->noa.absent;
	if (an->sleeping)
		ath_tx_aggr_sleep(sta, sc, an);
	else
		ath_tx_aggr_wakeup(sc, an);

out:
	rcu_read_unlock();
}

void ath9k_update_p2p_ps(struct ath_softc *sc, struct ieee80211_vif *vif)
{
	struct ath_vif *avp = (void *)vif->drv_priv;
	unsigned long flags;
	u32 tsf;

	if (!sc->p2p_ps_timer)
		return;

	if (vif->type != NL80211_IFTYPE_STATION || !vif->p2p)
		return;

	sc->p2p_ps_vif = avp;

	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	if (!(sc->ps_flags & PS_BEACON_SYNC)) {
		tsf = ath9k_hw_gettsf32(sc->sc_ah);
		ieee80211_parse_p2p_noa(&vif->bss_conf.p2p_noa_attr, &avp->noa, tsf);
		ath9k_update_p2p_ps_timer(sc, avp);
	}
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
}

1747 1748 1749 1750 1751
static void ath9k_bss_info_changed(struct ieee80211_hw *hw,
				   struct ieee80211_vif *vif,
				   struct ieee80211_bss_conf *bss_conf,
				   u32 changed)
{
S
Sujith Manoharan 已提交
1752 1753 1754 1755 1756
#define CHECK_ANI				\
	(BSS_CHANGED_ASSOC |			\
	 BSS_CHANGED_IBSS |			\
	 BSS_CHANGED_BEACON_ENABLED)

1757
	struct ath_softc *sc = hw->priv;
1758
	struct ath_hw *ah = sc->sc_ah;
1759
	struct ath_common *common = ath9k_hw_common(ah);
1760
	struct ath_vif *avp = (void *)vif->drv_priv;
1761
	int slottime;
1762

1763
	ath9k_ps_wakeup(sc);
1764 1765
	mutex_lock(&sc->mutex);

1766
	if (changed & BSS_CHANGED_ASSOC) {
1767 1768 1769 1770
		ath_dbg(common, CONFIG, "BSSID %pM Changed ASSOC %d\n",
			bss_conf->bssid, bss_conf->assoc);

		if (avp->primary_sta_vif && !bss_conf->assoc) {
1771
			clear_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags);
1772 1773 1774
			avp->primary_sta_vif = false;

			if (ah->opmode == NL80211_IFTYPE_STATION)
1775
				clear_bit(ATH_OP_BEACONS, &common->op_flags);
1776 1777
		}

1778 1779 1780
		ieee80211_iterate_active_interfaces_atomic(
			sc->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
			ath9k_bss_assoc_iter, sc);
1781

1782
		if (!test_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags) &&
1783 1784 1785 1786
		    ah->opmode == NL80211_IFTYPE_STATION) {
			memset(common->curbssid, 0, ETH_ALEN);
			common->curaid = 0;
			ath9k_hw_write_associd(sc->sc_ah);
1787 1788
			if (ath9k_hw_mci_is_enabled(sc->sc_ah))
				ath9k_mci_update_wlan_channels(sc, true);
1789
		}
S
Sujith 已提交
1790
	}
1791

1792 1793 1794 1795 1796 1797
	if (changed & BSS_CHANGED_IBSS) {
		memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
		common->curaid = bss_conf->aid;
		ath9k_hw_write_associd(sc->sc_ah);
	}

S
Sujith Manoharan 已提交
1798
	if ((changed & BSS_CHANGED_BEACON_ENABLED) ||
1799 1800
	    (changed & BSS_CHANGED_BEACON_INT))
		ath9k_beacon_config(sc, vif, changed);
1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818

	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);
		}
1819 1820
	}

1821 1822 1823 1824 1825 1826
	if (changed & BSS_CHANGED_P2P_PS) {
		spin_lock_bh(&sc->sc_pcu_lock);
		ath9k_update_p2p_ps(sc, vif);
		spin_unlock_bh(&sc->sc_pcu_lock);
	}

S
Sujith Manoharan 已提交
1827 1828 1829
	if (changed & CHECK_ANI)
		ath_check_ani(sc);

1830
	mutex_unlock(&sc->mutex);
1831
	ath9k_ps_restore(sc);
S
Sujith Manoharan 已提交
1832 1833

#undef CHECK_ANI
1834
}
1835

1836
static u64 ath9k_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
1837
{
1838
	struct ath_softc *sc = hw->priv;
1839
	u64 tsf;
1840

1841
	mutex_lock(&sc->mutex);
1842
	ath9k_ps_wakeup(sc);
1843
	tsf = ath9k_hw_gettsf64(sc->sc_ah);
1844
	ath9k_ps_restore(sc);
1845
	mutex_unlock(&sc->mutex);
1846

1847 1848
	return tsf;
}
1849

1850 1851 1852
static void ath9k_set_tsf(struct ieee80211_hw *hw,
			  struct ieee80211_vif *vif,
			  u64 tsf)
1853
{
1854
	struct ath_softc *sc = hw->priv;
1855

1856
	mutex_lock(&sc->mutex);
1857
	ath9k_ps_wakeup(sc);
1858
	ath9k_hw_settsf64(sc->sc_ah, tsf);
1859
	ath9k_ps_restore(sc);
1860
	mutex_unlock(&sc->mutex);
1861 1862
}

1863
static void ath9k_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
1864
{
1865
	struct ath_softc *sc = hw->priv;
1866

1867
	mutex_lock(&sc->mutex);
1868 1869

	ath9k_ps_wakeup(sc);
1870
	ath9k_hw_reset_tsf(sc->sc_ah);
1871 1872
	ath9k_ps_restore(sc);

1873
	mutex_unlock(&sc->mutex);
1874
}
1875

1876
static int ath9k_ampdu_action(struct ieee80211_hw *hw,
1877
			      struct ieee80211_vif *vif,
1878 1879
			      enum ieee80211_ampdu_mlme_action action,
			      struct ieee80211_sta *sta,
1880
			      u16 tid, u16 *ssn, u8 buf_size)
1881
{
1882
	struct ath_softc *sc = hw->priv;
1883
	bool flush = false;
1884
	int ret = 0;
1885

1886
	mutex_lock(&sc->mutex);
1887

1888 1889 1890 1891 1892 1893
	switch (action) {
	case IEEE80211_AMPDU_RX_START:
		break;
	case IEEE80211_AMPDU_RX_STOP:
		break;
	case IEEE80211_AMPDU_TX_START:
1894
		ath9k_ps_wakeup(sc);
1895 1896 1897
		ret = ath_tx_aggr_start(sc, sta, tid, ssn);
		if (!ret)
			ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
1898
		ath9k_ps_restore(sc);
1899
		break;
1900 1901
	case IEEE80211_AMPDU_TX_STOP_FLUSH:
	case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT:
1902 1903
		flush = true;
	case IEEE80211_AMPDU_TX_STOP_CONT:
1904
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
1905
		ath_tx_aggr_stop(sc, sta, tid);
1906
		if (!flush)
1907
			ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
1908
		ath9k_ps_restore(sc);
1909
		break;
1910
	case IEEE80211_AMPDU_TX_OPERATIONAL:
1911
		ath9k_ps_wakeup(sc);
1912
		ath_tx_aggr_resume(sc, sta, tid);
1913
		ath9k_ps_restore(sc);
1914
		break;
1915
	default:
1916
		ath_err(ath9k_hw_common(sc->sc_ah), "Unknown AMPDU action\n");
1917 1918
	}

1919
	mutex_unlock(&sc->mutex);
1920

1921
	return ret;
1922 1923
}

1924 1925 1926
static int ath9k_get_survey(struct ieee80211_hw *hw, int idx,
			     struct survey_info *survey)
{
1927
	struct ath_softc *sc = hw->priv;
1928
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1929
	struct ieee80211_supported_band *sband;
1930 1931 1932
	struct ieee80211_channel *chan;
	int pos;

L
Luis R. Rodriguez 已提交
1933 1934 1935
	if (config_enabled(CONFIG_ATH9K_TX99))
		return -EOPNOTSUPP;

S
Sujith Manoharan 已提交
1936
	spin_lock_bh(&common->cc_lock);
1937 1938
	if (idx == 0)
		ath_update_survey_stats(sc);
1939 1940 1941 1942 1943 1944

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

1946 1947
	if (!sband)
		sband = hw->wiphy->bands[IEEE80211_BAND_5GHZ];
1948

1949
	if (!sband || idx >= sband->n_channels) {
S
Sujith Manoharan 已提交
1950
		spin_unlock_bh(&common->cc_lock);
1951
		return -ENOENT;
1952
	}
1953

1954 1955 1956 1957
	chan = &sband->channels[idx];
	pos = chan->hw_value;
	memcpy(survey, &sc->survey[pos], sizeof(*survey));
	survey->channel = chan;
S
Sujith Manoharan 已提交
1958
	spin_unlock_bh(&common->cc_lock);
1959

1960 1961 1962
	return 0;
}

1963 1964
static void ath9k_set_coverage_class(struct ieee80211_hw *hw, u8 coverage_class)
{
1965
	struct ath_softc *sc = hw->priv;
1966 1967
	struct ath_hw *ah = sc->sc_ah;

L
Luis R. Rodriguez 已提交
1968 1969 1970
	if (config_enabled(CONFIG_ATH9K_TX99))
		return;

1971 1972
	mutex_lock(&sc->mutex);
	ah->coverage_class = coverage_class;
1973 1974

	ath9k_ps_wakeup(sc);
1975
	ath9k_hw_init_global_settings(ah);
1976 1977
	ath9k_ps_restore(sc);

1978 1979 1980
	mutex_unlock(&sc->mutex);
}

F
Felix Fietkau 已提交
1981 1982
static bool ath9k_has_tx_pending(struct ath_softc *sc)
{
1983
	int i, npend = 0;
F
Felix Fietkau 已提交
1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999

	for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
		if (!ATH_TXQ_SETUP(sc, i))
			continue;

		if (!sc->tx.txq[i].axq_depth)
			continue;

		npend = ath9k_has_pending_frames(sc, &sc->tx.txq[i]);
		if (npend)
			break;
	}

	return !!npend;
}

2000 2001
static void ath9k_flush(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
			u32 queues, bool drop)
2002 2003
{
	struct ath_softc *sc = hw->priv;
2004 2005
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
F
Felix Fietkau 已提交
2006
	int timeout = HZ / 5; /* 200 ms */
2007
	bool drain_txq;
2008 2009 2010 2011

	mutex_lock(&sc->mutex);
	cancel_delayed_work_sync(&sc->tx_complete_work);

2012
	if (ah->ah_flags & AH_UNPLUGGED) {
2013
		ath_dbg(common, ANY, "Device has been unplugged!\n");
2014 2015 2016 2017
		mutex_unlock(&sc->mutex);
		return;
	}

2018
	if (test_bit(ATH_OP_INVALID, &common->op_flags)) {
2019
		ath_dbg(common, ANY, "Device not present\n");
2020 2021 2022 2023
		mutex_unlock(&sc->mutex);
		return;
	}

F
Felix Fietkau 已提交
2024 2025 2026
	if (wait_event_timeout(sc->tx_wait, !ath9k_has_tx_pending(sc),
			       timeout) > 0)
		drop = false;
2027

2028 2029 2030
	if (drop) {
		ath9k_ps_wakeup(sc);
		spin_lock_bh(&sc->sc_pcu_lock);
2031
		drain_txq = ath_drain_all_txq(sc);
2032
		spin_unlock_bh(&sc->sc_pcu_lock);
2033

2034
		if (!drain_txq)
2035
			ath_reset(sc);
2036

2037 2038 2039
		ath9k_ps_restore(sc);
		ieee80211_wake_queues(hw);
	}
2040

2041 2042 2043 2044
	ieee80211_queue_delayed_work(hw, &sc->tx_complete_work, 0);
	mutex_unlock(&sc->mutex);
}

2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059
static bool ath9k_tx_frames_pending(struct ieee80211_hw *hw)
{
	struct ath_softc *sc = hw->priv;
	int i;

	for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
		if (!ATH_TXQ_SETUP(sc, i))
			continue;

		if (ath9k_has_pending_frames(sc, &sc->tx.txq[i]))
			return true;
	}
	return false;
}

2060
static int ath9k_tx_last_beacon(struct ieee80211_hw *hw)
2061 2062 2063 2064 2065 2066 2067
{
	struct ath_softc *sc = hw->priv;
	struct ath_hw *ah = sc->sc_ah;
	struct ieee80211_vif *vif;
	struct ath_vif *avp;
	struct ath_buf *bf;
	struct ath_tx_status ts;
2068
	bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
2069 2070 2071 2072 2073 2074
	int status;

	vif = sc->beacon.bslot[0];
	if (!vif)
		return 0;

S
Sujith Manoharan 已提交
2075
	if (!vif->bss_conf.enable_beacon)
2076 2077
		return 0;

S
Sujith Manoharan 已提交
2078 2079
	avp = (void *)vif->drv_priv;

2080
	if (!sc->beacon.tx_processed && !edma) {
2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100
		tasklet_disable(&sc->bcon_tasklet);

		bf = avp->av_bcbuf;
		if (!bf || !bf->bf_mpdu)
			goto skip;

		status = ath9k_hw_txprocdesc(ah, bf->bf_desc, &ts);
		if (status == -EINPROGRESS)
			goto skip;

		sc->beacon.tx_processed = true;
		sc->beacon.tx_last = !(ts.ts_status & ATH9K_TXERR_MASK);

skip:
		tasklet_enable(&sc->bcon_tasklet);
	}

	return sc->beacon.tx_last;
}

2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114
static int ath9k_get_stats(struct ieee80211_hw *hw,
			   struct ieee80211_low_level_stats *stats)
{
	struct ath_softc *sc = hw->priv;
	struct ath_hw *ah = sc->sc_ah;
	struct ath9k_mib_stats *mib_stats = &ah->ah_mibStats;

	stats->dot11ACKFailureCount = mib_stats->ackrcv_bad;
	stats->dot11RTSFailureCount = mib_stats->rts_bad;
	stats->dot11FCSErrorCount = mib_stats->fcs_bad;
	stats->dot11RTSSuccessCount = mib_stats->rts_good;
	return 0;
}

2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132
static u32 fill_chainmask(u32 cap, u32 new)
{
	u32 filled = 0;
	int i;

	for (i = 0; cap && new; i++, cap >>= 1) {
		if (!(cap & BIT(0)))
			continue;

		if (new & BIT(0))
			filled |= BIT(i);

		new >>= 1;
	}

	return filled;
}

2133 2134
static bool validate_antenna_mask(struct ath_hw *ah, u32 val)
{
2135 2136 2137
	if (AR_SREV_9300_20_OR_LATER(ah))
		return true;

2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149
	switch (val & 0x7) {
	case 0x1:
	case 0x3:
	case 0x7:
		return true;
	case 0x2:
		return (ah->caps.rx_chainmask == 1);
	default:
		return false;
	}
}

2150 2151 2152 2153 2154
static int ath9k_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)
{
	struct ath_softc *sc = hw->priv;
	struct ath_hw *ah = sc->sc_ah;

2155 2156 2157 2158
	if (ah->caps.rx_chainmask != 1)
		rx_ant |= tx_ant;

	if (!validate_antenna_mask(ah, rx_ant) || !tx_ant)
2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173
		return -EINVAL;

	sc->ant_rx = rx_ant;
	sc->ant_tx = tx_ant;

	if (ah->caps.rx_chainmask == 1)
		return 0;

	/* AR9100 runs into calibration issues if not all rx chains are enabled */
	if (AR_SREV_9100(ah))
		ah->rxchainmask = 0x7;
	else
		ah->rxchainmask = fill_chainmask(ah->caps.rx_chainmask, rx_ant);

	ah->txchainmask = fill_chainmask(ah->caps.tx_chainmask, tx_ant);
2174
	ath9k_cmn_reload_chainmask(ah);
2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187

	return 0;
}

static int ath9k_get_antenna(struct ieee80211_hw *hw, u32 *tx_ant, u32 *rx_ant)
{
	struct ath_softc *sc = hw->priv;

	*tx_ant = sc->ant_tx;
	*rx_ant = sc->ant_rx;
	return 0;
}

2188 2189 2190
static void ath9k_sw_scan_start(struct ieee80211_hw *hw)
{
	struct ath_softc *sc = hw->priv;
2191 2192
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	set_bit(ATH_OP_SCANNING, &common->op_flags);
2193 2194 2195 2196 2197
}

static void ath9k_sw_scan_complete(struct ieee80211_hw *hw)
{
	struct ath_softc *sc = hw->priv;
2198 2199
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	clear_bit(ATH_OP_SCANNING, &common->op_flags);
2200
}
2201

2202 2203 2204 2205
static void ath9k_channel_switch_beacon(struct ieee80211_hw *hw,
					struct ieee80211_vif *vif,
					struct cfg80211_chan_def *chandef)
{
2206 2207
	/* depend on vif->csa_active only */
	return;
2208 2209
}

2210
struct ieee80211_ops ath9k_ops = {
2211 2212 2213 2214
	.tx 		    = ath9k_tx,
	.start 		    = ath9k_start,
	.stop 		    = ath9k_stop,
	.add_interface 	    = ath9k_add_interface,
2215
	.change_interface   = ath9k_change_interface,
2216 2217 2218
	.remove_interface   = ath9k_remove_interface,
	.config 	    = ath9k_config,
	.configure_filter   = ath9k_configure_filter,
2219 2220
	.sta_add	    = ath9k_sta_add,
	.sta_remove	    = ath9k_sta_remove,
2221
	.sta_notify         = ath9k_sta_notify,
2222 2223 2224 2225
	.conf_tx 	    = ath9k_conf_tx,
	.bss_info_changed   = ath9k_bss_info_changed,
	.set_key            = ath9k_set_key,
	.get_tsf 	    = ath9k_get_tsf,
2226
	.set_tsf 	    = ath9k_set_tsf,
2227
	.reset_tsf 	    = ath9k_reset_tsf,
2228
	.ampdu_action       = ath9k_ampdu_action,
2229
	.get_survey	    = ath9k_get_survey,
J
Johannes Berg 已提交
2230
	.rfkill_poll        = ath9k_rfkill_poll_state,
2231
	.set_coverage_class = ath9k_set_coverage_class,
2232
	.flush		    = ath9k_flush,
2233
	.tx_frames_pending  = ath9k_tx_frames_pending,
2234
	.tx_last_beacon     = ath9k_tx_last_beacon,
2235
	.release_buffered_frames = ath9k_release_buffered_frames,
2236
	.get_stats	    = ath9k_get_stats,
2237 2238
	.set_antenna	    = ath9k_set_antenna,
	.get_antenna	    = ath9k_get_antenna,
2239

S
Sujith Manoharan 已提交
2240
#ifdef CONFIG_ATH9K_WOW
2241 2242 2243 2244 2245
	.suspend	    = ath9k_suspend,
	.resume		    = ath9k_resume,
	.set_wakeup	    = ath9k_set_wakeup,
#endif

2246 2247
#ifdef CONFIG_ATH9K_DEBUGFS
	.get_et_sset_count  = ath9k_get_et_sset_count,
2248 2249 2250 2251
	.get_et_stats       = ath9k_get_et_stats,
	.get_et_strings     = ath9k_get_et_strings,
#endif

2252
#if defined(CONFIG_MAC80211_DEBUGFS) && defined(CONFIG_ATH9K_STATION_STATISTICS)
2253
	.sta_add_debugfs    = ath9k_sta_add_debugfs,
2254
#endif
2255 2256
	.sw_scan_start	    = ath9k_sw_scan_start,
	.sw_scan_complete   = ath9k_sw_scan_complete,
2257
	.channel_switch_beacon     = ath9k_channel_switch_beacon,
2258
};