main.c 55.0 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
void ath9k_ps_wakeup(struct ath_softc *sc)
{
87
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
88
	unsigned long flags;
89
	enum ath9k_power_mode power_mode;
90 91 92 93 94

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

95
	power_mode = sc->sc_ah->power_mode;
96
	ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
97

98 99 100 101 102
	/*
	 * 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.
	 */
103 104 105 106
	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));
107
		memset(&common->cc_ani, 0, sizeof(common->cc_ani));
108 109
		spin_unlock(&common->cc_lock);
	}
110

111 112 113 114 115 116
 unlock:
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
}

void ath9k_ps_restore(struct ath_softc *sc)
{
117
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
F
Felix Fietkau 已提交
118
	enum ath9k_power_mode mode;
119
	unsigned long flags;
S
Sujith Manoharan 已提交
120
	bool reset;
121 122 123 124 125

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

S
Sujith Manoharan 已提交
126 127 128
	if (sc->ps_idle) {
		ath9k_hw_setrxabort(sc->sc_ah, 1);
		ath9k_hw_stopdmarecv(sc->sc_ah, &reset);
F
Felix Fietkau 已提交
129
		mode = ATH9K_PM_FULL_SLEEP;
S
Sujith Manoharan 已提交
130 131 132 133
	} else if (sc->ps_enabled &&
		   !(sc->ps_flags & (PS_WAIT_FOR_BEACON |
				     PS_WAIT_FOR_CAB |
				     PS_WAIT_FOR_PSPOLL_DATA |
134 135
				     PS_WAIT_FOR_TX_ACK |
				     PS_WAIT_FOR_ANI))) {
F
Felix Fietkau 已提交
136
		mode = ATH9K_PM_NETWORK_SLEEP;
137 138
		if (ath9k_hw_btcoex_is_enabled(sc->sc_ah))
			ath9k_btcoex_stop_gen_timer(sc);
S
Sujith Manoharan 已提交
139
	} else {
F
Felix Fietkau 已提交
140
		goto unlock;
S
Sujith Manoharan 已提交
141
	}
F
Felix Fietkau 已提交
142 143 144 145 146

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

147
	ath9k_hw_setpower(sc->sc_ah, mode);
148 149 150 151 152

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

153
static void __ath_cancel_work(struct ath_softc *sc)
S
Sujith 已提交
154
{
155 156 157
	cancel_work_sync(&sc->paprd_work);
	cancel_work_sync(&sc->hw_check_work);
	cancel_delayed_work_sync(&sc->tx_complete_work);
158
	cancel_delayed_work_sync(&sc->hw_pll_work);
S
Sujith Manoharan 已提交
159

160
#ifdef CONFIG_ATH9K_BTCOEX_SUPPORT
S
Sujith Manoharan 已提交
161 162
	if (ath9k_hw_mci_is_enabled(sc->sc_ah))
		cancel_work_sync(&sc->mci_work);
163
#endif
164
}
165

166 167 168 169 170
static void ath_cancel_work(struct ath_softc *sc)
{
	__ath_cancel_work(sc);
	cancel_work_sync(&sc->hw_reset_work);
}
171

S
Sujith Manoharan 已提交
172 173 174 175
static void ath_restart_work(struct ath_softc *sc)
{
	ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);

176 177
	if (AR_SREV_9340(sc->sc_ah) || AR_SREV_9485(sc->sc_ah) ||
	    AR_SREV_9550(sc->sc_ah))
S
Sujith Manoharan 已提交
178 179 180 181
		ieee80211_queue_delayed_work(sc->hw, &sc->hw_pll_work,
				     msecs_to_jiffies(ATH_PLL_WORK_INTERVAL));

	ath_start_rx_poll(sc, 3);
S
Sujith Manoharan 已提交
182
	ath_start_ani(sc);
S
Sujith Manoharan 已提交
183 184
}

F
Felix Fietkau 已提交
185
static bool ath_prepare_reset(struct ath_softc *sc, bool retry_tx)
186 187
{
	struct ath_hw *ah = sc->sc_ah;
188
	bool ret = true;
189

190
	ieee80211_stop_queues(sc->hw);
191

192
	sc->hw_busy_count = 0;
S
Sujith Manoharan 已提交
193
	ath_stop_ani(sc);
194
	del_timer_sync(&sc->rx_poll_timer);
S
Sujith 已提交
195

196 197
	ath9k_debug_samp_bb_mac(sc);
	ath9k_hw_disable_interrupts(ah);
198

199 200
	tasklet_disable(&sc->intr_tq);

201 202
	if (!ath_stoprecv(sc))
		ret = false;
203

204 205 206
	if (!ath_drain_all_txq(sc, retry_tx))
		ret = false;

207 208
	tasklet_enable(&sc->intr_tq);

209 210
	return ret;
}
S
Sujith 已提交
211

212 213 214 215
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);
216
	unsigned long flags;
217 218

	if (ath_startrecv(sc) != 0) {
219
		ath_err(common, "Unable to restart recv logic\n");
220
		return false;
221 222
	}

223 224
	ath9k_cmn_update_txpow(ah, sc->curtxpow,
			       sc->config.txpowlimit, &sc->curtxpow);
225 226

	clear_bit(SC_OP_HW_RESET, &sc->sc_flags);
227
	ath9k_hw_set_interrupts(ah);
228
	ath9k_hw_enable_interrupts(ah);
229

230
	if (!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL) && start) {
231 232 233
		if (!test_bit(SC_OP_BEACONS, &sc->sc_flags))
			goto work;

S
Sujith Manoharan 已提交
234
		ath9k_set_beacon(sc);
235 236 237 238 239 240 241 242

		if (ah->opmode == NL80211_IFTYPE_STATION &&
		    test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) {
			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);
		}
	work:
S
Sujith Manoharan 已提交
243
		ath_restart_work(sc);
244 245
	}

246 247
	if ((ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) && sc->ant_rx != 3)
		ath_ant_comb_update(sc);
248

249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265
	ieee80211_wake_queues(sc->hw);

	return true;
}

static int ath_reset_internal(struct ath_softc *sc, struct ath9k_channel *hchan,
			      bool retry_tx)
{
	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);

	spin_lock_bh(&sc->sc_pcu_lock);
266

267
	if (!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL)) {
268 269 270 271 272 273 274 275 276
		fastcc = false;
		caldata = &sc->caldata;
	}

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

F
Felix Fietkau 已提交
277
	if (!ath_prepare_reset(sc, retry_tx))
278 279
		fastcc = false;

280
	ath_dbg(common, CONFIG, "Reset to %u MHz, HT40: %d fastcc: %d\n",
281
		hchan->channel, IS_CHAN_HT40(hchan), fastcc);
282 283 284 285 286 287 288 289

	r = ath9k_hw_reset(ah, hchan, caldata, fastcc);
	if (r) {
		ath_err(common,
			"Unable to reset channel, reset status %d\n", r);
		goto out;
	}

290 291 292 293
	if (ath9k_hw_mci_is_enabled(sc->sc_ah) &&
	    (sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL))
		ath9k_mci_set_txpower(sc, true, false);

294 295 296 297
	if (!ath_complete_reset(sc, true))
		r = -EIO;

out:
298
	spin_unlock_bh(&sc->sc_pcu_lock);
299 300 301 302 303 304 305 306 307 308 309 310 311 312
	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.
*/
static int ath_set_channel(struct ath_softc *sc, struct ieee80211_hw *hw,
		    struct ath9k_channel *hchan)
{
	int r;

S
Sujith Manoharan 已提交
313
	if (test_bit(SC_OP_INVALID, &sc->sc_flags))
314 315 316
		return -EIO;

	r = ath_reset_internal(sc, hchan, false);
317

318
	return r;
S
Sujith 已提交
319 320
}

321 322
static void ath_node_attach(struct ath_softc *sc, struct ieee80211_sta *sta,
			    struct ieee80211_vif *vif)
S
Sujith 已提交
323 324
{
	struct ath_node *an;
325
	u8 density;
S
Sujith 已提交
326 327
	an = (struct ath_node *)sta->drv_priv;

328
	an->sc = sc;
329
	an->sta = sta;
330
	an->vif = vif;
331

332
	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_HT) {
S
Sujith 已提交
333
		ath_tx_node_init(sc, an);
S
Sujith 已提交
334
		an->maxampdu = 1 << (IEEE80211_HT_MAX_AMPDU_FACTOR +
335
				     sta->ht_cap.ampdu_factor);
336 337
		density = ath9k_parse_mpdudensity(sta->ht_cap.ampdu_density);
		an->mpdudensity = density;
338
	}
S
Sujith 已提交
339 340 341 342 343 344
}

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

