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

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

21 22
static void ath_cache_conf_rate(struct ath_softc *sc,
				struct ieee80211_conf *conf)
S
Sujith 已提交
23
{
24 25 26
	switch (conf->channel->band) {
	case IEEE80211_BAND_2GHZ:
		if (conf_is_ht20(conf))
27
			sc->cur_rate_mode = ATH9K_MODE_11NG_HT20;
28
		else if (conf_is_ht40_minus(conf))
29
			sc->cur_rate_mode = ATH9K_MODE_11NG_HT40MINUS;
30
		else if (conf_is_ht40_plus(conf))
31
			sc->cur_rate_mode = ATH9K_MODE_11NG_HT40PLUS;
32
		else
33
			sc->cur_rate_mode = ATH9K_MODE_11G;
34 35 36
		break;
	case IEEE80211_BAND_5GHZ:
		if (conf_is_ht20(conf))
37
			sc->cur_rate_mode = ATH9K_MODE_11NA_HT20;
38
		else if (conf_is_ht40_minus(conf))
39
			sc->cur_rate_mode = ATH9K_MODE_11NA_HT40MINUS;
40
		else if (conf_is_ht40_plus(conf))
41
			sc->cur_rate_mode = ATH9K_MODE_11NA_HT40PLUS;
42
		else
43
			sc->cur_rate_mode = ATH9K_MODE_11A;
44 45
		break;
	default:
46
		BUG_ON(1);
47 48
		break;
	}
S
Sujith 已提交
49 50 51 52
}

static void ath_update_txpow(struct ath_softc *sc)
{
53
	struct ath_hw *ah = sc->sc_ah;
S
Sujith 已提交
54 55
	u32 txpow;

S
Sujith 已提交
56 57
	if (sc->curtxpow != sc->config.txpowlimit) {
		ath9k_hw_set_txpowerlimit(ah, sc->config.txpowlimit);
S
Sujith 已提交
58 59
		/* read back in case value is clamped */
		ath9k_hw_getcapability(ah, ATH9K_CAP_TXPOW, 1, &txpow);
S
Sujith 已提交
60
		sc->curtxpow = txpow;
S
Sujith 已提交
61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98
	}
}

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

99 100 101 102 103 104 105 106 107 108 109 110 111
static struct ath9k_channel *ath_get_curchannel(struct ath_softc *sc,
						struct ieee80211_hw *hw)
{
	struct ieee80211_channel *curchan = hw->conf.channel;
	struct ath9k_channel *channel;
	u8 chan_idx;

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

S
Sujith 已提交
112
bool ath9k_setpower(struct ath_softc *sc, enum ath9k_power_mode mode)
113 114 115 116
{
	unsigned long flags;
	bool ret;

117 118 119
	spin_lock_irqsave(&sc->sc_pm_lock, flags);
	ret = ath9k_hw_setpower(sc->sc_ah, mode);
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
120 121 122 123

	return ret;
}

124 125 126 127 128 129 130 131
void ath9k_ps_wakeup(struct ath_softc *sc)
{
	unsigned long flags;

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

132
	ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
133 134 135 136 137 138 139 140 141 142 143 144 145

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

void ath9k_ps_restore(struct ath_softc *sc)
{
	unsigned long flags;

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

146 147 148 149
	if (sc->ps_idle)
		ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_FULL_SLEEP);
	else if (sc->ps_enabled &&
		 !(sc->ps_flags & (PS_WAIT_FOR_BEACON |
S
Sujith 已提交
150 151 152
			      PS_WAIT_FOR_CAB |
			      PS_WAIT_FOR_PSPOLL_DATA |
			      PS_WAIT_FOR_TX_ACK)))
153
		ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_NETWORK_SLEEP);
154 155 156 157 158

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

S
Sujith 已提交
159 160 161 162 163
/*
 * 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.
*/
164 165
int ath_set_channel(struct ath_softc *sc, struct ieee80211_hw *hw,
		    struct ath9k_channel *hchan)
S
Sujith 已提交
166
{
167
	struct ath_hw *ah = sc->sc_ah;
168
	struct ath_common *common = ath9k_hw_common(ah);
L
Luis R. Rodriguez 已提交
169
	struct ieee80211_conf *conf = &common->hw->conf;
S
Sujith 已提交
170
	bool fastcc = true, stopped;
171 172
	struct ieee80211_channel *channel = hw->conf.channel;
	int r;
S
Sujith 已提交
173 174 175 176

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

177 178
	ath9k_ps_wakeup(sc);

179 180 181 182 183 184 185 186 187 188
	/*
	 * This is only performed if the channel settings have
	 * actually changed.
	 *
	 * To switch channels clear any pending DMA operations;
	 * wait long enough for the RX fifo to drain, reset the
	 * hardware at the new frequency, and then re-enable
	 * the relevant bits of the h/w.
	 */
	ath9k_hw_set_interrupts(ah, 0);
S
Sujith 已提交
189
	ath_drain_all_txq(sc, false);
190
	stopped = ath_stoprecv(sc);
S
Sujith 已提交
191

192 193 194
	/* XXX: do not flush receive queue here. We don't want
	 * to flush data frames already in queue because of
	 * changing channel. */
S
Sujith 已提交
195

196 197 198
	if (!stopped || (sc->sc_flags & SC_OP_FULL_RESET))
		fastcc = false;

199
	ath_print(common, ATH_DBG_CONFIG,
L
Luis R. Rodriguez 已提交
200
		  "(%u MHz) -> (%u MHz), conf_is_ht40: %d\n",
201
		  sc->sc_ah->curchan->channel,
L
Luis R. Rodriguez 已提交
202
		  channel->center_freq, conf_is_ht40(conf));
S
Sujith 已提交
203

204 205 206 207
	spin_lock_bh(&sc->sc_resetlock);

	r = ath9k_hw_reset(ah, hchan, fastcc);
	if (r) {
208
		ath_print(common, ATH_DBG_FATAL,
209
			  "Unable to reset channel (%u MHz), "
210 211
			  "reset status %d\n",
			  channel->center_freq, r);
212
		spin_unlock_bh(&sc->sc_resetlock);
213
		goto ps_restore;
S
Sujith 已提交
214
	}
215 216 217 218 219
	spin_unlock_bh(&sc->sc_resetlock);

	sc->sc_flags &= ~SC_OP_FULL_RESET;

	if (ath_startrecv(sc) != 0) {
220 221
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to restart recv logic\n");
222 223
		r = -EIO;
		goto ps_restore;
224 225 226 227
	}

	ath_cache_conf_rate(sc, &hw->conf);
	ath_update_txpow(sc);
P
Pavel Roskin 已提交
228
	ath9k_hw_set_interrupts(ah, ah->imask);
229 230

 ps_restore:
231
	ath9k_ps_restore(sc);
232
	return r;
S
Sujith 已提交
233 234 235 236 237 238 239 240 241
}

/*
 *  This routine performs the periodic noise floor calibration function
 *  that is used to adjust and optimize the chip performance.  This
 *  takes environmental changes (location, temperature) into account.
 *  When the task is complete, it reschedules itself depending on the
 *  appropriate interval that was calculated.
 */
S
Sujith 已提交
242
void ath_ani_calibrate(unsigned long data)
S
Sujith 已提交
243
{
244 245
	struct ath_softc *sc = (struct ath_softc *)data;
	struct ath_hw *ah = sc->sc_ah;
246
	struct ath_common *common = ath9k_hw_common(ah);
S
Sujith 已提交
247 248 249 250
	bool longcal = false;
	bool shortcal = false;
	bool aniflag = false;
	unsigned int timestamp = jiffies_to_msecs(jiffies);
251
	u32 cal_interval, short_cal_interval;
S
Sujith 已提交
252

253 254
	short_cal_interval = (ah->opmode == NL80211_IFTYPE_AP) ?
		ATH_AP_SHORT_CALINTERVAL : ATH_STA_SHORT_CALINTERVAL;
S
Sujith 已提交
255

256 257 258 259 260 261
	/* Only calibrate if awake */
	if (sc->sc_ah->power_mode != ATH9K_PM_AWAKE)
		goto set_timer;

	ath9k_ps_wakeup(sc);

S
Sujith 已提交
262
	/* Long calibration runs independently of short calibration. */
263
	if ((timestamp - common->ani.longcal_timer) >= ATH_LONG_CALINTERVAL) {
S
Sujith 已提交
264
		longcal = true;
265
		ath_print(common, ATH_DBG_ANI, "longcal @%lu\n", jiffies);
266
		common->ani.longcal_timer = timestamp;
S
Sujith 已提交
267 268
	}

S
Sujith 已提交
269
	/* Short calibration applies only while caldone is false */
270 271
	if (!common->ani.caldone) {
		if ((timestamp - common->ani.shortcal_timer) >= short_cal_interval) {
S
Sujith 已提交
272
			shortcal = true;
273 274
			ath_print(common, ATH_DBG_ANI,
				  "shortcal @%lu\n", jiffies);
275 276
			common->ani.shortcal_timer = timestamp;
			common->ani.resetcal_timer = timestamp;
S
Sujith 已提交
277 278
		}
	} else {
279
		if ((timestamp - common->ani.resetcal_timer) >=
S
Sujith 已提交
280
		    ATH_RESTART_CALINTERVAL) {
281 282 283
			common->ani.caldone = ath9k_hw_reset_calvalid(ah);
			if (common->ani.caldone)
				common->ani.resetcal_timer = timestamp;
S
Sujith 已提交
284 285 286 287
		}
	}

	/* Verify whether we must check ANI */
288
	if ((timestamp - common->ani.checkani_timer) >= ATH_ANI_POLLINTERVAL) {
S
Sujith 已提交
289
		aniflag = true;
290
		common->ani.checkani_timer = timestamp;
S
Sujith 已提交
291 292 293 294 295 296
	}

	/* Skip all processing if there's nothing to do. */
	if (longcal || shortcal || aniflag) {
		/* Call ANI routine if necessary */
		if (aniflag)
297
			ath9k_hw_ani_monitor(ah, ah->curchan);
S
Sujith 已提交
298 299 300

		/* Perform calibration if necessary */
		if (longcal || shortcal) {
301
			common->ani.caldone =
302 303 304 305
				ath9k_hw_calibrate(ah,
						   ah->curchan,
						   common->rx_chainmask,
						   longcal);
S
Sujith 已提交
306 307

			if (longcal)
308
				common->ani.noise_floor = ath9k_hw_getchan_noise(ah,
S
Sujith 已提交
309 310
								     ah->curchan);

311 312 313 314
			ath_print(common, ATH_DBG_ANI,
				  " calibrate chan %u/%x nf: %d\n",
				  ah->curchan->channel,
				  ah->curchan->channelFlags,
315
				  common->ani.noise_floor);
S
Sujith 已提交
316 317 318
		}
	}

319 320
	ath9k_ps_restore(sc);

321
set_timer:
S
Sujith 已提交
322 323 324 325 326
	/*
	* Set timer interval based on previous results.
	* The interval must be the shortest necessary to satisfy ANI,
	* short calibration and long calibration.
	*/
327
	cal_interval = ATH_LONG_CALINTERVAL;
328
	if (sc->sc_ah->config.enable_ani)
329
		cal_interval = min(cal_interval, (u32)ATH_ANI_POLLINTERVAL);
330
	if (!common->ani.caldone)
331
		cal_interval = min(cal_interval, (u32)short_cal_interval);
S
Sujith 已提交
332

333
	mod_timer(&common->ani.timer, jiffies + msecs_to_jiffies(cal_interval));
S
Sujith 已提交
334 335
}

336
static void ath_start_ani(struct ath_common *common)
S
Sujith 已提交
337 338 339
{
	unsigned long timestamp = jiffies_to_msecs(jiffies);

340 341 342
	common->ani.longcal_timer = timestamp;
	common->ani.shortcal_timer = timestamp;
	common->ani.checkani_timer = timestamp;
S
Sujith 已提交
343

344
	mod_timer(&common->ani.timer,
S
Sujith 已提交
345 346 347
		  jiffies + msecs_to_jiffies(ATH_ANI_POLLINTERVAL));
}

S
Sujith 已提交
348 349 350
/*
 * Update tx/rx chainmask. For legacy association,
 * hard code chainmask to 1x1, for 11n association, use
351 352
 * the chainmask configuration, for bt coexistence, use
 * the chainmask configuration even in legacy mode.
S
Sujith 已提交
353
 */
354
void ath_update_chainmask(struct ath_softc *sc, int is_ht)
S
Sujith 已提交
355
{
356
	struct ath_hw *ah = sc->sc_ah;
357
	struct ath_common *common = ath9k_hw_common(ah);
358

359
	if ((sc->sc_flags & SC_OP_SCANNING) || is_ht ||
360
	    (ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE)) {
361 362
		common->tx_chainmask = ah->caps.tx_chainmask;
		common->rx_chainmask = ah->caps.rx_chainmask;
S
Sujith 已提交
363
	} else {
364 365
		common->tx_chainmask = 1;
		common->rx_chainmask = 1;
S
Sujith 已提交
366 367
	}

368
	ath_print(common, ATH_DBG_CONFIG,
369
		  "tx chmask: %d, rx chmask: %d\n",
370 371
		  common->tx_chainmask,
		  common->rx_chainmask);
S
Sujith 已提交
372 373 374 375 376 377 378 379
}

static void ath_node_attach(struct ath_softc *sc, struct ieee80211_sta *sta)
{
	struct ath_node *an;

	an = (struct ath_node *)sta->drv_priv;

380
	if (sc->sc_flags & SC_OP_TXAGGR) {
S
Sujith 已提交
381
		ath_tx_node_init(sc, an);
S
Sujith 已提交
382
		an->maxampdu = 1 << (IEEE80211_HT_MAX_AMPDU_FACTOR +
383 384
				     sta->ht_cap.ampdu_factor);
		an->mpdudensity = parse_mpdudensity(sta->ht_cap.ampdu_density);
385
		an->last_rssi = ATH_RSSI_DUMMY_MARKER;
386
	}
S
Sujith 已提交
387 388 389 390 391 392 393 394 395 396
}

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

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

S
Sujith 已提交
397
void ath9k_tasklet(unsigned long data)
S
Sujith 已提交
398 399
{
	struct ath_softc *sc = (struct ath_softc *)data;
400
	struct ath_hw *ah = sc->sc_ah;
401
	struct ath_common *common = ath9k_hw_common(ah);
402

S
Sujith 已提交
403
	u32 status = sc->intrstatus;
F
Felix Fietkau 已提交
404
	u32 rxmask;
S
Sujith 已提交
405

406 407
	ath9k_ps_wakeup(sc);

408 409
	if ((status & ATH9K_INT_FATAL) ||
	    !ath9k_hw_check_alive(ah)) {
S
Sujith 已提交
410
		ath_reset(sc, false);
411
		ath9k_ps_restore(sc);
S
Sujith 已提交
412
		return;
S
Sujith 已提交
413
	}
S
Sujith 已提交
414

F
Felix Fietkau 已提交
415 416 417 418 419 420 421
	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) {
S
Sujith 已提交
422
		spin_lock_bh(&sc->rx.rxflushlock);
F
Felix Fietkau 已提交
423 424 425 426 427 428 429

		/* 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 已提交
430
		spin_unlock_bh(&sc->rx.rxflushlock);
S
Sujith 已提交
431 432
	}

433 434 435 436 437 438
	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 已提交
439

440
	if ((status & ATH9K_INT_TSFOOR) && sc->ps_enabled) {
441 442 443 444
		/*
		 * TSF sync does not look correct; remain awake to sync with
		 * the next Beacon.
		 */
445 446
		ath_print(common, ATH_DBG_PS,
			  "TSFOOR - Sync with next Beacon\n");
S
Sujith 已提交
447
		sc->ps_flags |= PS_WAIT_FOR_BEACON | PS_BEACON_SYNC;
448 449
	}

450
	if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
451 452 453
		if (status & ATH9K_INT_GENTIMER)
			ath_gen_timer_isr(sc->sc_ah);

S
Sujith 已提交
454
	/* re-enable hardware interrupt */
P
Pavel Roskin 已提交
455
	ath9k_hw_set_interrupts(ah, ah->imask);
456
	ath9k_ps_restore(sc);
S
Sujith 已提交
457 458
}