345
	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_HT)
S
Sujith 已提交
346 347 348
		ath_tx_node_cleanup(sc, an);
}

S
Sujith 已提交
349
void ath9k_tasklet(unsigned long data)
S
Sujith 已提交
350 351
{
	struct ath_softc *sc = (struct ath_softc *)data;
352
	struct ath_hw *ah = sc->sc_ah;
353
	struct ath_common *common = ath9k_hw_common(ah);
354
	enum ath_reset_type type;
S
Sujith Manoharan 已提交
355
	unsigned long flags;
S
Sujith 已提交
356
	u32 status = sc->intrstatus;
F
Felix Fietkau 已提交
357
	u32 rxmask;
S
Sujith 已提交
358

359 360 361
	ath9k_ps_wakeup(sc);
	spin_lock(&sc->sc_pcu_lock);

362 363
	if ((status & ATH9K_INT_FATAL) ||
	    (status & ATH9K_INT_BB_WATCHDOG)) {
364 365 366 367 368 369

		if (status & ATH9K_INT_FATAL)
			type = RESET_TYPE_FATAL_INT;
		else
			type = RESET_TYPE_BB_WATCHDOG;

370
		ath9k_queue_reset(sc, type);
371
		goto out;
S
Sujith 已提交
372
	}
S
Sujith 已提交
373

S
Sujith Manoharan 已提交
374
	spin_lock_irqsave(&sc->sc_pm_lock, flags);
375 376 377 378 379
	if ((status & ATH9K_INT_TSFOOR) && sc->ps_enabled) {
		/*
		 * TSF sync does not look correct; remain awake to sync with
		 * the next Beacon.
		 */
380
		ath_dbg(common, PS, "TSFOOR - Sync with next Beacon\n");
381
		sc->ps_flags |= PS_WAIT_FOR_BEACON | PS_BEACON_SYNC;
382
	}
S
Sujith Manoharan 已提交
383
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
384

F
Felix Fietkau 已提交
385 386 387 388 389 390 391 392 393 394 395 396 397
	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 已提交
398 399
	}

400 401 402 403 404 405
	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 已提交
406

407
	ath9k_btcoex_handle_interrupt(sc, status);
408

409
out:
S
Sujith 已提交
410
	/* re-enable hardware interrupt */
411
	ath9k_hw_enable_interrupts(ah);
412

413
	spin_unlock(&sc->sc_pcu_lock);
414
	ath9k_ps_restore(sc);
S
Sujith 已提交
415 416
}

417
irqreturn_t ath_isr(int irq, void *dev)
S
Sujith 已提交
418
{
S
Sujith 已提交
419 420
#define SCHED_INTR (				\
		ATH9K_INT_FATAL |		\
421
		ATH9K_INT_BB_WATCHDOG |		\
S
Sujith 已提交
422 423 424
		ATH9K_INT_RXORN |		\
		ATH9K_INT_RXEOL |		\
		ATH9K_INT_RX |			\
F
Felix Fietkau 已提交
425 426
		ATH9K_INT_RXLP |		\
		ATH9K_INT_RXHP |		\
S
Sujith 已提交
427 428 429
		ATH9K_INT_TX |			\
		ATH9K_INT_BMISS |		\
		ATH9K_INT_CST |			\
430
		ATH9K_INT_TSFOOR |		\
431 432
		ATH9K_INT_GENTIMER |		\
		ATH9K_INT_MCI)
S
Sujith 已提交
433

S
Sujith 已提交
434
	struct ath_softc *sc = dev;
435
	struct ath_hw *ah = sc->sc_ah;
436
	struct ath_common *common = ath9k_hw_common(ah);
S
Sujith 已提交
437 438 439
	enum ath9k_int status;
	bool sched = false;

S
Sujith 已提交
440 441 442 443 444
	/*
	 * The hardware is not ready/present, don't
	 * touch anything. Note this can happen early
	 * on if the IRQ is shared.
	 */
S
Sujith Manoharan 已提交
445
	if (test_bit(SC_OP_INVALID, &sc->sc_flags))
S
Sujith 已提交
446
		return IRQ_NONE;
S
Sujith 已提交
447

S
Sujith 已提交
448 449
	/* shared irq, not for us */

450
	if (!ath9k_hw_intrpend(ah))
S
Sujith 已提交
451 452
		return IRQ_NONE;

453 454
	if (test_bit(SC_OP_HW_RESET, &sc->sc_flags)) {
		ath9k_hw_kill_interrupts(ah);
455
		return IRQ_HANDLED;
456
	}
457

S
Sujith 已提交
458 459 460 461 462 463 464
	/*
	 * 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 已提交
465
	status &= ah->imask;	/* discard unasked-for bits */
S
Sujith 已提交
466

S
Sujith 已提交
467 468 469 470
	/*
	 * If there are no status bits set, then this interrupt was not
	 * for me (should have been caught above).
	 */
471
	if (!status)
S
Sujith 已提交
472
		return IRQ_NONE;
S
Sujith 已提交
473

S
Sujith 已提交
474 475 476 477 478 479 480 481 482 483
	/* 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 已提交
484 485
	if ((status & ATH9K_INT_FATAL) || ((status & ATH9K_INT_RXORN) &&
	    !(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)))
S
Sujith 已提交
486 487
		goto chip_reset;

488 489
	if ((ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) &&
	    (status & ATH9K_INT_BB_WATCHDOG)) {
490 491 492

		spin_lock(&common->cc_lock);
		ath_hw_cycle_counters_update(common);
493
		ar9003_hw_bb_watchdog_dbg_info(ah);
494 495
		spin_unlock(&common->cc_lock);

496 497
		goto chip_reset;
	}
498 499 500 501 502 503 504 505 506
#ifdef CONFIG_PM_SLEEP
	if (status & ATH9K_INT_BMISS) {
		if (atomic_read(&sc->wow_sleep_proc_intr) == 0) {
			ath_dbg(common, ANY, "during WoW we got a BMISS\n");
			atomic_inc(&sc->wow_got_bmiss_intr);
			atomic_dec(&sc->wow_sleep_proc_intr);
		}
	}
#endif
S
Sujith 已提交
507 508 509 510 511 512
	if (status & ATH9K_INT_SWBA)
		tasklet_schedule(&sc->bcon_tasklet);

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

513 514
	if (status & ATH9K_INT_RXEOL) {
		ah->imask &= ~(ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
515
		ath9k_hw_set_interrupts(ah);
F
Felix Fietkau 已提交
516 517
	}

518 519
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
		if (status & ATH9K_INT_TIM_TIMER) {
520 521
			if (ATH_DBG_WARN_ON_ONCE(sc->ps_idle))
				goto chip_reset;
S
Sujith 已提交
522 523
			/* Clear RxAbort bit so that we can
			 * receive frames */
524
			ath9k_setpower(sc, ATH9K_PM_AWAKE);
S
Sujith Manoharan 已提交
525
			spin_lock(&sc->sc_pm_lock);
526
			ath9k_hw_setrxabort(sc->sc_ah, 0);
S
Sujith 已提交
527
			sc->ps_flags |= PS_WAIT_FOR_BEACON;
S
Sujith Manoharan 已提交
528
			spin_unlock(&sc->sc_pm_lock);
S
Sujith 已提交
529
		}
S
Sujith 已提交
530 531

chip_reset:
S
Sujith 已提交
532

533 534
	ath_debug_stat_interrupt(sc, status);

S
Sujith 已提交
535
	if (sched) {
536 537
		/* turn off every interrupt */
		ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
538 539 540 541
		tasklet_schedule(&sc->intr_tq);
	}

	return IRQ_HANDLED;
S
Sujith 已提交
542 543

#undef SCHED_INTR
S
Sujith 已提交
544 545
}

546
static int ath_reset(struct ath_softc *sc, bool retry_tx)
S
Sujith 已提交
547
{
548
	int r;
S
Sujith 已提交
549

550
	ath9k_ps_wakeup(sc);
551

552
	r = ath_reset_internal(sc, NULL, retry_tx);
S
Sujith 已提交
553 554 555 556 557

	if (retry_tx) {
		int i;
		for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
			if (ATH_TXQ_SETUP(sc, i)) {
S
Sujith 已提交
558 559 560
				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 已提交
561 562 563 564
			}
		}
	}

565
	ath9k_ps_restore(sc);
S
Sujith 已提交
566

567
	return r;
S
Sujith 已提交
568 569
}

570 571 572 573 574 575 576 577 578
void ath9k_queue_reset(struct ath_softc *sc, enum ath_reset_type type)
{
#ifdef CONFIG_ATH9K_DEBUGFS
	RESET_STAT_INC(sc, type);
#endif
	set_bit(SC_OP_HW_RESET, &sc->sc_flags);
	ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
}

579 580 581 582 583 584 585
void ath_reset_work(struct work_struct *work)
{
	struct ath_softc *sc = container_of(work, struct ath_softc, hw_reset_work);

	ath_reset(sc, true);
}

S
Sujith 已提交
586 587 588 589
/**********************/
/* mac80211 callbacks */
/**********************/

590
static int ath9k_start(struct ieee80211_hw *hw)
591
{
592
	struct ath_softc *sc = hw->priv;
593
	struct ath_hw *ah = sc->sc_ah;
594
	struct ath_common *common = ath9k_hw_common(ah);
595
	struct ieee80211_channel *curchan = hw->conf.channel;
S
Sujith 已提交
596
	struct ath9k_channel *init_channel;
597
	int r;
598

599
	ath_dbg(common, CONFIG,
J
Joe Perches 已提交
600 601
		"Starting driver with initial channel: %d MHz\n",
		curchan->center_freq);
602

603
	ath9k_ps_wakeup(sc);
604 605
	mutex_lock(&sc->mutex);

606
	init_channel = ath9k_cmn_get_curchannel(hw, ah);
S
Sujith 已提交
607 608

	/* Reset SERDES registers */
609
	ath9k_hw_configpcipowersave(ah, false);
S
Sujith 已提交
610 611 612 613 614 615 616 617

	/*
	 * 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.
	 */
618
	spin_lock_bh(&sc->sc_pcu_lock);
F
Felix Fietkau 已提交
619 620 621

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

622
	r = ath9k_hw_reset(ah, init_channel, ah->caldata, false);
623
	if (r) {
624 625 626
		ath_err(common,
			"Unable to reset hardware; reset status %d (freq %u MHz)\n",
			r, curchan->center_freq);
627
		ah->reset_power_on = false;
S
Sujith 已提交
628 629 630
	}

	/* Setup our intr mask. */
F
Felix Fietkau 已提交
631 632 633 634 635
	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)
636 637 638
		ah->imask |= ATH9K_INT_RXHP |
			     ATH9K_INT_RXLP |
			     ATH9K_INT_BB_WATCHDOG;
F
Felix Fietkau 已提交
639 640
	else
		ah->imask |= ATH9K_INT_RX;
S
Sujith 已提交
641

642
	ah->imask |= ATH9K_INT_GTT;
S
Sujith 已提交
643

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

647
	ath_mci_enable(sc);
648

S
Sujith Manoharan 已提交
649
	clear_bit(SC_OP_INVALID, &sc->sc_flags);
650
	sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
651

652 653
	if (!ath_complete_reset(sc, false))
		ah->reset_power_on = false;
S
Sujith 已提交
654

F
Felix Fietkau 已提交
655 656 657 658 659 660 661 662 663 664 665 666
	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);

667
	spin_unlock_bh(&sc->sc_pcu_lock);
668

669 670
	mutex_unlock(&sc->mutex);

671 672
	ath9k_ps_restore(sc);

673
	return 0;
674 675
}

676 677 678
static void ath9k_tx(struct ieee80211_hw *hw,
		     struct ieee80211_tx_control *control,
		     struct sk_buff *skb)
679
{
680
	struct ath_softc *sc = hw->priv;
681
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
S
Sujith 已提交
682
	struct ath_tx_control txctl;
683
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
S
Sujith Manoharan 已提交
684
	unsigned long flags;
S
Sujith 已提交
685

686
	if (sc->ps_enabled) {
687 688 689 690 691 692 693
		/*
		 * 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)) {
694
			ath_dbg(common, PS,
J
Joe Perches 已提交
695
				"Add PM=1 for a TX frame while in PS mode\n");
696 697 698 699
			hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
		}
	}

S
Sujith Manoharan 已提交
700
	if (unlikely(sc->sc_ah->power_mode == ATH9K_PM_NETWORK_SLEEP)) {
701 702 703 704 705 706
		/*
		 * 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 已提交
707
		spin_lock_irqsave(&sc->sc_pm_lock, flags);
708 709
		if (!(sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
			ath9k_hw_setrxabort(sc->sc_ah, 0);
710
		if (ieee80211_is_pspoll(hdr->frame_control)) {
711
			ath_dbg(common, PS,
J
Joe Perches 已提交
712
				"Sending PS-Poll to pick a buffered frame\n");
S
Sujith 已提交
713
			sc->ps_flags |= PS_WAIT_FOR_PSPOLL_DATA;
714
		} else {
715
			ath_dbg(common, PS, "Wake up to complete TX\n");
S
Sujith 已提交
716
			sc->ps_flags |= PS_WAIT_FOR_TX_ACK;
717 718 719
		}
		/*
		 * The actual restore operation will happen only after
S
Sujith Manoharan 已提交
720
		 * the ps_flags bit is cleared. We are just dropping
721 722
		 * the ps_usecount here.
		 */
S
Sujith Manoharan 已提交
723
		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
724 725 726
		ath9k_ps_restore(sc);
	}

S
Sujith Manoharan 已提交
727 728 729 730 731 732 733 734 735
	/*
	 * 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 已提交
736
	memset(&txctl, 0, sizeof(struct ath_tx_control));
737
	txctl.txq = sc->tx.txq_map[skb_get_queue_mapping(skb)];
738
	txctl.sta = control->sta;
S
Sujith 已提交
739

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

742
	if (ath_tx_start(hw, skb, &txctl) != 0) {
743
		ath_dbg(common, XMIT, "TX failed\n");
B
Ben Greear 已提交
744
		TX_STAT_INC(txctl.txq->axq_qnum, txfailed);
S
Sujith 已提交
745
		goto exit;
746 747
	}

748
	return;
S
Sujith 已提交
749
exit:
F
Felix Fietkau 已提交
750
	ieee80211_free_txskb(hw, skb);
751 752
}

753
static void ath9k_stop(struct ieee80211_hw *hw)
754
{
755
	struct ath_softc *sc = hw->priv;
756
	struct ath_hw *ah = sc->sc_ah;
757
	struct ath_common *common = ath9k_hw_common(ah);
F
Felix Fietkau 已提交
758
	bool prev_idle;
759

S
Sujith 已提交
760 761
	mutex_lock(&sc->mutex);

762
	ath_cancel_work(sc);
763
	del_timer_sync(&sc->rx_poll_timer);
764

S
Sujith Manoharan 已提交
765
	if (test_bit(SC_OP_INVALID, &sc->sc_flags)) {
766
		ath_dbg(common, ANY, "Device not present\n");
S
Sujith 已提交
767
		mutex_unlock(&sc->mutex);
S
Sujith 已提交
768 769
		return;
	}
770

771 772 773
	/* Ensure HW is awake when we try to shut it down. */
	ath9k_ps_wakeup(sc);

774 775
	spin_lock_bh(&sc->sc_pcu_lock);

776 777 778
	/* prevent tasklets to enable interrupts once we disable them */
	ah->imask &= ~ATH9K_INT_GLOBAL;

S
Sujith 已提交
779 780
	/* make sure h/w will not generate any interrupt
	 * before setting the invalid flag. */
781
	ath9k_hw_disable_interrupts(ah);
S
Sujith 已提交
782

F
Felix Fietkau 已提交
783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800
	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);
	}

F
Felix Fietkau 已提交
801
	ath_prepare_reset(sc, false);
S
Sujith 已提交
802

803 804 805 806 807
	if (sc->rx.frag) {
		dev_kfree_skb_any(sc->rx.frag);
		sc->rx.frag = NULL;
	}

F
Felix Fietkau 已提交
808 809
	if (!ah->curchan)
		ah->curchan = ath9k_cmn_get_curchannel(hw, ah);
810

F
Felix Fietkau 已提交
811 812
	ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
	ath9k_hw_phy_disable(ah);
813

F
Felix Fietkau 已提交
814
	ath9k_hw_configpcipowersave(ah, true);
815

F
Felix Fietkau 已提交
816
	spin_unlock_bh(&sc->sc_pcu_lock);
817

F
Felix Fietkau 已提交
818
	ath9k_ps_restore(sc);
S
Sujith 已提交
819

S
Sujith Manoharan 已提交
820
	set_bit(SC_OP_INVALID, &sc->sc_flags);
F
Felix Fietkau 已提交
821
	sc->ps_idle = prev_idle;
822

823 824
	mutex_unlock(&sc->mutex);

825
	ath_dbg(common, CONFIG, "Driver halt\n");
826 827
}

828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848
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_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]);
849