459
irqreturn_t ath_isr(int irq, void *dev)
S
Sujith 已提交
460
{
S
Sujith 已提交
461 462 463 464 465
#define SCHED_INTR (				\
		ATH9K_INT_FATAL |		\
		ATH9K_INT_RXORN |		\
		ATH9K_INT_RXEOL |		\
		ATH9K_INT_RX |			\
F
Felix Fietkau 已提交
466 467
		ATH9K_INT_RXLP |		\
		ATH9K_INT_RXHP |		\
S
Sujith 已提交
468 469 470
		ATH9K_INT_TX |			\
		ATH9K_INT_BMISS |		\
		ATH9K_INT_CST |			\
471 472
		ATH9K_INT_TSFOOR |		\
		ATH9K_INT_GENTIMER)
S
Sujith 已提交
473

S
Sujith 已提交
474
	struct ath_softc *sc = dev;
475
	struct ath_hw *ah = sc->sc_ah;
S
Sujith 已提交
476 477 478
	enum ath9k_int status;
	bool sched = false;

S
Sujith 已提交
479 480 481 482 483 484 485
	/*
	 * The hardware is not ready/present, don't
	 * touch anything. Note this can happen early
	 * on if the IRQ is shared.
	 */
	if (sc->sc_flags & SC_OP_INVALID)
		return IRQ_NONE;
S
Sujith 已提交
486

S
Sujith 已提交
487 488 489

	/* shared irq, not for us */

490
	if (!ath9k_hw_intrpend(ah))
S
Sujith 已提交
491 492 493 494 495 496 497 498 499
		return IRQ_NONE;

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

S
Sujith 已提交
502 503 504 505
	/*
	 * If there are no status bits set, then this interrupt was not
	 * for me (should have been caught above).
	 */
506
	if (!status)
S
Sujith 已提交
507
		return IRQ_NONE;
S
Sujith 已提交
508

S
Sujith 已提交
509 510 511 512 513 514 515 516 517 518
	/* 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 已提交
519 520
	if ((status & ATH9K_INT_FATAL) || ((status & ATH9K_INT_RXORN) &&
	    !(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)))
S
Sujith 已提交
521 522 523 524 525 526 527 528
		goto chip_reset;

	if (status & ATH9K_INT_SWBA)
		tasklet_schedule(&sc->bcon_tasklet);

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

F
Felix Fietkau 已提交
529 530 531 532 533 534 535
	if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
		if (status & ATH9K_INT_RXEOL) {
			ah->imask &= ~(ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
			ath9k_hw_set_interrupts(ah, ah->imask);
		}
	}

S
Sujith 已提交
536
	if (status & ATH9K_INT_MIB) {
S
Sujith 已提交
537
		/*
S
Sujith 已提交
538 539 540
		 * Disable interrupts until we service the MIB
		 * interrupt; otherwise it will continue to
		 * fire.
S
Sujith 已提交
541
		 */
S
Sujith 已提交
542 543 544 545 546 547
		ath9k_hw_set_interrupts(ah, 0);
		/*
		 * Let the hal handle the event. We assume
		 * it will clear whatever condition caused
		 * the interrupt.
		 */
548
		ath9k_hw_procmibevent(ah);
P
Pavel Roskin 已提交
549
		ath9k_hw_set_interrupts(ah, ah->imask);