850
	switch (vif->type) {
851 852
	case NL80211_IFTYPE_AP:
		iter_data->naps++;
853
		break;
854 855
	case NL80211_IFTYPE_STATION:
		iter_data->nstations++;
B
Bill Jordan 已提交
856
		break;
857
	case NL80211_IFTYPE_ADHOC:
858 859
		iter_data->nadhocs++;
		break;
860
	case NL80211_IFTYPE_MESH_POINT:
861 862 863 864
		iter_data->nmeshes++;
		break;
	case NL80211_IFTYPE_WDS:
		iter_data->nwds++;
865 866
		break;
	default:
867
		break;
868
	}
869
}
870

871 872 873 874 875 876 877 878 879 880 881 882
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);
}

883 884 885 886 887
/* 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)
{
888
	struct ath_softc *sc = hw->priv;
889 890
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
891

892 893 894 895 896 897 898
	/*
	 * 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 已提交
899

900 901 902 903
	if (vif)
		ath9k_vif_iter(iter_data, vif->addr, vif);

	/* Get list of all active MAC addresses */
904 905 906
	ieee80211_iterate_active_interfaces_atomic(
		sc->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
		ath9k_vif_iter, iter_data);
907
}
908

909 910 911 912
/* Called with sc->mutex held. */
static void ath9k_calculate_summary_state(struct ieee80211_hw *hw,
					  struct ieee80211_vif *vif)
{
913
	struct ath_softc *sc = hw->priv;
914 915 916
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	struct ath9k_vif_iter_data iter_data;
917
	enum nl80211_iftype old_opmode = ah->opmode;
918

919
	ath9k_calculate_iter_data(hw, vif, &iter_data);
920

921 922 923 924
	memcpy(common->bssidmask, iter_data.mask, ETH_ALEN);
	ath_hw_setbssidmask(common);

	if (iter_data.naps > 0) {
925
		ath9k_hw_set_tsfadjust(ah, true);
926 927
		ah->opmode = NL80211_IFTYPE_AP;
	} else {
928
		ath9k_hw_set_tsfadjust(ah, false);
S
Sujith 已提交
929

930 931 932
		if (iter_data.nmeshes)
			ah->opmode = NL80211_IFTYPE_MESH_POINT;
		else if (iter_data.nwds)
933 934 935 936 937 938
			ah->opmode = NL80211_IFTYPE_AP;
		else if (iter_data.nadhocs)
			ah->opmode = NL80211_IFTYPE_ADHOC;
		else
			ah->opmode = NL80211_IFTYPE_STATION;
	}
S
Sujith 已提交
939

940 941
	ath9k_hw_setopmode(ah);

942
	if ((iter_data.nstations + iter_data.nadhocs + iter_data.nmeshes) > 0)
P
Pavel Roskin 已提交
943
		ah->imask |= ATH9K_INT_TSFOOR;
944
	else
945
		ah->imask &= ~ATH9K_INT_TSFOOR;
946

947
	ath9k_hw_set_interrupts(ah);
948 949 950 951 952 953 954 955

	/*
	 * 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 &&
	    test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) {
956 957 958
		ieee80211_iterate_active_interfaces_atomic(
			sc->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
			ath9k_sta_vif_iter, sc);
959
	}
960
}
961

962 963
static int ath9k_add_interface(struct ieee80211_hw *hw,
			       struct ieee80211_vif *vif)
964
{
965
	struct ath_softc *sc = hw->priv;
966 967
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
968

969
	mutex_lock(&sc->mutex);
970

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

974
	ath9k_ps_wakeup(sc);
S
Sujith Manoharan 已提交
975
	ath9k_calculate_summary_state(hw, vif);
976 977
	ath9k_ps_restore(sc);

S
Sujith Manoharan 已提交
978 979 980
	if (ath9k_uses_beacons(vif->type))
		ath9k_beacon_assign_slot(sc, vif);

981
	mutex_unlock(&sc->mutex);
982
	return 0;
983 984 985 986 987 988 989
}

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

993
	ath_dbg(common, CONFIG, "Change Interface\n");
994
	mutex_lock(&sc->mutex);
995 996

	if (ath9k_uses_beacons(vif->type))
S
Sujith Manoharan 已提交
997
		ath9k_beacon_remove_slot(sc, vif);
998

999 1000 1001
	vif->type = new_type;
	vif->p2p = p2p;

1002
	ath9k_ps_wakeup(sc);
S
Sujith Manoharan 已提交
1003
	ath9k_calculate_summary_state(hw, vif);
1004 1005
	ath9k_ps_restore(sc);

S
Sujith Manoharan 已提交
1006 1007 1008
	if (ath9k_uses_beacons(vif->type))
		ath9k_beacon_assign_slot(sc, vif);

1009
	mutex_unlock(&sc->mutex);
1010
	return 0;
1011 1012
}

1013
static void ath9k_remove_interface(struct ieee80211_hw *hw,
1014
				   struct ieee80211_vif *vif)
1015
{
1016
	struct ath_softc *sc = hw->priv;
1017
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1018

1019
	ath_dbg(common, CONFIG, "Detach Interface\n");
1020

1021 1022
	mutex_lock(&sc->mutex);

1023
	sc->nvifs--;
J
Jouni Malinen 已提交
1024

1025
	if (ath9k_uses_beacons(vif->type))
S
Sujith Manoharan 已提交
1026
		ath9k_beacon_remove_slot(sc, vif);
1027

1028
	ath9k_ps_wakeup(sc);
1029
	ath9k_calculate_summary_state(hw, NULL);
1030
	ath9k_ps_restore(sc);
1031 1032

	mutex_unlock(&sc->mutex);
1033 1034
}

1035
static void ath9k_enable_ps(struct ath_softc *sc)
1036
{
P
Pavel Roskin 已提交
1037
	struct ath_hw *ah = sc->sc_ah;
S
Sujith Manoharan 已提交
1038
	struct ath_common *common = ath9k_hw_common(ah);
P
Pavel Roskin 已提交
1039

1040
	sc->ps_enabled = true;
P
Pavel Roskin 已提交
1041 1042 1043
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
		if ((ah->imask & ATH9K_INT_TIM_TIMER) == 0) {
			ah->imask |= ATH9K_INT_TIM_TIMER;
1044
			ath9k_hw_set_interrupts(ah);
1045
		}
1046
		ath9k_hw_setrxabort(ah, 1);
1047
	}
S
Sujith Manoharan 已提交
1048
	ath_dbg(common, PS, "PowerSave enabled\n");
1049 1050
}

1051 1052 1053
static void ath9k_disable_ps(struct ath_softc *sc)
{
	struct ath_hw *ah = sc->sc_ah;
S
Sujith Manoharan 已提交
1054
	struct ath_common *common = ath9k_hw_common(ah);
1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065

	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;
1066
			ath9k_hw_set_interrupts(ah);
1067 1068
		}
	}
S
Sujith Manoharan 已提交
1069
	ath_dbg(common, PS, "PowerSave disabled\n");
1070 1071
}

1072
static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
1073
{
1074
	struct ath_softc *sc = hw->priv;
1075 1076
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1077
	struct ieee80211_conf *conf = &hw->conf;
1078
	bool reset_channel = false;
1079

F
Felix Fietkau 已提交
1080
	ath9k_ps_wakeup(sc);
1081
	mutex_lock(&sc->mutex);
1082

1083
	if (changed & IEEE80211_CONF_CHANGE_IDLE) {
1084
		sc->ps_idle = !!(conf->flags & IEEE80211_CONF_IDLE);
1085
		if (sc->ps_idle) {
1086
			ath_cancel_work(sc);
1087 1088 1089
			ath9k_stop_btcoex(sc);
		} else {
			ath9k_start_btcoex(sc);
1090 1091 1092 1093 1094
			/*
			 * The chip needs a reset to properly wake up from
			 * full sleep
			 */
			reset_channel = ah->chip_fullsleep;
1095
		}
1096
	}
1097

1098 1099 1100 1101 1102 1103
	/*
	 * 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.
	 */
1104
	if (changed & IEEE80211_CONF_CHANGE_PS) {
1105 1106
		unsigned long flags;
		spin_lock_irqsave(&sc->sc_pm_lock, flags);
1107 1108
		if (conf->flags & IEEE80211_CONF_PS)
			ath9k_enable_ps(sc);
1109 1110
		else
			ath9k_disable_ps(sc);
1111
		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1112 1113
	}

S
Sujith 已提交
1114 1115
	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
		if (conf->flags & IEEE80211_CONF_MONITOR) {
1116
			ath_dbg(common, CONFIG, "Monitor mode is enabled\n");
1117 1118
			sc->sc_ah->is_monitoring = true;
		} else {
1119
			ath_dbg(common, CONFIG, "Monitor mode is disabled\n");
1120
			sc->sc_ah->is_monitoring = false;
S
Sujith 已提交
1121 1122 1123
		}
	}

1124
	if ((changed & IEEE80211_CONF_CHANGE_CHANNEL) || reset_channel) {
1125
		struct ieee80211_channel *curchan = hw->conf.channel;
1126
		int pos = curchan->hw_value;
1127 1128 1129 1130 1131
		int old_pos = -1;
		unsigned long flags;

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

1133
		ath_dbg(common, CONFIG, "Set channel: %d MHz type: %d\n",
1134
			curchan->center_freq, conf->channel_type);
1135

1136 1137 1138 1139 1140
		/* 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);

1141 1142 1143 1144
		/*
		 * Preserve the current channel values, before updating
		 * the same channel
		 */
1145 1146
		if (ah->curchan && (old_pos == pos))
			ath9k_hw_getnf(ah, ah->curchan);
1147 1148 1149 1150

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

1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
		/*
		 * 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));
		}

1171
		if (ath_set_channel(sc, hw, &sc->sc_ah->channels[pos]) < 0) {
1172
			ath_err(common, "Unable to set channel\n");
1173
			mutex_unlock(&sc->mutex);
1174
			ath9k_ps_restore(sc);
1175 1176
			return -EINVAL;
		}
1177 1178 1179 1180 1181 1182 1183 1184

		/*
		 * 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 已提交
1185
	}
1186

1187
	if (changed & IEEE80211_CONF_CHANGE_POWER) {
1188
		ath_dbg(common, CONFIG, "Set power: %d\n", conf->power_level);
S
Sujith 已提交
1189
		sc->config.txpowlimit = 2 * conf->power_level;
1190 1191
		ath9k_cmn_update_txpow(ah, sc->curtxpow,
				       sc->config.txpowlimit, &sc->curtxpow);
1192 1193
	}

1194
	mutex_unlock(&sc->mutex);
F
Felix Fietkau 已提交
1195
	ath9k_ps_restore(sc);
1196

1197 1198 1199
	return 0;
}

1200 1201 1202 1203
#define SUPPORTED_FILTERS			\
	(FIF_PROMISC_IN_BSS |			\
	FIF_ALLMULTI |				\
	FIF_CONTROL |				\
1204
	FIF_PSPOLL |				\
1205 1206
	FIF_OTHER_BSS |				\
	FIF_BCN_PRBRESP_PROMISC |		\
1207
	FIF_PROBE_REQ |				\
1208
	FIF_FCSFAIL)
1209

1210 1211 1212 1213
/* FIXME: sc->sc_full_reset ? */
static void ath9k_configure_filter(struct ieee80211_hw *hw,
				   unsigned int changed_flags,
				   unsigned int *total_flags,
1214
				   u64 multicast)
1215
{
1216
	struct ath_softc *sc = hw->priv;
1217
	u32 rfilt;
1218

1219 1220
	changed_flags &= SUPPORTED_FILTERS;
	*total_flags &= SUPPORTED_FILTERS;
1221

S
Sujith 已提交
1222
	sc->rx.rxfilter = *total_flags;
1223
	ath9k_ps_wakeup(sc);
1224 1225
	rfilt = ath_calcrxfilter(sc);
	ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1226
	ath9k_ps_restore(sc);
1227

1228 1229
	ath_dbg(ath9k_hw_common(sc->sc_ah), CONFIG, "Set HW RX filter: 0x%x\n",
		rfilt);
1230
}
1231

1232 1233 1234
static int ath9k_sta_add(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta)
1235
{
1236
	struct ath_softc *sc = hw->priv;
1237 1238 1239
	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 = { };
1240

1241
	ath_node_attach(sc, sta, vif);
1242 1243 1244 1245 1246

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

1247
	an->ps_key = ath_key_config(common, vif, sta, &ps_key);
1248 1249 1250 1251

	return 0;
}

1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265
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);
}

1266 1267 1268 1269
static int ath9k_sta_remove(struct ieee80211_hw *hw,
			    struct ieee80211_vif *vif,
			    struct ieee80211_sta *sta)
{
1270
	struct ath_softc *sc = hw->priv;
1271

1272
	ath9k_del_ps_key(sc, vif, sta);
1273 1274 1275
	ath_node_detach(sc, sta);

	return 0;
1276 1277
}

1278 1279 1280 1281 1282 1283 1284 1285
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;

1286
	if (!sta->ht_cap.ht_supported)
1287 1288
		return;

1289 1290 1291
	switch (cmd) {
	case STA_NOTIFY_SLEEP:
		an->sleeping = true;
1292
		ath_tx_aggr_sleep(sta, sc, an);
1293 1294 1295 1296 1297 1298 1299 1300
		break;
	case STA_NOTIFY_AWAKE:
		an->sleeping = false;
		ath_tx_aggr_wakeup(sc, an);
		break;
	}
}

1301 1302
static int ath9k_conf_tx(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif, u16 queue,
1303
			 const struct ieee80211_tx_queue_params *params)
1304
{
1305
	struct ath_softc *sc = hw->priv;
1306
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1307
	struct ath_txq *txq;
1308
	struct ath9k_tx_queue_info qi;
1309
	int ret = 0;
1310

1311
	if (queue >= IEEE80211_NUM_ACS)
1312
		return 0;
1313

1314 1315
	txq = sc->tx.txq_map[queue];

1316
	ath9k_ps_wakeup(sc);
1317 1318
	mutex_lock(&sc->mutex);

1319 1320
	memset(&qi, 0, sizeof(struct ath9k_tx_queue_info));

1321 1322 1323
	qi.tqi_aifs = params->aifs;
	qi.tqi_cwmin = params->cw_min;
	qi.tqi_cwmax = params->cw_max;
1324
	qi.tqi_burstTime = params->txop * 32;
1325

1326
	ath_dbg(common, CONFIG,
J
Joe Perches 已提交
1327 1328 1329
		"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);
1330

1331
	ath_update_max_aggr_framelen(sc, queue, qi.tqi_burstTime);
1332
	ret = ath_txq_update(sc, txq->axq_qnum, &qi);
1333
	if (ret)
1334
		ath_err(common, "TXQ Update failed\n");
1335

1336
	mutex_unlock(&sc->mutex);
1337
	ath9k_ps_restore(sc);
1338

1339 1340
	return ret;
}
1341

1342 1343
static int ath9k_set_key(struct ieee80211_hw *hw,
			 enum set_key_cmd cmd,
1344 1345
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta,
1346 1347
			 struct ieee80211_key_conf *key)
{
1348
	struct ath_softc *sc = hw->priv;
1349
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1350
	int ret = 0;
1351

1352
	if (ath9k_modparam_nohwcrypt)
1353 1354
		return -ENOSPC;

C
Chun-Yeow Yeoh 已提交
1355 1356
	if ((vif->type == NL80211_IFTYPE_ADHOC ||
	     vif->type == NL80211_IFTYPE_MESH_POINT) &&
J
Jouni Malinen 已提交
1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369
	    (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;
	}

1370
	mutex_lock(&sc->mutex);
1371
	ath9k_ps_wakeup(sc);
1372
	ath_dbg(common, CONFIG, "Set HW Key\n");
1373

1374 1375
	switch (cmd) {
	case SET_KEY:
1376 1377 1378
		if (sta)
			ath9k_del_ps_key(sc, vif, sta);

1379
		ret = ath_key_config(common, vif, sta, key);
1380 1381
		if (ret >= 0) {
			key->hw_key_idx = ret;
1382 1383
			/* push IV and Michael MIC generation to stack */
			key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
1384
			if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
1385
				key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
1386 1387
			if (sc->sc_ah->sw_mgmt_crypto &&
			    key->cipher == WLAN_CIPHER_SUITE_CCMP)
1388
				key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
1389
			ret = 0;
1390 1391 1392
		}
		break;
	case DISABLE_KEY:
1393
		ath_key_delete(common, key);
1394 1395 1396 1397
		break;
	default:
		ret = -EINVAL;
	}
1398

1399
	ath9k_ps_restore(sc);
1400 1401
	mutex_unlock(&sc->mutex);

1402 1403
	return ret;
}
1404 1405 1406

static void ath9k_set_assoc_state(struct ath_softc *sc,
				  struct ieee80211_vif *vif)
1407 1408 1409
{
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	struct ath_vif *avp = (void *)vif->drv_priv;
1410
	struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
S
Sujith Manoharan 已提交
1411
	unsigned long flags;
1412 1413 1414 1415

	set_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags);
	avp->primary_sta_vif = true;

1416
	/*
1417 1418 1419 1420
	 * 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.
1421
	 */
1422
	if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
1423 1424
		return;

1425 1426 1427
	memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
	common->curaid = bss_conf->aid;
	ath9k_hw_write_associd(sc->sc_ah);
S
Sujith Manoharan 已提交
1428

1429 1430
	sc->last_rssi = ATH_RSSI_DUMMY_MARKER;
	sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
1431

1432 1433 1434
	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);
1435

1436 1437 1438
	if (ath9k_hw_mci_is_enabled(sc->sc_ah))
		ath9k_mci_update_wlan_channels(sc, false);

1439 1440 1441
	ath_dbg(common, CONFIG,
		"Primary Station interface: %pM, BSSID: %pM\n",
		vif->addr, common->curbssid);
1442 1443
}