S
Sujith 已提交
550
	}
S
Sujith 已提交
551

552 553
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
		if (status & ATH9K_INT_TIM_TIMER) {
S
Sujith 已提交
554 555
			/* Clear RxAbort bit so that we can
			 * receive frames */
556
			ath9k_setpower(sc, ATH9K_PM_AWAKE);
557
			ath9k_hw_setrxabort(sc->sc_ah, 0);
S
Sujith 已提交
558
			sc->ps_flags |= PS_WAIT_FOR_BEACON;
S
Sujith 已提交
559
		}
S
Sujith 已提交
560 561

chip_reset:
S
Sujith 已提交
562

563 564
	ath_debug_stat_interrupt(sc, status);

S
Sujith 已提交
565 566
	if (sched) {
		/* turn off every interrupt except SWBA */
P
Pavel Roskin 已提交
567
		ath9k_hw_set_interrupts(ah, (ah->imask & ATH9K_INT_SWBA));
S
Sujith 已提交
568 569 570 571
		tasklet_schedule(&sc->intr_tq);
	}

	return IRQ_HANDLED;
S
Sujith 已提交
572 573

#undef SCHED_INTR
S
Sujith 已提交
574 575
}

576
static u32 ath_get_extchanmode(struct ath_softc *sc,
577
			       struct ieee80211_channel *chan,
S
Sujith 已提交
578
			       enum nl80211_channel_type channel_type)
579 580 581 582 583
{
	u32 chanmode = 0;

	switch (chan->band) {
	case IEEE80211_BAND_2GHZ:
S
Sujith 已提交
584 585 586
		switch(channel_type) {
		case NL80211_CHAN_NO_HT:
		case NL80211_CHAN_HT20:
587
			chanmode = CHANNEL_G_HT20;
S
Sujith 已提交
588 589
			break;
		case NL80211_CHAN_HT40PLUS:
590
			chanmode = CHANNEL_G_HT40PLUS;
S
Sujith 已提交
591 592
			break;
		case NL80211_CHAN_HT40MINUS:
593
			chanmode = CHANNEL_G_HT40MINUS;
S
Sujith 已提交
594 595
			break;
		}
596 597
		break;
	case IEEE80211_BAND_5GHZ:
S
Sujith 已提交
598 599 600
		switch(channel_type) {
		case NL80211_CHAN_NO_HT:
		case NL80211_CHAN_HT20:
601
			chanmode = CHANNEL_A_HT20;
S
Sujith 已提交
602 603
			break;
		case NL80211_CHAN_HT40PLUS:
604
			chanmode = CHANNEL_A_HT40PLUS;
S
Sujith 已提交
605 606
			break;
		case NL80211_CHAN_HT40MINUS:
607
			chanmode = CHANNEL_A_HT40MINUS;
S
Sujith 已提交
608 609
			break;
		}
610 611 612 613 614 615 616 617
		break;
	default:
		break;
	}

	return chanmode;
}

618
static int ath_setkey_tkip(struct ath_common *common, u16 keyix, const u8 *key,
619 620
			   struct ath9k_keyval *hk, const u8 *addr,
			   bool authenticator)
621
{
622
	struct ath_hw *ah = common->ah;
623 624
	const u8 *key_rxmic;
	const u8 *key_txmic;
625

626 627
	key_txmic = key + NL80211_TKIP_DATA_OFFSET_TX_MIC_KEY;
	key_rxmic = key + NL80211_TKIP_DATA_OFFSET_RX_MIC_KEY;
628 629

	if (addr == NULL) {
630 631 632 633 634
		/*
		 * Group key installation - only two key cache entries are used
		 * regardless of splitmic capability since group key is only
		 * used either for TX or RX.
		 */
635 636 637 638 639 640 641
		if (authenticator) {
			memcpy(hk->kv_mic, key_txmic, sizeof(hk->kv_mic));
			memcpy(hk->kv_txmic, key_txmic, sizeof(hk->kv_mic));
		} else {
			memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic));
			memcpy(hk->kv_txmic, key_rxmic, sizeof(hk->kv_mic));
		}
642
		return ath9k_hw_set_keycache_entry(ah, keyix, hk, addr);
643
	}
644
	if (!common->splitmic) {
645
		/* TX and RX keys share the same key cache entry. */
646 647
		memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic));
		memcpy(hk->kv_txmic, key_txmic, sizeof(hk->kv_txmic));
648
		return ath9k_hw_set_keycache_entry(ah, keyix, hk, addr);
649
	}
650 651 652 653

	/* Separate key cache entries for TX and RX */

	/* TX key goes at first index, RX key at +32. */
654
	memcpy(hk->kv_mic, key_txmic, sizeof(hk->kv_mic));
655
	if (!ath9k_hw_set_keycache_entry(ah, keyix, hk, NULL)) {
656
		/* TX MIC entry failed. No need to proceed further */
657
		ath_print(common, ATH_DBG_FATAL,
658
			  "Setting TX MIC Key Failed\n");
659 660 661 662 663
		return 0;
	}

	memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic));
	/* XXX delete tx key on failure? */
664
	return ath9k_hw_set_keycache_entry(ah, keyix + 32, hk, addr);
665 666
}

667
static int ath_reserve_key_cache_slot_tkip(struct ath_common *common)
668 669 670
{
	int i;

671 672 673
	for (i = IEEE80211_WEP_NKID; i < common->keymax / 2; i++) {
		if (test_bit(i, common->keymap) ||
		    test_bit(i + 64, common->keymap))
674
			continue; /* At least one part of TKIP key allocated */
675 676 677
		if (common->splitmic &&
		    (test_bit(i + 32, common->keymap) ||
		     test_bit(i + 64 + 32, common->keymap)))
678 679 680 681 682 683 684 685
			continue; /* At least one part of TKIP key allocated */

		/* Found a free slot for a TKIP key */
		return i;
	}
	return -1;
}

686
static int ath_reserve_key_cache_slot(struct ath_common *common)
687 688 689 690
{
	int i;

	/* First, try to find slots that would not be available for TKIP. */
691 692 693 694 695 696
	if (common->splitmic) {
		for (i = IEEE80211_WEP_NKID; i < common->keymax / 4; i++) {
			if (!test_bit(i, common->keymap) &&
			    (test_bit(i + 32, common->keymap) ||
			     test_bit(i + 64, common->keymap) ||
			     test_bit(i + 64 + 32, common->keymap)))
697
				return i;
698 699 700 701
			if (!test_bit(i + 32, common->keymap) &&
			    (test_bit(i, common->keymap) ||
			     test_bit(i + 64, common->keymap) ||
			     test_bit(i + 64 + 32, common->keymap)))
702
				return i + 32;
703 704 705 706
			if (!test_bit(i + 64, common->keymap) &&
			    (test_bit(i , common->keymap) ||
			     test_bit(i + 32, common->keymap) ||
			     test_bit(i + 64 + 32, common->keymap)))
707
				return i + 64;
708 709 710 711
			if (!test_bit(i + 64 + 32, common->keymap) &&
			    (test_bit(i, common->keymap) ||
			     test_bit(i + 32, common->keymap) ||
			     test_bit(i + 64, common->keymap)))
712
				return i + 64 + 32;
713 714
		}
	} else {
715 716 717
		for (i = IEEE80211_WEP_NKID; i < common->keymax / 2; i++) {
			if (!test_bit(i, common->keymap) &&
			    test_bit(i + 64, common->keymap))
718
				return i;
719 720
			if (test_bit(i, common->keymap) &&
			    !test_bit(i + 64, common->keymap))
721 722 723 724 725
				return i + 64;
		}
	}

	/* No partially used TKIP slots, pick any available slot */
726
	for (i = IEEE80211_WEP_NKID; i < common->keymax; i++) {
727 728 729 730 731
		/* Do not allow slots that could be needed for TKIP group keys
		 * to be used. This limitation could be removed if we know that
		 * TKIP will not be used. */
		if (i >= 64 && i < 64 + IEEE80211_WEP_NKID)
			continue;
732
		if (common->splitmic) {
733 734 735 736 737 738
			if (i >= 32 && i < 32 + IEEE80211_WEP_NKID)
				continue;
			if (i >= 64 + 32 && i < 64 + 32 + IEEE80211_WEP_NKID)
				continue;
		}

739
		if (!test_bit(i, common->keymap))
740 741 742 743 744
			return i; /* Found a free slot for a key */
	}

	/* No free slot found */
	return -1;
745 746
}

747
static int ath_key_config(struct ath_common *common,
748
			  struct ieee80211_vif *vif,
749
			  struct ieee80211_sta *sta,
750 751
			  struct ieee80211_key_conf *key)
{
752
	struct ath_hw *ah = common->ah;
753 754
	struct ath9k_keyval hk;
	const u8 *mac = NULL;
755
	u8 gmac[ETH_ALEN];
756
	int ret = 0;
757
	int idx;
758 759 760 761 762 763 764 765 766 767 768 769 770 771

	memset(&hk, 0, sizeof(hk));