1444
static void ath9k_bss_assoc_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
1445
{
1446
	struct ath_softc *sc = data;
1447 1448
	struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;

1449
	if (test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags))
1450 1451
		return;

1452 1453
	if (bss_conf->assoc)
		ath9k_set_assoc_state(sc, vif);
1454
}
1455

1456 1457 1458 1459 1460
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 已提交
1461 1462 1463 1464 1465
#define CHECK_ANI				\
	(BSS_CHANGED_ASSOC |			\
	 BSS_CHANGED_IBSS |			\
	 BSS_CHANGED_BEACON_ENABLED)

1466
	struct ath_softc *sc = hw->priv;
1467
	struct ath_hw *ah = sc->sc_ah;
1468
	struct ath_common *common = ath9k_hw_common(ah);
1469
	struct ath_vif *avp = (void *)vif->drv_priv;
1470
	int slottime;
1471

1472
	ath9k_ps_wakeup(sc);
1473 1474
	mutex_lock(&sc->mutex);

1475
	if (changed & BSS_CHANGED_ASSOC) {
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486
		ath_dbg(common, CONFIG, "BSSID %pM Changed ASSOC %d\n",
			bss_conf->bssid, bss_conf->assoc);

		if (avp->primary_sta_vif && !bss_conf->assoc) {
			clear_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags);
			avp->primary_sta_vif = false;

			if (ah->opmode == NL80211_IFTYPE_STATION)
				clear_bit(SC_OP_BEACONS, &sc->sc_flags);
		}

1487 1488 1489
		ieee80211_iterate_active_interfaces_atomic(
			sc->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
			ath9k_bss_assoc_iter, sc);
1490

1491 1492 1493 1494 1495
		if (!test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags) &&
		    ah->opmode == NL80211_IFTYPE_STATION) {
			memset(common->curbssid, 0, ETH_ALEN);
			common->curaid = 0;
			ath9k_hw_write_associd(sc->sc_ah);
1496 1497
			if (ath9k_hw_mci_is_enabled(sc->sc_ah))
				ath9k_mci_update_wlan_channels(sc, true);
1498
		}
S
Sujith 已提交
1499
	}
1500

1501 1502 1503 1504 1505 1506
	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 已提交
1507 1508
	if ((changed & BSS_CHANGED_BEACON_ENABLED) ||
	    (changed & BSS_CHANGED_BEACON_INT)) {
1509 1510 1511
		if (ah->opmode == NL80211_IFTYPE_AP &&
		    bss_conf->enable_beacon)
			ath9k_set_tsfadjust(sc, vif);
S
Sujith Manoharan 已提交
1512 1513
		if (ath9k_allow_beacon_config(sc, vif))
			ath9k_beacon_config(sc, vif, changed);
1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532
	}

	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);
		}
1533 1534
	}

S
Sujith Manoharan 已提交
1535 1536 1537
	if (changed & CHECK_ANI)
		ath_check_ani(sc);

1538
	mutex_unlock(&sc->mutex);
1539
	ath9k_ps_restore(sc);
S
Sujith Manoharan 已提交
1540 1541

#undef CHECK_ANI
1542
}
1543

1544
static u64 ath9k_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
1545
{
1546
	struct ath_softc *sc = hw->priv;
1547
	u64 tsf;
1548

1549
	mutex_lock(&sc->mutex);
1550
	ath9k_ps_wakeup(sc);
1551
	tsf = ath9k_hw_gettsf64(sc->sc_ah);
1552
	ath9k_ps_restore(sc);
1553
	mutex_unlock(&sc->mutex);
1554

1555 1556
	return tsf;
}
1557

1558 1559 1560
static void ath9k_set_tsf(struct ieee80211_hw *hw,
			  struct ieee80211_vif *vif,
			  u64 tsf)
1561
{
1562
	struct ath_softc *sc = hw->priv;
1563

1564
	mutex_lock(&sc->mutex);
1565
	ath9k_ps_wakeup(sc);
1566
	ath9k_hw_settsf64(sc->sc_ah, tsf);
1567
	ath9k_ps_restore(sc);
1568
	mutex_unlock(&sc->mutex);
1569 1570
}

1571
static void ath9k_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
1572
{
1573
	struct ath_softc *sc = hw->priv;
1574

1575
	mutex_lock(&sc->mutex);
1576 1577

	ath9k_ps_wakeup(sc);
1578
	ath9k_hw_reset_tsf(sc->sc_ah);
1579 1580
	ath9k_ps_restore(sc);

1581
	mutex_unlock(&sc->mutex);
1582
}
1583

1584
static int ath9k_ampdu_action(struct ieee80211_hw *hw,
1585
			      struct ieee80211_vif *vif,
1586 1587
			      enum ieee80211_ampdu_mlme_action action,
			      struct ieee80211_sta *sta,
1588
			      u16 tid, u16 *ssn, u8 buf_size)
1589
{
1590
	struct ath_softc *sc = hw->priv;
1591
	int ret = 0;
1592

1593 1594
	local_bh_disable();

1595 1596 1597 1598 1599 1600
	switch (action) {
	case IEEE80211_AMPDU_RX_START:
		break;
	case IEEE80211_AMPDU_RX_STOP:
		break;
	case IEEE80211_AMPDU_TX_START:
1601
		ath9k_ps_wakeup(sc);
1602 1603 1604
		ret = ath_tx_aggr_start(sc, sta, tid, ssn);
		if (!ret)
			ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
1605
		ath9k_ps_restore(sc);
1606 1607
		break;
	case IEEE80211_AMPDU_TX_STOP:
1608
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
1609
		ath_tx_aggr_stop(sc, sta, tid);
1610
		ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
1611
		ath9k_ps_restore(sc);
1612
		break;
1613
	case IEEE80211_AMPDU_TX_OPERATIONAL:
1614
		ath9k_ps_wakeup(sc);
1615
		ath_tx_aggr_resume(sc, sta, tid);
1616
		ath9k_ps_restore(sc);
1617
		break;
1618
	default:
1619
		ath_err(ath9k_hw_common(sc->sc_ah), "Unknown AMPDU action\n");
1620 1621
	}

1622 1623
	local_bh_enable();

1624
	return ret;
1625 1626
}

1627 1628 1629
static int ath9k_get_survey(struct ieee80211_hw *hw, int idx,
			     struct survey_info *survey)
{
1630
	struct ath_softc *sc = hw->priv;
1631
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1632
	struct ieee80211_supported_band *sband;
1633 1634 1635 1636 1637 1638 1639
	struct ieee80211_channel *chan;
	unsigned long flags;
	int pos;

	spin_lock_irqsave(&common->cc_lock, flags);
	if (idx == 0)
		ath_update_survey_stats(sc);
1640 1641 1642 1643 1644 1645

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

1647 1648
	if (!sband)
		sband = hw->wiphy->bands[IEEE80211_BAND_5GHZ];
1649

1650 1651 1652
	if (!sband || idx >= sband->n_channels) {
		spin_unlock_irqrestore(&common->cc_lock, flags);
		return -ENOENT;
1653
	}
1654

1655 1656 1657 1658 1659 1660
	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);

1661 1662 1663
	return 0;
}

1664 1665
static void ath9k_set_coverage_class(struct ieee80211_hw *hw, u8 coverage_class)
{
1666
	struct ath_softc *sc = hw->priv;
1667 1668 1669 1670
	struct ath_hw *ah = sc->sc_ah;

	mutex_lock(&sc->mutex);
	ah->coverage_class = coverage_class;
1671 1672

	ath9k_ps_wakeup(sc);
1673
	ath9k_hw_init_global_settings(ah);
1674 1675
	ath9k_ps_restore(sc);

1676 1677 1678
	mutex_unlock(&sc->mutex);
}

1679 1680 1681
static void ath9k_flush(struct ieee80211_hw *hw, bool drop)
{
	struct ath_softc *sc = hw->priv;
1682 1683
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1684 1685
	int timeout = 200; /* ms */
	int i, j;
1686
	bool drain_txq;
1687 1688 1689 1690

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

1691
	if (ah->ah_flags & AH_UNPLUGGED) {
1692
		ath_dbg(common, ANY, "Device has been unplugged!\n");
1693 1694 1695 1696
		mutex_unlock(&sc->mutex);
		return;
	}

S
Sujith Manoharan 已提交
1697
	if (test_bit(SC_OP_INVALID, &sc->sc_flags)) {
1698
		ath_dbg(common, ANY, "Device not present\n");
1699 1700 1701 1702
		mutex_unlock(&sc->mutex);
		return;
	}

1703
	for (j = 0; j < timeout; j++) {
1704
		bool npend = false;
1705 1706 1707

		if (j)
			usleep_range(1000, 2000);
1708

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

1713 1714 1715 1716
			npend = ath9k_has_pending_frames(sc, &sc->tx.txq[i]);

			if (npend)
				break;
1717
		}
1718 1719

		if (!npend)
1720
		    break;
1721 1722
	}

1723 1724 1725 1726 1727
	if (drop) {
		ath9k_ps_wakeup(sc);
		spin_lock_bh(&sc->sc_pcu_lock);
		drain_txq = ath_drain_all_txq(sc, false);
		spin_unlock_bh(&sc->sc_pcu_lock);
1728

1729 1730
		if (!drain_txq)
			ath_reset(sc, false);
1731

1732 1733 1734
		ath9k_ps_restore(sc);
		ieee80211_wake_queues(hw);
	}
1735

1736 1737 1738 1739
	ieee80211_queue_delayed_work(hw, &sc->tx_complete_work, 0);
	mutex_unlock(&sc->mutex);
}

1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754
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;
}

1755
static int ath9k_tx_last_beacon(struct ieee80211_hw *hw)
1756 1757 1758 1759 1760 1761 1762
{
	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;
1763
	bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
1764 1765 1766 1767 1768 1769
	int status;

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

S
Sujith Manoharan 已提交
1770
	if (!vif->bss_conf.enable_beacon)
1771 1772
		return 0;

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

1775
	if (!sc->beacon.tx_processed && !edma) {
1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795
		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;
}

1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809
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;
}

1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827
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;
}

1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841
static bool validate_antenna_mask(struct ath_hw *ah, u32 val)
{
	switch (val & 0x7) {
	case 0x1:
	case 0x3:
	case 0x7:
		return true;
	case 0x2:
		return (ah->caps.rx_chainmask == 1);
	default:
		return false;
	}
}

1842 1843 1844 1845 1846
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;

1847 1848 1849 1850
	if (ah->caps.rx_chainmask != 1)
		rx_ant |= tx_ant;

	if (!validate_antenna_mask(ah, rx_ant) || !tx_ant)
1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879
		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);
	ath9k_reload_chainmask_settings(sc);

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

1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082
#ifdef CONFIG_PM_SLEEP

static void ath9k_wow_map_triggers(struct ath_softc *sc,
				   struct cfg80211_wowlan *wowlan,
				   u32 *wow_triggers)
{
	if (wowlan->disconnect)
		*wow_triggers |= AH_WOW_LINK_CHANGE |
				 AH_WOW_BEACON_MISS;
	if (wowlan->magic_pkt)
		*wow_triggers |= AH_WOW_MAGIC_PATTERN_EN;

	if (wowlan->n_patterns)
		*wow_triggers |= AH_WOW_USER_PATTERN_EN;

	sc->wow_enabled = *wow_triggers;

}

static void ath9k_wow_add_disassoc_deauth_pattern(struct ath_softc *sc)
{
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	struct ath9k_hw_capabilities *pcaps = &ah->caps;
	int pattern_count = 0;
	int i, byte_cnt;
	u8 dis_deauth_pattern[MAX_PATTERN_SIZE];
	u8 dis_deauth_mask[MAX_PATTERN_SIZE];

	memset(dis_deauth_pattern, 0, MAX_PATTERN_SIZE);
	memset(dis_deauth_mask, 0, MAX_PATTERN_SIZE);

	/*
	 * Create Dissassociate / Deauthenticate packet filter
	 *
	 *     2 bytes        2 byte    6 bytes   6 bytes  6 bytes
	 *  +--------------+----------+---------+--------+--------+----
	 *  + Frame Control+ Duration +   DA    +  SA    +  BSSID +
	 *  +--------------+----------+---------+--------+--------+----
	 *
	 * The above is the management frame format for disassociate/
	 * deauthenticate pattern, from this we need to match the first byte
	 * of 'Frame Control' and DA, SA, and BSSID fields
	 * (skipping 2nd byte of FC and Duration feild.
	 *
	 * Disassociate pattern
	 * --------------------
	 * Frame control = 00 00 1010
	 * DA, SA, BSSID = x:x:x:x:x:x
	 * Pattern will be A0000000 | x:x:x:x:x:x | x:x:x:x:x:x
	 *			    | x:x:x:x:x:x  -- 22 bytes
	 *
	 * Deauthenticate pattern
	 * ----------------------
	 * Frame control = 00 00 1100
	 * DA, SA, BSSID = x:x:x:x:x:x
	 * Pattern will be C0000000 | x:x:x:x:x:x | x:x:x:x:x:x
	 *			    | x:x:x:x:x:x  -- 22 bytes
	 */

	/* Create Disassociate Pattern first */

	byte_cnt = 0;

	/* Fill out the mask with all FF's */

	for (i = 0; i < MAX_PATTERN_MASK_SIZE; i++)
		dis_deauth_mask[i] = 0xff;

	/* copy the first byte of frame control field */
	dis_deauth_pattern[byte_cnt] = 0xa0;
	byte_cnt++;

	/* skip 2nd byte of frame control and Duration field */
	byte_cnt += 3;

	/*
	 * need not match the destination mac address, it can be a broadcast
	 * mac address or an unicast to this station
	 */
	byte_cnt += 6;

	/* copy the source mac address */
	memcpy((dis_deauth_pattern + byte_cnt), common->curbssid, ETH_ALEN);

	byte_cnt += 6;

	/* copy the bssid, its same as the source mac address */

	memcpy((dis_deauth_pattern + byte_cnt), common->curbssid, ETH_ALEN);

	/* Create Disassociate pattern mask */

	if (pcaps->hw_caps & ATH9K_HW_WOW_PATTERN_MATCH_EXACT) {

		if (pcaps->hw_caps & ATH9K_HW_WOW_PATTERN_MATCH_DWORD) {
			/*
			 * for AR9280, because of hardware limitation, the
			 * first 4 bytes have to be matched for all patterns.
			 * the mask for disassociation and de-auth pattern
			 * matching need to enable the first 4 bytes.
			 * also the duration field needs to be filled.
			 */
			dis_deauth_mask[0] = 0xf0;

			/*
			 * fill in duration field
			 FIXME: what is the exact value ?
			 */
			dis_deauth_pattern[2] = 0xff;
			dis_deauth_pattern[3] = 0xff;
		} else {
			dis_deauth_mask[0] = 0xfe;
		}

		dis_deauth_mask[1] = 0x03;
		dis_deauth_mask[2] = 0xc0;
	} else {
		dis_deauth_mask[0] = 0xef;
		dis_deauth_mask[1] = 0x3f;
		dis_deauth_mask[2] = 0x00;
		dis_deauth_mask[3] = 0xfc;
	}

	ath_dbg(common, WOW, "Adding disassoc/deauth patterns for WoW\n");

	ath9k_hw_wow_apply_pattern(ah, dis_deauth_pattern, dis_deauth_mask,
				   pattern_count, byte_cnt);

	pattern_count++;
	/*
	 * for de-authenticate pattern, only the first byte of the frame
	 * control field gets changed from 0xA0 to 0xC0
	 */
	dis_deauth_pattern[0] = 0xC0;

	ath9k_hw_wow_apply_pattern(ah, dis_deauth_pattern, dis_deauth_mask,
				   pattern_count, byte_cnt);

}

static void ath9k_wow_add_pattern(struct ath_softc *sc,
				  struct cfg80211_wowlan *wowlan)
{
	struct ath_hw *ah = sc->sc_ah;
	struct ath9k_wow_pattern *wow_pattern = NULL;
	struct cfg80211_wowlan_trig_pkt_pattern *patterns = wowlan->patterns;
	int mask_len;
	s8 i = 0;

	if (!wowlan->n_patterns)
		return;