	switch (key->alg) {
	case ALG_WEP:
		hk.kv_type = ATH9K_CIPHER_WEP;
		break;
	case ALG_TKIP:
		hk.kv_type = ATH9K_CIPHER_TKIP;
		break;
	case ALG_CCMP:
		hk.kv_type = ATH9K_CIPHER_AES_CCM;
		break;
	default:
J
Jouni Malinen 已提交
772
		return -EOPNOTSUPP;
773 774
	}

775
	hk.kv_len = key->keylen;
776 777
	memcpy(hk.kv_val, key->key, key->keylen);

778
	if (!(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802

		if (key->ap_addr) {
			/*
			 * Group keys on hardware that supports multicast frame
			 * key search use a mac that is the sender's address with
			 * the high bit set instead of the app-specified address.
			 */
			memcpy(gmac, key->ap_addr, ETH_ALEN);
			gmac[0] |= 0x80;
			mac = gmac;

			if (key->alg == ALG_TKIP)
				idx = ath_reserve_key_cache_slot_tkip(common);
			else
				idx = ath_reserve_key_cache_slot(common);
			if (idx < 0)
				mac = NULL; /* no free key cache entries */
		}

		if (!mac) {
			/* For now, use the default keys for broadcast keys. This may
			 * need to change with virtual interfaces. */
			idx = key->keyidx;
		}
803
	} else if (key->keyidx) {
804 805 806 807
		if (WARN_ON(!sta))
			return -EOPNOTSUPP;
		mac = sta->addr;

808 809 810 811 812 813
		if (vif->type != NL80211_IFTYPE_AP) {
			/* Only keyidx 0 should be used with unicast key, but
			 * allow this for client mode for now. */
			idx = key->keyidx;
		} else
			return -EIO;
814
	} else {
815 816 817 818
		if (WARN_ON(!sta))
			return -EOPNOTSUPP;
		mac = sta->addr;

819
		if (key->alg == ALG_TKIP)
820
			idx = ath_reserve_key_cache_slot_tkip(common);
821
		else
822
			idx = ath_reserve_key_cache_slot(common);
823
		if (idx < 0)
J
Jouni Malinen 已提交
824
			return -ENOSPC; /* no free key cache entries */
825 826 827
	}

	if (key->alg == ALG_TKIP)
828
		ret = ath_setkey_tkip(common, idx, key->key, &hk, mac,
829
				      vif->type == NL80211_IFTYPE_AP);
830
	else
831
		ret = ath9k_hw_set_keycache_entry(ah, idx, &hk, mac);
832 833 834 835

	if (!ret)
		return -EIO;

836
	set_bit(idx, common->keymap);
837
	if (key->alg == ALG_TKIP) {
838 839 840 841
		set_bit(idx + 64, common->keymap);
		if (common->splitmic) {
			set_bit(idx + 32, common->keymap);
			set_bit(idx + 64 + 32, common->keymap);
842 843 844 845
		}
	}

	return idx;
846 847
}

848
static void ath_key_delete(struct ath_common *common, struct ieee80211_key_conf *key)
849
{
850 851 852
	struct ath_hw *ah = common->ah;

	ath9k_hw_keyreset(ah, key->hw_key_idx);
853 854 855
	if (key->hw_key_idx < IEEE80211_WEP_NKID)
		return;

856
	clear_bit(key->hw_key_idx, common->keymap);
857 858
	if (key->alg != ALG_TKIP)
		return;
859

860 861
	clear_bit(key->hw_key_idx + 64, common->keymap);
	if (common->splitmic) {
862
		ath9k_hw_keyreset(ah, key->hw_key_idx + 32);
863 864
		clear_bit(key->hw_key_idx + 32, common->keymap);
		clear_bit(key->hw_key_idx + 64 + 32, common->keymap);
865
	}
866 867
}

868
static void ath9k_bss_assoc_info(struct ath_softc *sc,
S
Sujith 已提交
869
				 struct ieee80211_vif *vif,
870
				 struct ieee80211_bss_conf *bss_conf)
871
{
872
	struct ath_hw *ah = sc->sc_ah;
873
	struct ath_common *common = ath9k_hw_common(ah);
874

875
	if (bss_conf->assoc) {
876 877 878
		ath_print(common, ATH_DBG_CONFIG,
			  "Bss Info ASSOC %d, bssid: %pM\n",
			   bss_conf->aid, common->curbssid);
879

880
		/* New association, store aid */
881
		common->curaid = bss_conf->aid;
882
		ath9k_hw_write_associd(ah);
883 884 885 886 887 888

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

891
		/* Configure the beacon */
892
		ath_beacon_config(sc, vif);
893

894
		/* Reset rssi stats */
895
		sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
896

897
		ath_start_ani(common);
898
	} else {
899
		ath_print(common, ATH_DBG_CONFIG, "Bss Info DISASSOC\n");
900
		common->curaid = 0;
901
		/* Stop ANI */
902
		del_timer_sync(&common->ani.timer);
903
	}
904
}
905

906
void ath_radio_enable(struct ath_softc *sc, struct ieee80211_hw *hw)
907
{
908
	struct ath_hw *ah = sc->sc_ah;
909
	struct ath_common *common = ath9k_hw_common(ah);
910
	struct ieee80211_channel *channel = hw->conf.channel;
911
	int r;
912

913
	ath9k_ps_wakeup(sc);
V
Vivek Natarajan 已提交
914
	ath9k_hw_configpcipowersave(ah, 0, 0);
915

916 917 918
	if (!ah->curchan)
		ah->curchan = ath_get_curchannel(sc, sc->hw);

S
Sujith 已提交
919
	spin_lock_bh(&sc->sc_resetlock);
920
	r = ath9k_hw_reset(ah, ah->curchan, false);
921
	if (r) {
922
		ath_print(common, ATH_DBG_FATAL,
923
			  "Unable to reset channel (%u MHz), "
924 925
			  "reset status %d\n",
			  channel->center_freq, r);
926 927 928 929 930
	}
	spin_unlock_bh(&sc->sc_resetlock);

	ath_update_txpow(sc);
	if (ath_startrecv(sc) != 0) {
931 932
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to restart recv logic\n");
933 934 935 936
		return;
	}

	if (sc->sc_flags & SC_OP_BEACONS)
937
		ath_beacon_config(sc, NULL);	/* restart beacons */
938 939

	/* Re-Enable  interrupts */
P
Pavel Roskin 已提交
940
	ath9k_hw_set_interrupts(ah, ah->imask);
941 942

	/* Enable LED */
943
	ath9k_hw_cfg_output(ah, ah->led_pin,
944
			    AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
945
	ath9k_hw_set_gpio(ah, ah->led_pin, 0);
946

947
	ieee80211_wake_queues(hw);
948
	ath9k_ps_restore(sc);
949 950
}

951
void ath_radio_disable(struct ath_softc *sc, struct ieee80211_hw *hw)
952
{
953
	struct ath_hw *ah = sc->sc_ah;
954
	struct ieee80211_channel *channel = hw->conf.channel;
955
	int r;
956

957
	ath9k_ps_wakeup(sc);
958
	ieee80211_stop_queues(hw);
959 960

	/* Disable LED */
961 962
	ath9k_hw_set_gpio(ah, ah->led_pin, 1);
	ath9k_hw_cfg_gpio_input(ah, ah->led_pin);
963 964 965 966

	/* Disable interrupts */
	ath9k_hw_set_interrupts(ah, 0);

S
Sujith 已提交
967
	ath_drain_all_txq(sc, false);	/* clear pending tx frames */
968 969 970
	ath_stoprecv(sc);		/* turn off frame recv */
	ath_flushrecv(sc);		/* flush recv queue */

971
	if (!ah->curchan)
972
		ah->curchan = ath_get_curchannel(sc, hw);
973

974
	spin_lock_bh(&sc->sc_resetlock);
975
	r = ath9k_hw_reset(ah, ah->curchan, false);
976
	if (r) {
977
		ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_FATAL,
978
			  "Unable to reset channel (%u MHz), "
979 980
			  "reset status %d\n",
			  channel->center_freq, r);
981 982 983 984
	}
	spin_unlock_bh(&sc->sc_resetlock);

	ath9k_hw_phy_disable(ah);
V
Vivek Natarajan 已提交
985
	ath9k_hw_configpcipowersave(ah, 1, 1);
986
	ath9k_ps_restore(sc);
987
	ath9k_setpower(sc, ATH9K_PM_FULL_SLEEP);
988 989
}

S
Sujith 已提交
990 991
int ath_reset(struct ath_softc *sc, bool retry_tx)
{
992
	struct ath_hw *ah = sc->sc_ah;
993
	struct ath_common *common = ath9k_hw_common(ah);
994
	struct ieee80211_hw *hw = sc->hw;
995
	int r;
S
Sujith 已提交
996

S
Sujith 已提交
997 998 999
	/* Stop ANI */
	del_timer_sync(&common->ani.timer);

S
Sujith 已提交
1000 1001
	ieee80211_stop_queues(hw);

S
Sujith 已提交
1002
	ath9k_hw_set_interrupts(ah, 0);
S
Sujith 已提交
1003
	ath_drain_all_txq(sc, retry_tx);
S
Sujith 已提交
1004 1005 1006 1007
	ath_stoprecv(sc);
	ath_flushrecv(sc);

	spin_lock_bh(&sc->sc_resetlock);
1008
	r = ath9k_hw_reset(ah, sc->sc_ah->curchan, false);
1009
	if (r)
1010 1011
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to reset hardware; reset status %d\n", r);
S
Sujith 已提交
1012 1013 1014
	spin_unlock_bh(&sc->sc_resetlock);

	if (ath_startrecv(sc) != 0)
1015 1016
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to start recv logic\n");
S
Sujith 已提交
1017 1018 1019 1020 1021 1022

	/*
	 * We may be doing a reset in response to a request
	 * that changes the channel so update any state that
	 * might change as a result.
	 */
1023
	ath_cache_conf_rate(sc, &hw->conf);
S
Sujith 已提交
1024 1025 1026 1027

	ath_update_txpow(sc);

	if (sc->sc_flags & SC_OP_BEACONS)
1028
		ath_beacon_config(sc, NULL);	/* restart beacons */
S
Sujith 已提交
1029

P
Pavel Roskin 已提交
1030
	ath9k_hw_set_interrupts(ah, ah->imask);
S
Sujith 已提交
1031 1032 1033 1034 1035

	if (retry_tx) {
		int i;
		for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
			if (ATH_TXQ_SETUP(sc, i)) {
S
Sujith 已提交
1036 1037 1038
				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 已提交
1039 1040 1041 1042
			}
		}
	}

S
Sujith 已提交
1043 1044
	ieee80211_wake_queues(hw);

S
Sujith 已提交
1045 1046 1047
	/* Start ANI */
	ath_start_ani(common);

1048
	return r;
S
Sujith 已提交
1049 1050 1051 1052 1053 1054 1055 1056
}

int ath_get_hal_qnum(u16 queue, struct ath_softc *sc)
{
	int qnum;

	switch (queue) {
	case 0:
S
Sujith 已提交
1057
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_VO];
S
Sujith 已提交
1058 1059
		break;
	case 1:
S
Sujith 已提交
1060
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_VI];
S
Sujith 已提交
1061 1062
		break;
	case 2:
S
Sujith 已提交
1063
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_BE];
S
Sujith 已提交
1064 1065
		break;
	case 3:
S
Sujith 已提交
1066
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_BK];
S
Sujith 已提交
1067 1068
		break;
	default:
S
Sujith 已提交
1069
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_BE];
S
Sujith 已提交
1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100
		break;
	}

	return qnum;
}

int ath_get_mac80211_qnum(u32 queue, struct ath_softc *sc)
{
	int qnum;

	switch (queue) {
	case ATH9K_WME_AC_VO:
		qnum = 0;
		break;
	case ATH9K_WME_AC_VI:
		qnum = 1;
		break;
	case ATH9K_WME_AC_BE:
		qnum = 2;
		break;
	case ATH9K_WME_AC_BK:
		qnum = 3;
		break;
	default:
		qnum = -1;
		break;
	}

	return qnum;
}

1101 1102
/* XXX: Remove me once we don't depend on ath9k_channel for all
 * this redundant data */
1103 1104
void ath9k_update_ichannel(struct ath_softc *sc, struct ieee80211_hw *hw,
			   struct ath9k_channel *ichan)
1105 1106 1107 1108 1109 1110 1111 1112 1113
{
	struct ieee80211_channel *chan = hw->conf.channel;
	struct ieee80211_conf *conf = &hw->conf;

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

	if (chan->band == IEEE80211_BAND_2GHZ) {
		ichan->chanmode = CHANNEL_G;
S
Sujith 已提交
1114
		ichan->channelFlags = CHANNEL_2GHZ | CHANNEL_OFDM | CHANNEL_G;
1115 1116 1117 1118 1119
	} else {
		ichan->chanmode = CHANNEL_A;
		ichan->channelFlags = CHANNEL_5GHZ | CHANNEL_OFDM;
	}

L
Luis R. Rodriguez 已提交
1120
	if (conf_is_ht(conf))
1121 1122 1123 1124
		ichan->chanmode = ath_get_extchanmode(sc, chan,
					    conf->channel_type);
}

S
Sujith 已提交
1125 1126 1127 1128
/**********************/
/* mac80211 callbacks */
/**********************/

1129
static int ath9k_start(struct ieee80211_hw *hw)
1130
{
1131 1132
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1133
	struct ath_hw *ah = sc->sc_ah;
1134
	struct ath_common *common = ath9k_hw_common(ah);
1135
	struct ieee80211_channel *curchan = hw->conf.channel;
S
Sujith 已提交
1136
	struct ath9k_channel *init_channel;
1137
	int r;
1138

1139 1140 1141
	ath_print(common, ATH_DBG_CONFIG,
		  "Starting driver with initial channel: %d MHz\n",
		  curchan->center_freq);
1142

1143 1144
	mutex_lock(&sc->mutex);

1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165
	if (ath9k_wiphy_started(sc)) {
		if (sc->chan_idx == curchan->hw_value) {
			/*
			 * Already on the operational channel, the new wiphy
			 * can be marked active.
			 */
			aphy->state = ATH_WIPHY_ACTIVE;
			ieee80211_wake_queues(hw);
		} else {
			/*
			 * Another wiphy is on another channel, start the new
			 * wiphy in paused state.
			 */
			aphy->state = ATH_WIPHY_PAUSED;
			ieee80211_stop_queues(hw);
		}
		mutex_unlock(&sc->mutex);
		return 0;
	}
	aphy->state = ATH_WIPHY_ACTIVE;

1166
	/* setup initial channel */
1167

1168
	sc->chan_idx = curchan->hw_value;
1169

1170
	init_channel = ath_get_curchannel(sc, hw);
S
Sujith 已提交
1171 1172

	/* Reset SERDES registers */
1173
	ath9k_hw_configpcipowersave(ah, 0, 0);
S
Sujith 已提交
1174 1175 1176 1177 1178 1179 1180 1181 1182

	/*
	 * 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.
	 */
	spin_lock_bh(&sc->sc_resetlock);
1183
	r = ath9k_hw_reset(ah, init_channel, false);
1184
	if (r) {
1185 1186 1187 1188
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to reset hardware; reset status %d "
			  "(freq %u MHz)\n", r,
			  curchan->center_freq);
S
Sujith 已提交
1189
		spin_unlock_bh(&sc->sc_resetlock);
1190
		goto mutex_unlock;
S
Sujith 已提交
1191 1192 1193 1194 1195 1196 1197 1198
	}
	spin_unlock_bh(&sc->sc_resetlock);

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

S
Sujith 已提交
1200 1201 1202 1203 1204 1205 1206 1207
	/*
	 * Setup the hardware after reset:
	 * The receive engine is set going.
	 * Frame transmit is handled entirely
	 * in the frame output path; there's nothing to do
	 * here except setup the interrupt mask.
	 */
	if (ath_startrecv(sc) != 0) {
1208 1209
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to start recv logic\n");
1210 1211
		r = -EIO;
		goto mutex_unlock;
1212
	}
1213

S
Sujith 已提交
1214
	/* Setup our intr mask. */
F
Felix Fietkau 已提交
1215 1216 1217 1218 1219 1220 1221 1222
	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)
		ah->imask |= ATH9K_INT_RXHP | ATH9K_INT_RXLP;
	else
		ah->imask |= ATH9K_INT_RX;
S
Sujith 已提交
1223

1224
	if (ah->caps.hw_caps & ATH9K_HW_CAP_GTT)
P
Pavel Roskin 已提交
1225
		ah->imask |= ATH9K_INT_GTT;
S
Sujith 已提交
1226

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

1230
	ath_cache_conf_rate(sc, &hw->conf);
S
Sujith 已提交
1231 1232 1233 1234

	sc->sc_flags &= ~SC_OP_INVALID;

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

1238
	ieee80211_wake_queues(hw);
S
Sujith 已提交
1239

1240
	ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
1241

1242 1243
	if ((ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE) &&
	    !ah->btcoex_hw.enabled) {
1244 1245
		ath9k_hw_btcoex_set_weight(ah, AR_BT_COEX_WGHT,
					   AR_STOMP_LOW_WLAN_WGHT);
1246
		ath9k_hw_btcoex_enable(ah);
1247

1248 1249
		if (common->bus_ops->bt_coex_prep)
			common->bus_ops->bt_coex_prep(common);
1250
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1251
			ath9k_btcoex_timer_resume(sc);
1252 1253
	}

1254 1255 1256
mutex_unlock:
	mutex_unlock(&sc->mutex);

1257
	return r;
1258 1259
}

1260 1261
static int ath9k_tx(struct ieee80211_hw *hw,
		    struct sk_buff *skb)
1262
{
S
Sujith 已提交
1263
	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
1264 1265
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1266
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
S
Sujith 已提交
1267
	struct ath_tx_control txctl;
1268 1269
	int padpos, padsize;
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
S
Sujith 已提交
1270

1271
	if (aphy->state != ATH_WIPHY_ACTIVE && aphy->state != ATH_WIPHY_SCAN) {
1272 1273 1274
		ath_print(common, ATH_DBG_XMIT,
			  "ath9k: %s: TX in unexpected wiphy state "
			  "%d\n", wiphy_name(hw->wiphy), aphy->state);
1275 1276 1277
		goto exit;
	}

1278
	if (sc->ps_enabled) {
1279 1280 1281 1282 1283 1284 1285
		/*
		 * 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)) {
1286 1287
			ath_print(common, ATH_DBG_PS, "Add PM=1 for a TX frame "
				  "while in PS mode\n");
1288 1289 1290 1291
			hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
		}
	}

1292 1293 1294 1295 1296 1297 1298 1299 1300
	if (unlikely(sc->sc_ah->power_mode != ATH9K_PM_AWAKE)) {
		/*
		 * We are using PS-Poll and mac80211 can request TX while in
		 * power save mode. Need to wake up hardware for the TX to be
		 * completed and if needed, also for RX of buffered frames.
		 */
		ath9k_ps_wakeup(sc);
		ath9k_hw_setrxabort(sc->sc_ah, 0);
		if (ieee80211_is_pspoll(hdr->frame_control)) {
1301 1302
			ath_print(common, ATH_DBG_PS,
				  "Sending PS-Poll to pick a buffered frame\n");
S
Sujith 已提交
1303
			sc->ps_flags |= PS_WAIT_FOR_PSPOLL_DATA;
1304
		} else {
1305 1306
			ath_print(common, ATH_DBG_PS,
				  "Wake up to complete TX\n");
S
Sujith 已提交
1307
			sc->ps_flags |= PS_WAIT_FOR_TX_ACK;
1308 1309 1310 1311 1312 1313 1314 1315 1316
		}
		/*
		 * The actual restore operation will happen only after
		 * the sc_flags bit is cleared. We are just dropping
		 * the ps_usecount here.
		 */
		ath9k_ps_restore(sc);
	}

S
Sujith 已提交
1317
	memset(&txctl, 0, sizeof(struct ath_tx_control));
1318

1319 1320 1321 1322 1323 1324 1325
	/*
	 * As a temporary workaround, assign seq# here; this will likely need
	 * to be cleaned up to work better with Beacon transmission and virtual
	 * BSSes.
	 */
	if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) {
		if (info->flags & IEEE80211_TX_CTL_FIRST_FRAGMENT)
S
Sujith 已提交
1326
			sc->tx.seq_no += 0x10;
1327
		hdr->seq_ctrl &= cpu_to_le16(IEEE80211_SCTL_FRAG);
S
Sujith 已提交
1328
		hdr->seq_ctrl |= cpu_to_le16(sc->tx.seq_no);
1329
	}