	/*
	 * Add the new user configured patterns
	 */
	for (i = 0; i < wowlan->n_patterns; i++) {

		wow_pattern = kzalloc(sizeof(*wow_pattern), GFP_KERNEL);

		if (!wow_pattern)
			return;

		/*
		 * TODO: convert the generic user space pattern to
		 * appropriate chip specific/802.11 pattern.
		 */

		mask_len = DIV_ROUND_UP(wowlan->patterns[i].pattern_len, 8);
		memset(wow_pattern->pattern_bytes, 0, MAX_PATTERN_SIZE);
		memset(wow_pattern->mask_bytes, 0, MAX_PATTERN_SIZE);
		memcpy(wow_pattern->pattern_bytes, patterns[i].pattern,
		       patterns[i].pattern_len);
		memcpy(wow_pattern->mask_bytes, patterns[i].mask, mask_len);
		wow_pattern->pattern_len = patterns[i].pattern_len;

		/*
		 * just need to take care of deauth and disssoc pattern,
		 * make sure we don't overwrite them.
		 */

		ath9k_hw_wow_apply_pattern(ah, wow_pattern->pattern_bytes,
					   wow_pattern->mask_bytes,
					   i + 2,
					   wow_pattern->pattern_len);
		kfree(wow_pattern);

	}

}

static int ath9k_suspend(struct ieee80211_hw *hw,
			 struct cfg80211_wowlan *wowlan)
{
	struct ath_softc *sc = hw->priv;
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	u32 wow_triggers_enabled = 0;
	int ret = 0;

	mutex_lock(&sc->mutex);

	ath_cancel_work(sc);
2083
	ath_stop_ani(sc);
2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235
	del_timer_sync(&sc->rx_poll_timer);

	if (test_bit(SC_OP_INVALID, &sc->sc_flags)) {
		ath_dbg(common, ANY, "Device not present\n");
		ret = -EINVAL;
		goto fail_wow;
	}

	if (WARN_ON(!wowlan)) {
		ath_dbg(common, WOW, "None of the WoW triggers enabled\n");
		ret = -EINVAL;
		goto fail_wow;
	}

	if (!device_can_wakeup(sc->dev)) {
		ath_dbg(common, WOW, "device_can_wakeup failed, WoW is not enabled\n");
		ret = 1;
		goto fail_wow;
	}

	/*
	 * none of the sta vifs are associated
	 * and we are not currently handling multivif
	 * cases, for instance we have to seperately
	 * configure 'keep alive frame' for each
	 * STA.
	 */

	if (!test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) {
		ath_dbg(common, WOW, "None of the STA vifs are associated\n");
		ret = 1;
		goto fail_wow;
	}

	if (sc->nvifs > 1) {
		ath_dbg(common, WOW, "WoW for multivif is not yet supported\n");
		ret = 1;
		goto fail_wow;
	}

	ath9k_wow_map_triggers(sc, wowlan, &wow_triggers_enabled);

	ath_dbg(common, WOW, "WoW triggers enabled 0x%x\n",
		wow_triggers_enabled);

	ath9k_ps_wakeup(sc);

	ath9k_stop_btcoex(sc);

	/*
	 * Enable wake up on recieving disassoc/deauth
	 * frame by default.
	 */
	ath9k_wow_add_disassoc_deauth_pattern(sc);

	if (wow_triggers_enabled & AH_WOW_USER_PATTERN_EN)
		ath9k_wow_add_pattern(sc, wowlan);

	spin_lock_bh(&sc->sc_pcu_lock);
	/*
	 * To avoid false wake, we enable beacon miss interrupt only
	 * when we go to sleep. We save the current interrupt mask
	 * so we can restore it after the system wakes up
	 */
	sc->wow_intr_before_sleep = ah->imask;
	ah->imask &= ~ATH9K_INT_GLOBAL;
	ath9k_hw_disable_interrupts(ah);
	ah->imask = ATH9K_INT_BMISS | ATH9K_INT_GLOBAL;
	ath9k_hw_set_interrupts(ah);
	ath9k_hw_enable_interrupts(ah);

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

	ath9k_hw_wow_enable(ah, wow_triggers_enabled);

	ath9k_ps_restore(sc);
	ath_dbg(common, ANY, "WoW enabled in ath9k\n");
	atomic_inc(&sc->wow_sleep_proc_intr);

fail_wow:
	mutex_unlock(&sc->mutex);
	return ret;
}

static int ath9k_resume(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 wow_status;

	mutex_lock(&sc->mutex);

	ath9k_ps_wakeup(sc);

	spin_lock_bh(&sc->sc_pcu_lock);

	ath9k_hw_disable_interrupts(ah);
	ah->imask = sc->wow_intr_before_sleep;
	ath9k_hw_set_interrupts(ah);
	ath9k_hw_enable_interrupts(ah);

	spin_unlock_bh(&sc->sc_pcu_lock);

	wow_status = ath9k_hw_wow_wakeup(ah);

	if (atomic_read(&sc->wow_got_bmiss_intr) == 0) {
		/*
		 * some devices may not pick beacon miss
		 * as the reason they woke up so we add
		 * that here for that shortcoming.
		 */
		wow_status |= AH_WOW_BEACON_MISS;
		atomic_dec(&sc->wow_got_bmiss_intr);
		ath_dbg(common, ANY, "Beacon miss interrupt picked up during WoW sleep\n");
	}

	atomic_dec(&sc->wow_sleep_proc_intr);

	if (wow_status) {
		ath_dbg(common, ANY, "Waking up due to WoW triggers %s with WoW status = %x\n",
			ath9k_hw_wow_event_to_string(wow_status), wow_status);
	}

	ath_restart_work(sc);
	ath9k_start_btcoex(sc);

	ath9k_ps_restore(sc);
	mutex_unlock(&sc->mutex);

	return 0;
}

static void ath9k_set_wakeup(struct ieee80211_hw *hw, bool enabled)
{
	struct ath_softc *sc = hw->priv;

	mutex_lock(&sc->mutex);
	device_init_wakeup(sc->dev, 1);
	device_set_wakeup_enable(sc->dev, enabled);
	mutex_unlock(&sc->mutex);
}

#endif

2236
struct ieee80211_ops ath9k_ops = {
2237 2238 2239 2240
	.tx 		    = ath9k_tx,
	.start 		    = ath9k_start,
	.stop 		    = ath9k_stop,
	.add_interface 	    = ath9k_add_interface,
2241
	.change_interface   = ath9k_change_interface,
2242 2243 2244
	.remove_interface   = ath9k_remove_interface,
	.config 	    = ath9k_config,
	.configure_filter   = ath9k_configure_filter,
2245 2246
	.sta_add	    = ath9k_sta_add,
	.sta_remove	    = ath9k_sta_remove,
2247
	.sta_notify         = ath9k_sta_notify,
2248 2249 2250 2251
	.conf_tx 	    = ath9k_conf_tx,
	.bss_info_changed   = ath9k_bss_info_changed,
	.set_key            = ath9k_set_key,
	.get_tsf 	    = ath9k_get_tsf,
2252
	.set_tsf 	    = ath9k_set_tsf,
2253
	.reset_tsf 	    = ath9k_reset_tsf,
2254
	.ampdu_action       = ath9k_ampdu_action,
2255
	.get_survey	    = ath9k_get_survey,
J
Johannes Berg 已提交
2256
	.rfkill_poll        = ath9k_rfkill_poll_state,
2257
	.set_coverage_class = ath9k_set_coverage_class,
2258
	.flush		    = ath9k_flush,
2259
	.tx_frames_pending  = ath9k_tx_frames_pending,
2260 2261
	.tx_last_beacon     = ath9k_tx_last_beacon,
	.get_stats	    = ath9k_get_stats,
2262 2263
	.set_antenna	    = ath9k_set_antenna,
	.get_antenna	    = ath9k_get_antenna,
2264

2265 2266 2267 2268 2269 2270
#ifdef CONFIG_PM_SLEEP
	.suspend	    = ath9k_suspend,
	.resume		    = ath9k_resume,
	.set_wakeup	    = ath9k_set_wakeup,
#endif

2271 2272
#ifdef CONFIG_ATH9K_DEBUGFS
	.get_et_sset_count  = ath9k_get_et_sset_count,
2273 2274 2275 2276 2277 2278 2279
	.get_et_stats       = ath9k_get_et_stats,
	.get_et_strings     = ath9k_get_et_strings,
#endif

#if defined(CONFIG_MAC80211_DEBUGFS) && defined(CONFIG_ATH9K_DEBUGFS)
	.sta_add_debugfs    = ath9k_sta_add_debugfs,
	.sta_remove_debugfs = ath9k_sta_remove_debugfs,
2280
#endif
2281
};