1330

1331
	/* Add the padding after the header if this is not already done */
1332 1333 1334
	padpos = ath9k_cmn_padpos(hdr->frame_control);
	padsize = padpos & 3;
	if (padsize && skb->len>padpos) {
1335 1336 1337
		if (skb_headroom(skb) < padsize)
			return -1;
		skb_push(skb, padsize);
1338
		memmove(skb->data, skb->data + padsize, padpos);
1339 1340
	}

S
Sujith 已提交
1341 1342 1343 1344 1345 1346
	/* Check if a tx queue is available */

	txctl.txq = ath_test_get_txq(sc, skb);
	if (!txctl.txq)
		goto exit;

1347
	ath_print(common, ATH_DBG_XMIT, "transmitting packet, skb: %p\n", skb);
1348

1349
	if (ath_tx_start(hw, skb, &txctl) != 0) {
1350
		ath_print(common, ATH_DBG_XMIT, "TX failed\n");
S
Sujith 已提交
1351
		goto exit;
1352 1353
	}

S
Sujith 已提交
1354 1355 1356
	return 0;
exit:
	dev_kfree_skb_any(skb);
1357
	return 0;
1358 1359
}

1360
static void ath9k_stop(struct ieee80211_hw *hw)
1361
{
1362 1363
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1364
	struct ath_hw *ah = sc->sc_ah;
1365
	struct ath_common *common = ath9k_hw_common(ah);
1366

S
Sujith 已提交
1367 1368
	mutex_lock(&sc->mutex);

1369 1370
	aphy->state = ATH_WIPHY_INACTIVE;

1371 1372 1373 1374 1375 1376 1377 1378
	cancel_delayed_work_sync(&sc->ath_led_blink_work);
	cancel_delayed_work_sync(&sc->tx_complete_work);

	if (!sc->num_sec_wiphy) {
		cancel_delayed_work_sync(&sc->wiphy_work);
		cancel_work_sync(&sc->chan_work);
	}

S
Sujith 已提交
1379
	if (sc->sc_flags & SC_OP_INVALID) {
1380
		ath_print(common, ATH_DBG_ANY, "Device not present\n");
S
Sujith 已提交
1381
		mutex_unlock(&sc->mutex);
S
Sujith 已提交
1382 1383
		return;
	}
1384

1385 1386 1387 1388 1389
	if (ath9k_wiphy_started(sc)) {
		mutex_unlock(&sc->mutex);
		return; /* another wiphy still in use */
	}

1390 1391 1392
	/* Ensure HW is awake when we try to shut it down. */
	ath9k_ps_wakeup(sc);

1393
	if (ah->btcoex_hw.enabled) {
1394
		ath9k_hw_btcoex_disable(ah);
1395
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1396
			ath9k_btcoex_timer_pause(sc);
1397 1398
	}

S
Sujith 已提交
1399 1400
	/* make sure h/w will not generate any interrupt
	 * before setting the invalid flag. */
1401
	ath9k_hw_set_interrupts(ah, 0);
S
Sujith 已提交
1402 1403

	if (!(sc->sc_flags & SC_OP_INVALID)) {
S
Sujith 已提交
1404
		ath_drain_all_txq(sc, false);
S
Sujith 已提交
1405
		ath_stoprecv(sc);
1406
		ath9k_hw_phy_disable(ah);
S
Sujith 已提交
1407
	} else
S
Sujith 已提交
1408
		sc->rx.rxlink = NULL;
S
Sujith 已提交
1409 1410

	/* disable HAL and put h/w to sleep */
1411 1412
	ath9k_hw_disable(ah);
	ath9k_hw_configpcipowersave(ah, 1, 1);
1413 1414 1415
	ath9k_ps_restore(sc);

	/* Finally, put the chip in FULL SLEEP mode */
1416
	ath9k_setpower(sc, ATH9K_PM_FULL_SLEEP);
S
Sujith 已提交
1417 1418

	sc->sc_flags |= SC_OP_INVALID;
1419

1420 1421
	mutex_unlock(&sc->mutex);

1422
	ath_print(common, ATH_DBG_CONFIG, "Driver halt\n");
1423 1424
}

1425
static int ath9k_add_interface(struct ieee80211_hw *hw,
1426
			       struct ieee80211_vif *vif)
1427
{
1428 1429
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
P
Pavel Roskin 已提交
1430 1431
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1432
	struct ath_vif *avp = (void *)vif->drv_priv;
1433
	enum nl80211_iftype ic_opmode = NL80211_IFTYPE_UNSPECIFIED;
1434
	int ret = 0;
1435

1436 1437
	mutex_lock(&sc->mutex);

P
Pavel Roskin 已提交
1438
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK) &&
1439 1440 1441 1442 1443
	    sc->nvifs > 0) {
		ret = -ENOBUFS;
		goto out;
	}

1444
	switch (vif->type) {
1445
	case NL80211_IFTYPE_STATION:
1446
		ic_opmode = NL80211_IFTYPE_STATION;
1447
		break;
1448 1449
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_AP:
1450
	case NL80211_IFTYPE_MESH_POINT:
1451 1452 1453 1454
		if (sc->nbcnvifs >= ATH_BCBUF) {
			ret = -ENOBUFS;
			goto out;
		}
1455
		ic_opmode = vif->type;
1456 1457
		break;
	default:
1458
		ath_print(common, ATH_DBG_FATAL,
1459
			"Interface type %d not yet supported\n", vif->type);
1460 1461
		ret = -EOPNOTSUPP;
		goto out;
1462 1463
	}

1464 1465
	ath_print(common, ATH_DBG_CONFIG,
		  "Attach a VIF of type: %d\n", ic_opmode);
1466

S
Sujith 已提交
1467
	/* Set the VIF opmode */
S
Sujith 已提交
1468 1469 1470
	avp->av_opmode = ic_opmode;
	avp->av_bslot = -1;

1471
	sc->nvifs++;
1472

P
Pavel Roskin 已提交
1473
	if (ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK)
1474 1475
		ath9k_set_bssid_mask(hw);

1476 1477 1478
	if (sc->nvifs > 1)
		goto out; /* skip global settings for secondary vif */

S
Sujith 已提交
1479
	if (ic_opmode == NL80211_IFTYPE_AP) {
P
Pavel Roskin 已提交
1480
		ath9k_hw_set_tsfadjust(ah, 1);
S
Sujith 已提交
1481 1482
		sc->sc_flags |= SC_OP_TSF_RESET;
	}
S
Sujith 已提交
1483 1484

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

1487 1488 1489 1490
	/*
	 * Enable MIB interrupts when there are hardware phy counters.
	 * Note we only do this (at the moment) for station mode.
	 */
1491 1492 1493
	if ((vif->type == NL80211_IFTYPE_STATION) ||
	    (vif->type == NL80211_IFTYPE_ADHOC) ||
	    (vif->type == NL80211_IFTYPE_MESH_POINT)) {
1494 1495
		if (ah->config.enable_ani)
			ah->imask |= ATH9K_INT_MIB;
P
Pavel Roskin 已提交
1496
		ah->imask |= ATH9K_INT_TSFOOR;
1497 1498
	}

P
Pavel Roskin 已提交
1499
	ath9k_hw_set_interrupts(ah, ah->imask);
1500

1501 1502 1503
	if (vif->type == NL80211_IFTYPE_AP    ||
	    vif->type == NL80211_IFTYPE_ADHOC ||
	    vif->type == NL80211_IFTYPE_MONITOR)
1504
		ath_start_ani(common);
1505

1506
out:
1507
	mutex_unlock(&sc->mutex);
1508
	return ret;
1509 1510
}

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

1520
	ath_print(common, ATH_DBG_CONFIG, "Detach Interface\n");
1521

1522 1523
	mutex_lock(&sc->mutex);

1524
	/* Stop ANI */
1525
	del_timer_sync(&common->ani.timer);
J
Jouni Malinen 已提交
1526

1527
	/* Reclaim beacon resources */
1528 1529 1530
	if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) ||
	    (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC) ||
	    (sc->sc_ah->opmode == NL80211_IFTYPE_MESH_POINT)) {
1531
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
1532
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
1533
		ath9k_ps_restore(sc);
J
Jouni Malinen 已提交
1534
	}
1535

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

1539
	for (i = 0; i < ARRAY_SIZE(sc->beacon.bslot); i++) {
1540
		if (sc->beacon.bslot[i] == vif) {
1541 1542 1543
			printk(KERN_DEBUG "%s: vif had allocated beacon "
			       "slot\n", __func__);
			sc->beacon.bslot[i] = NULL;
1544
			sc->beacon.bslot_aphy[i] = NULL;
1545 1546 1547
		}
	}

S
Sujith 已提交
1548
	sc->nvifs--;
1549 1550

	mutex_unlock(&sc->mutex);
1551 1552
}

1553 1554
void ath9k_enable_ps(struct ath_softc *sc)
{
P
Pavel Roskin 已提交
1555 1556
	struct ath_hw *ah = sc->sc_ah;

1557
	sc->ps_enabled = true;
P
Pavel Roskin 已提交
1558 1559 1560 1561
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
		if ((ah->imask & ATH9K_INT_TIM_TIMER) == 0) {
			ah->imask |= ATH9K_INT_TIM_TIMER;
			ath9k_hw_set_interrupts(ah, ah->imask);
1562 1563
		}
	}
P
Pavel Roskin 已提交
1564
	ath9k_hw_setrxabort(ah, 1);
1565 1566
}

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

1576
	mutex_lock(&sc->mutex);
1577

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

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

1593
		enable_radio = (!idle && all_wiphys_idle);
1594 1595 1596 1597 1598 1599 1600

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

1603
		if (enable_radio) {
1604
			sc->ps_idle = false;
1605
			ath_radio_enable(sc, hw);
1606 1607
			ath_print(common, ATH_DBG_CONFIG,
				  "not-idle: enabling radio\n");
1608 1609 1610
		}
	}

1611 1612 1613 1614 1615 1616
	/*
	 * 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.
	 */
1617 1618
	if (changed & IEEE80211_CONF_CHANGE_PS) {
		if (conf->flags & IEEE80211_CONF_PS) {
S
Sujith 已提交
1619
			sc->ps_flags |= PS_ENABLED;
1620 1621 1622 1623
			/*
			 * At this point we know hardware has received an ACK
			 * of a previously sent null data frame.
			 */
S
Sujith 已提交
1624 1625
			if ((sc->ps_flags & PS_NULLFUNC_COMPLETED)) {
				sc->ps_flags &= ~PS_NULLFUNC_COMPLETED;
1626
				ath9k_enable_ps(sc);
1627
                        }
1628
		} else {
1629
			sc->ps_enabled = false;
S
Sujith 已提交
1630 1631
			sc->ps_flags &= ~(PS_ENABLED |
					  PS_NULLFUNC_COMPLETED);
1632
			ath9k_setpower(sc, ATH9K_PM_AWAKE);
1633 1634 1635
			if (!(ah->caps.hw_caps &
			      ATH9K_HW_CAP_AUTOSLEEP)) {
				ath9k_hw_setrxabort(sc->sc_ah, 0);
S
Sujith 已提交
1636 1637 1638 1639
				sc->ps_flags &= ~(PS_WAIT_FOR_BEACON |
						  PS_WAIT_FOR_CAB |
						  PS_WAIT_FOR_PSPOLL_DATA |
						  PS_WAIT_FOR_TX_ACK);
P
Pavel Roskin 已提交
1640 1641
				if (ah->imask & ATH9K_INT_TIM_TIMER) {
					ah->imask &= ~ATH9K_INT_TIM_TIMER;
1642
					ath9k_hw_set_interrupts(sc->sc_ah,
P
Pavel Roskin 已提交
1643
							ah->imask);
1644
				}
1645 1646 1647 1648
			}
		}
	}

S
Sujith 已提交
1649 1650 1651 1652 1653 1654 1655 1656
	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
		if (conf->flags & IEEE80211_CONF_MONITOR) {
			ath_print(common, ATH_DBG_CONFIG,
				  "HW opmode set to Monitor mode\n");
			sc->sc_ah->opmode = NL80211_IFTYPE_MONITOR;
		}
	}

1657
	if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
1658
		struct ieee80211_channel *curchan = hw->conf.channel;
1659
		int pos = curchan->hw_value;
J
Johannes Berg 已提交
1660

1661 1662 1663
		aphy->chan_idx = pos;
		aphy->chan_is_ht = conf_is_ht(conf);

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

1675 1676
		ath_print(common, ATH_DBG_CONFIG, "Set channel: %d MHz\n",
			  curchan->center_freq);
1677

1678
		/* XXX: remove me eventualy */
1679
		ath9k_update_ichannel(sc, hw, &sc->sc_ah->channels[pos]);
1680

1681
		ath_update_chainmask(sc, conf_is_ht(conf));
S
Sujith 已提交
1682

1683
		if (ath_set_channel(sc, hw, &sc->sc_ah->channels[pos]) < 0) {
1684 1685
			ath_print(common, ATH_DBG_FATAL,
				  "Unable to set channel\n");
1686
			mutex_unlock(&sc->mutex);
1687 1688
			return -EINVAL;
		}
S
Sujith 已提交
1689
	}
1690

1691
skip_chan_change:
1692
	if (changed & IEEE80211_CONF_CHANGE_POWER) {
S
Sujith 已提交
1693
		sc->config.txpowlimit = 2 * conf->power_level;
1694 1695
		ath_update_txpow(sc);
	}
1696

1697 1698 1699 1700
	spin_lock_bh(&sc->wiphy_lock);
	disable_radio = ath9k_all_wiphys_idle(sc);
	spin_unlock_bh(&sc->wiphy_lock);

1701
	if (disable_radio) {
1702
		ath_print(common, ATH_DBG_CONFIG, "idle: disabling radio\n");
1703
		sc->ps_idle = true;
1704
		ath_radio_disable(sc, hw);
1705 1706
	}

1707
	mutex_unlock(&sc->mutex);
1708

1709 1710 1711
	return 0;
}

1712 1713 1714 1715
#define SUPPORTED_FILTERS			\
	(FIF_PROMISC_IN_BSS |			\
	FIF_ALLMULTI |				\
	FIF_CONTROL |				\
1716
	FIF_PSPOLL |				\
1717 1718 1719
	FIF_OTHER_BSS |				\
	FIF_BCN_PRBRESP_PROMISC |		\
	FIF_FCSFAIL)
1720

1721 1722 1723 1724
/* FIXME: sc->sc_full_reset ? */
static void ath9k_configure_filter(struct ieee80211_hw *hw,
				   unsigned int changed_flags,
				   unsigned int *total_flags,
1725
				   u64 multicast)
1726
{
1727 1728
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1729
	u32 rfilt;
1730

1731 1732
	changed_flags &= SUPPORTED_FILTERS;
	*total_flags &= SUPPORTED_FILTERS;
1733

S
Sujith 已提交
1734
	sc->rx.rxfilter = *total_flags;
1735
	ath9k_ps_wakeup(sc);
1736 1737
	rfilt = ath_calcrxfilter(sc);
	ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1738
	ath9k_ps_restore(sc);
1739

1740 1741
	ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_CONFIG,
		  "Set HW RX filter: 0x%x\n", rfilt);
1742
}
1743

1744 1745 1746
static int ath9k_sta_add(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta)
1747
{
1748 1749
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1750

1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765
	ath_node_attach(sc, sta);

	return 0;
}

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

	ath_node_detach(sc, sta);

	return 0;
1766 1767
}

1768
static int ath9k_conf_tx(struct ieee80211_hw *hw, u16 queue,
1769
			 const struct ieee80211_tx_queue_params *params)
1770
{
1771 1772
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1773
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1774 1775
	struct ath9k_tx_queue_info qi;
	int ret = 0, qnum;
1776

1777 1778
	if (queue >= WME_NUM_AC)
		return 0;
1779

1780 1781
	mutex_lock(&sc->mutex);

1782 1783
	memset(&qi, 0, sizeof(struct ath9k_tx_queue_info));

1784 1785 1786 1787 1788
	qi.tqi_aifs = params->aifs;
	qi.tqi_cwmin = params->cw_min;
	qi.tqi_cwmax = params->cw_max;
	qi.tqi_burstTime = params->txop;
	qnum = ath_get_hal_qnum(queue, sc);
1789

1790 1791 1792 1793 1794
	ath_print(common, ATH_DBG_CONFIG,
		  "Configure tx [queue/halq] [%d/%d],  "
		  "aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
		  queue, qnum, params->aifs, params->cw_min,
		  params->cw_max, params->txop);
1795

1796 1797
	ret = ath_txq_update(sc, qnum, &qi);
	if (ret)
1798
		ath_print(common, ATH_DBG_FATAL, "TXQ Update failed\n");
1799

1800 1801 1802 1803
	if (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC)
		if ((qnum == sc->tx.hwq_map[ATH9K_WME_AC_BE]) && !ret)
			ath_beaconq_config(sc);

1804 1805
	mutex_unlock(&sc->mutex);

1806 1807
	return ret;
}
1808

1809 1810
static int ath9k_set_key(struct ieee80211_hw *hw,
			 enum set_key_cmd cmd,
1811 1812
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta,
1813 1814
			 struct ieee80211_key_conf *key)
{
1815 1816
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1817
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1818
	int ret = 0;
1819

1820 1821 1822
	if (modparam_nohwcrypt)
		return -ENOSPC;

1823
	mutex_lock(&sc->mutex);
1824
	ath9k_ps_wakeup(sc);
1825
	ath_print(common, ATH_DBG_CONFIG, "Set HW Key\n");
1826

1827 1828
	switch (cmd) {
	case SET_KEY:
1829
		ret = ath_key_config(common, vif, sta, key);
1830 1831
		if (ret >= 0) {
			key->hw_key_idx = ret;
1832 1833 1834 1835
			/* push IV and Michael MIC generation to stack */
			key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
			if (key->alg == ALG_TKIP)
				key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
1836 1837
			if (sc->sc_ah->sw_mgmt_crypto && key->alg == ALG_CCMP)
				key->flags |= IEEE80211_KEY_FLAG_SW_MGMT;
1838
			ret = 0;
1839 1840 1841
		}
		break;
	case DISABLE_KEY:
1842
		ath_key_delete(common, key);
1843 1844 1845 1846
		break;
	default:
		ret = -EINVAL;
	}
1847

1848
	ath9k_ps_restore(sc);
1849 1850
	mutex_unlock(&sc->mutex);

1851 1852
	return ret;
}
1853

1854 1855 1856 1857 1858
static void ath9k_bss_info_changed(struct ieee80211_hw *hw,
				   struct ieee80211_vif *vif,
				   struct ieee80211_bss_conf *bss_conf,
				   u32 changed)
{
1859 1860
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1861
	struct ath_hw *ah = sc->sc_ah;
1862
	struct ath_common *common = ath9k_hw_common(ah);
1863
	struct ath_vif *avp = (void *)vif->drv_priv;
1864
	int slottime;
S
Sujith 已提交
1865
	int error;
1866

1867 1868
	mutex_lock(&sc->mutex);

S
Sujith 已提交
1869 1870 1871 1872
	if (changed & BSS_CHANGED_BSSID) {
		/* Set BSSID */
		memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
		memcpy(avp->bssid, bss_conf->bssid, ETH_ALEN);
1873
		common->curaid = 0;
1874
		ath9k_hw_write_associd(ah);
1875

S
Sujith 已提交
1876 1877
		/* Set aggregation protection mode parameters */
		sc->config.ath_aggr_prot = 0;
1878

S
Sujith 已提交
1879 1880 1881
		/* Only legacy IBSS for now */
		if (vif->type == NL80211_IFTYPE_ADHOC)
			ath_update_chainmask(sc, 0);
1882

S
Sujith 已提交
1883 1884 1885
		ath_print(common, ATH_DBG_CONFIG,
			  "BSSID: %pM aid: 0x%x\n",
			  common->curbssid, common->curaid);
1886

S
Sujith 已提交
1887 1888 1889
		/* need to reconfigure the beacon */
		sc->sc_flags &= ~SC_OP_BEACONS ;
	}
1890

S
Sujith 已提交
1891 1892 1893 1894 1895 1896 1897
	/* Enable transmission of beacons (AP, IBSS, MESH) */
	if ((changed & BSS_CHANGED_BEACON) ||
	    ((changed & BSS_CHANGED_BEACON_ENABLED) && bss_conf->enable_beacon)) {
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
		error = ath_beacon_alloc(aphy, vif);
		if (!error)
			ath_beacon_config(sc, vif);
1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916
	}

	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);
		}
1917 1918
	}

S
Sujith 已提交
1919 1920 1921
	/* Disable transmission of beacons */
	if ((changed & BSS_CHANGED_BEACON_ENABLED) && !bss_conf->enable_beacon)
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
1922

S
Sujith 已提交
1923 1924 1925 1926 1927 1928 1929 1930 1931
	if (changed & BSS_CHANGED_BEACON_INT) {
		sc->beacon_interval = bss_conf->beacon_int;
		/*
		 * In case of AP mode, the HW TSF has to be reset
		 * when the beacon interval changes.
		 */
		if (vif->type == NL80211_IFTYPE_AP) {
			sc->sc_flags |= SC_OP_TSF_RESET;
			ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
1932 1933 1934
			error = ath_beacon_alloc(aphy, vif);
			if (!error)
				ath_beacon_config(sc, vif);
S
Sujith 已提交
1935 1936
		} else {
			ath_beacon_config(sc, vif);
1937 1938 1939
		}
	}

1940
	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
1941 1942
		ath_print(common, ATH_DBG_CONFIG, "BSS Changed PREAMBLE %d\n",
			  bss_conf->use_short_preamble);
1943 1944 1945 1946 1947
		if (bss_conf->use_short_preamble)
			sc->sc_flags |= SC_OP_PREAMBLE_SHORT;
		else
			sc->sc_flags &= ~SC_OP_PREAMBLE_SHORT;
	}
1948

1949
	if (changed & BSS_CHANGED_ERP_CTS_PROT) {
1950 1951
		ath_print(common, ATH_DBG_CONFIG, "BSS Changed CTS PROT %d\n",
			  bss_conf->use_cts_prot);
1952 1953 1954 1955 1956 1957
		if (bss_conf->use_cts_prot &&
		    hw->conf.channel->band != IEEE80211_BAND_5GHZ)
			sc->sc_flags |= SC_OP_PROTECT_ENABLE;
		else
			sc->sc_flags &= ~SC_OP_PROTECT_ENABLE;
	}
1958

1959
	if (changed & BSS_CHANGED_ASSOC) {
1960
		ath_print(common, ATH_DBG_CONFIG, "BSS Changed ASSOC %d\n",
1961
			bss_conf->assoc);
S
Sujith 已提交
1962
		ath9k_bss_assoc_info(sc, vif, bss_conf);
1963
	}
1964 1965

	mutex_unlock(&sc->mutex);
1966
}
1967

1968 1969 1970
static u64 ath9k_get_tsf(struct ieee80211_hw *hw)
{
	u64 tsf;
1971 1972
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1973

1974 1975 1976
	mutex_lock(&sc->mutex);
	tsf = ath9k_hw_gettsf64(sc->sc_ah);
	mutex_unlock(&sc->mutex);
1977

1978 1979
	return tsf;
}
1980

1981 1982
static void ath9k_set_tsf(struct ieee80211_hw *hw, u64 tsf)
{
1983 1984
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1985

1986 1987 1988
	mutex_lock(&sc->mutex);
	ath9k_hw_settsf64(sc->sc_ah, tsf);
	mutex_unlock(&sc->mutex);
1989 1990
}

1991 1992
static void ath9k_reset_tsf(struct ieee80211_hw *hw)
{
1993 1994
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1995

1996
	mutex_lock(&sc->mutex);
1997 1998

	ath9k_ps_wakeup(sc);
1999
	ath9k_hw_reset_tsf(sc->sc_ah);
2000 2001
	ath9k_ps_restore(sc);

2002
	mutex_unlock(&sc->mutex);
2003
}
2004

2005
static int ath9k_ampdu_action(struct ieee80211_hw *hw,
2006
			      struct ieee80211_vif *vif,
2007 2008 2009
			      enum ieee80211_ampdu_mlme_action action,
			      struct ieee80211_sta *sta,
			      u16 tid, u16 *ssn)
2010
{
2011 2012
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
2013
	int ret = 0;
2014

2015 2016
	switch (action) {
	case IEEE80211_AMPDU_RX_START:
2017 2018
		if (!(sc->sc_flags & SC_OP_RXAGGR))
			ret = -ENOTSUPP;
2019 2020 2021 2022
		break;
	case IEEE80211_AMPDU_RX_STOP:
		break;
	case IEEE80211_AMPDU_TX_START:
2023
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
2024
		ath_tx_aggr_start(sc, sta, tid, ssn);
2025
		ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2026
		ath9k_ps_restore(sc);
2027 2028
		break;
	case IEEE80211_AMPDU_TX_STOP:
2029
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
2030
		ath_tx_aggr_stop(sc, sta, tid);
2031
		ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2032
		ath9k_ps_restore(sc);
2033
		break;
2034
	case IEEE80211_AMPDU_TX_OPERATIONAL:
2035
		ath9k_ps_wakeup(sc);
2036
		ath_tx_aggr_resume(sc, sta, tid);
2037
		ath9k_ps_restore(sc);
2038
		break;
2039
	default:
2040 2041
		ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_FATAL,
			  "Unknown AMPDU action\n");
2042 2043 2044
	}

	return ret;
2045 2046
}

2047 2048
static void ath9k_sw_scan_start(struct ieee80211_hw *hw)
{
2049 2050
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
S
Sujith 已提交
2051
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
2052

2053
	mutex_lock(&sc->mutex);
2054 2055 2056 2057 2058 2059 2060
	if (ath9k_wiphy_scanning(sc)) {
		printk(KERN_DEBUG "ath9k: Two wiphys trying to scan at the "
		       "same time\n");
		/*
		 * Do not allow the concurrent scanning state for now. This
		 * could be improved with scanning control moved into ath9k.
		 */
2061
		mutex_unlock(&sc->mutex);
2062 2063 2064 2065 2066
		return;
	}

	aphy->state = ATH_WIPHY_SCAN;
	ath9k_wiphy_pause_all_forced(sc, aphy);
2067
	sc->sc_flags |= SC_OP_SCANNING;
S
Sujith 已提交
2068
	del_timer_sync(&common->ani.timer);
S
Sujith 已提交
2069
	cancel_delayed_work_sync(&sc->tx_complete_work);
2070
	mutex_unlock(&sc->mutex);
2071 2072 2073 2074
}

static void ath9k_sw_scan_complete(struct ieee80211_hw *hw)
{
2075 2076
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
S
Sujith 已提交
2077
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
2078

2079
	mutex_lock(&sc->mutex);
2080
	aphy->state = ATH_WIPHY_ACTIVE;
2081
	sc->sc_flags &= ~SC_OP_SCANNING;
S
Sujith 已提交
2082
	sc->sc_flags |= SC_OP_FULL_RESET;
S
Sujith 已提交
2083
	ath_start_ani(common);
S
Sujith 已提交
2084
	ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
2085
	ath_beacon_config(sc, NULL);
2086
	mutex_unlock(&sc->mutex);
2087 2088
}

2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100
static void ath9k_set_coverage_class(struct ieee80211_hw *hw, u8 coverage_class)
{
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
	struct ath_hw *ah = sc->sc_ah;

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

2101
struct ieee80211_ops ath9k_ops = {
2102 2103 2104 2105 2106 2107 2108
	.tx 		    = ath9k_tx,
	.start 		    = ath9k_start,
	.stop 		    = ath9k_stop,
	.add_interface 	    = ath9k_add_interface,
	.remove_interface   = ath9k_remove_interface,
	.config 	    = ath9k_config,
	.configure_filter   = ath9k_configure_filter,
2109 2110
	.sta_add	    = ath9k_sta_add,
	.sta_remove	    = ath9k_sta_remove,
2111 2112 2113 2114
	.conf_tx 	    = ath9k_conf_tx,
	.bss_info_changed   = ath9k_bss_info_changed,
	.set_key            = ath9k_set_key,
	.get_tsf 	    = ath9k_get_tsf,
2115
	.set_tsf 	    = ath9k_set_tsf,
2116
	.reset_tsf 	    = ath9k_reset_tsf,
2117
	.ampdu_action       = ath9k_ampdu_action,
2118 2119
	.sw_scan_start      = ath9k_sw_scan_start,
	.sw_scan_complete   = ath9k_sw_scan_complete,
J
Johannes Berg 已提交
2120
	.rfkill_poll        = ath9k_rfkill_poll_state,
2121
	.set_coverage_class = ath9k_set_coverage_class,
2122
};