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 755
	struct ath9k_keyval hk;
	const u8 *mac = NULL;
	int ret = 0;
756
	int idx;
757 758 759 760 761 762 763 764 765 766 767 768 769 770

	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 已提交
771
		return -EOPNOTSUPP;
772 773
	}

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

777
	if (!(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
778 779 780
		/* For now, use the default keys for broadcast keys. This may
		 * need to change with virtual interfaces. */
		idx = key->keyidx;
781
	} else if (key->keyidx) {
782 783 784 785
		if (WARN_ON(!sta))
			return -EOPNOTSUPP;
		mac = sta->addr;

786 787 788 789 790 791
		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;
792
	} else {
793 794 795 796
		if (WARN_ON(!sta))
			return -EOPNOTSUPP;
		mac = sta->addr;

797
		if (key->alg == ALG_TKIP)
798
			idx = ath_reserve_key_cache_slot_tkip(common);
799
		else
800
			idx = ath_reserve_key_cache_slot(common);
801
		if (idx < 0)
J
Jouni Malinen 已提交
802
			return -ENOSPC; /* no free key cache entries */
803 804 805
	}

	if (key->alg == ALG_TKIP)
806
		ret = ath_setkey_tkip(common, idx, key->key, &hk, mac,
807
				      vif->type == NL80211_IFTYPE_AP);
808
	else
809
		ret = ath9k_hw_set_keycache_entry(ah, idx, &hk, mac);
810 811 812 813

	if (!ret)
		return -EIO;

814
	set_bit(idx, common->keymap);
815
	if (key->alg == ALG_TKIP) {
816 817 818 819
		set_bit(idx + 64, common->keymap);
		if (common->splitmic) {
			set_bit(idx + 32, common->keymap);
			set_bit(idx + 64 + 32, common->keymap);
820 821 822 823
		}
	}

	return idx;
824 825
}

826
static void ath_key_delete(struct ath_common *common, struct ieee80211_key_conf *key)
827
{
828 829 830
	struct ath_hw *ah = common->ah;

	ath9k_hw_keyreset(ah, key->hw_key_idx);
831 832 833
	if (key->hw_key_idx < IEEE80211_WEP_NKID)
		return;

834
	clear_bit(key->hw_key_idx, common->keymap);
835 836
	if (key->alg != ALG_TKIP)
		return;
837

838 839
	clear_bit(key->hw_key_idx + 64, common->keymap);
	if (common->splitmic) {
840
		ath9k_hw_keyreset(ah, key->hw_key_idx + 32);
841 842
		clear_bit(key->hw_key_idx + 32, common->keymap);
		clear_bit(key->hw_key_idx + 64 + 32, common->keymap);
843
	}
844 845
}

846
static void ath9k_bss_assoc_info(struct ath_softc *sc,
S
Sujith 已提交
847
				 struct ieee80211_vif *vif,
848
				 struct ieee80211_bss_conf *bss_conf)
849
{
850
	struct ath_hw *ah = sc->sc_ah;
851
	struct ath_common *common = ath9k_hw_common(ah);
852

853
	if (bss_conf->assoc) {
854 855 856
		ath_print(common, ATH_DBG_CONFIG,
			  "Bss Info ASSOC %d, bssid: %pM\n",
			   bss_conf->aid, common->curbssid);
857

858
		/* New association, store aid */
859
		common->curaid = bss_conf->aid;
860
		ath9k_hw_write_associd(ah);
861 862 863 864 865 866

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

869
		/* Configure the beacon */
870
		ath_beacon_config(sc, vif);
871

872
		/* Reset rssi stats */
873
		sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
874

875
		ath_start_ani(common);
876
	} else {
877
		ath_print(common, ATH_DBG_CONFIG, "Bss Info DISASSOC\n");
878
		common->curaid = 0;
879
		/* Stop ANI */
880
		del_timer_sync(&common->ani.timer);
881
	}
882
}
883

884
void ath_radio_enable(struct ath_softc *sc, struct ieee80211_hw *hw)
885
{
886
	struct ath_hw *ah = sc->sc_ah;
887
	struct ath_common *common = ath9k_hw_common(ah);
888
	struct ieee80211_channel *channel = hw->conf.channel;
889
	int r;
890

891
	ath9k_ps_wakeup(sc);
V
Vivek Natarajan 已提交
892
	ath9k_hw_configpcipowersave(ah, 0, 0);
893

894 895 896
	if (!ah->curchan)
		ah->curchan = ath_get_curchannel(sc, sc->hw);

S
Sujith 已提交
897
	spin_lock_bh(&sc->sc_resetlock);
898
	r = ath9k_hw_reset(ah, ah->curchan, false);
899
	if (r) {
900
		ath_print(common, ATH_DBG_FATAL,
901
			  "Unable to reset channel (%u MHz), "
902 903
			  "reset status %d\n",
			  channel->center_freq, r);
904 905 906 907 908
	}
	spin_unlock_bh(&sc->sc_resetlock);

	ath_update_txpow(sc);
	if (ath_startrecv(sc) != 0) {
909 910
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to restart recv logic\n");
911 912 913 914
		return;
	}

	if (sc->sc_flags & SC_OP_BEACONS)
915
		ath_beacon_config(sc, NULL);	/* restart beacons */
916 917

	/* Re-Enable  interrupts */
P
Pavel Roskin 已提交
918
	ath9k_hw_set_interrupts(ah, ah->imask);
919 920

	/* Enable LED */
921
	ath9k_hw_cfg_output(ah, ah->led_pin,
922
			    AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
923
	ath9k_hw_set_gpio(ah, ah->led_pin, 0);
924

925
	ieee80211_wake_queues(hw);
926
	ath9k_ps_restore(sc);
927 928
}

929
void ath_radio_disable(struct ath_softc *sc, struct ieee80211_hw *hw)
930
{
931
	struct ath_hw *ah = sc->sc_ah;
932
	struct ieee80211_channel *channel = hw->conf.channel;
933
	int r;
934

935
	ath9k_ps_wakeup(sc);
936
	ieee80211_stop_queues(hw);
937 938

	/* Disable LED */
939 940
	ath9k_hw_set_gpio(ah, ah->led_pin, 1);
	ath9k_hw_cfg_gpio_input(ah, ah->led_pin);
941 942 943 944

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

S
Sujith 已提交
945
	ath_drain_all_txq(sc, false);	/* clear pending tx frames */
946 947 948
	ath_stoprecv(sc);		/* turn off frame recv */
	ath_flushrecv(sc);		/* flush recv queue */

949
	if (!ah->curchan)
950
		ah->curchan = ath_get_curchannel(sc, hw);
951

952
	spin_lock_bh(&sc->sc_resetlock);
953
	r = ath9k_hw_reset(ah, ah->curchan, false);
954
	if (r) {
955
		ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_FATAL,
956
			  "Unable to reset channel (%u MHz), "
957 958
			  "reset status %d\n",
			  channel->center_freq, r);
959 960 961 962
	}
	spin_unlock_bh(&sc->sc_resetlock);

	ath9k_hw_phy_disable(ah);
V
Vivek Natarajan 已提交
963
	ath9k_hw_configpcipowersave(ah, 1, 1);
964
	ath9k_ps_restore(sc);
965
	ath9k_setpower(sc, ATH9K_PM_FULL_SLEEP);
966 967
}

S
Sujith 已提交
968 969
int ath_reset(struct ath_softc *sc, bool retry_tx)
{
970
	struct ath_hw *ah = sc->sc_ah;
971
	struct ath_common *common = ath9k_hw_common(ah);
972
	struct ieee80211_hw *hw = sc->hw;
973
	int r;
S
Sujith 已提交
974

S
Sujith 已提交
975 976 977
	/* Stop ANI */
	del_timer_sync(&common->ani.timer);

S
Sujith 已提交
978 979
	ieee80211_stop_queues(hw);

S
Sujith 已提交
980
	ath9k_hw_set_interrupts(ah, 0);
S
Sujith 已提交
981
	ath_drain_all_txq(sc, retry_tx);
S
Sujith 已提交
982 983 984 985
	ath_stoprecv(sc);
	ath_flushrecv(sc);

	spin_lock_bh(&sc->sc_resetlock);
986
	r = ath9k_hw_reset(ah, sc->sc_ah->curchan, false);
987
	if (r)
988 989
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to reset hardware; reset status %d\n", r);
S
Sujith 已提交
990 991 992
	spin_unlock_bh(&sc->sc_resetlock);

	if (ath_startrecv(sc) != 0)
993 994
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to start recv logic\n");
S
Sujith 已提交
995 996 997 998 999 1000

	/*
	 * 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.
	 */
1001
	ath_cache_conf_rate(sc, &hw->conf);
S
Sujith 已提交
1002 1003 1004 1005

	ath_update_txpow(sc);

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

P
Pavel Roskin 已提交
1008
	ath9k_hw_set_interrupts(ah, ah->imask);
S
Sujith 已提交
1009 1010 1011 1012 1013

	if (retry_tx) {
		int i;
		for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
			if (ATH_TXQ_SETUP(sc, i)) {
S
Sujith 已提交
1014 1015 1016
				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 已提交
1017 1018 1019 1020
			}
		}
	}

S
Sujith 已提交
1021 1022
	ieee80211_wake_queues(hw);

S
Sujith 已提交
1023 1024 1025
	/* Start ANI */
	ath_start_ani(common);

1026
	return r;
S
Sujith 已提交
1027 1028 1029 1030 1031 1032 1033 1034
}

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

	switch (queue) {
	case 0:
S
Sujith 已提交
1035
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_VO];
S
Sujith 已提交
1036 1037
		break;
	case 1:
S
Sujith 已提交
1038
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_VI];
S
Sujith 已提交
1039 1040
		break;
	case 2:
S
Sujith 已提交
1041
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_BE];
S
Sujith 已提交
1042 1043
		break;
	case 3:
S
Sujith 已提交
1044
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_BK];
S
Sujith 已提交
1045 1046
		break;
	default:
S
Sujith 已提交
1047
		qnum = sc->tx.hwq_map[ATH9K_WME_AC_BE];
S
Sujith 已提交
1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078
		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;
}

1079 1080
/* XXX: Remove me once we don't depend on ath9k_channel for all
 * this redundant data */
1081 1082
void ath9k_update_ichannel(struct ath_softc *sc, struct ieee80211_hw *hw,
			   struct ath9k_channel *ichan)
1083 1084 1085 1086 1087 1088 1089 1090 1091
{
	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 已提交
1092
		ichan->channelFlags = CHANNEL_2GHZ | CHANNEL_OFDM | CHANNEL_G;
1093 1094 1095 1096 1097
	} else {
		ichan->chanmode = CHANNEL_A;
		ichan->channelFlags = CHANNEL_5GHZ | CHANNEL_OFDM;
	}

L
Luis R. Rodriguez 已提交
1098
	if (conf_is_ht(conf))
1099 1100 1101 1102
		ichan->chanmode = ath_get_extchanmode(sc, chan,
					    conf->channel_type);
}

S
Sujith 已提交
1103 1104 1105 1106
/**********************/
/* mac80211 callbacks */
/**********************/

1107
static int ath9k_start(struct ieee80211_hw *hw)
1108
{
1109 1110
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1111
	struct ath_hw *ah = sc->sc_ah;
1112
	struct ath_common *common = ath9k_hw_common(ah);
1113
	struct ieee80211_channel *curchan = hw->conf.channel;
S
Sujith 已提交
1114
	struct ath9k_channel *init_channel;
1115
	int r;
1116

1117 1118 1119
	ath_print(common, ATH_DBG_CONFIG,
		  "Starting driver with initial channel: %d MHz\n",
		  curchan->center_freq);
1120

1121 1122
	mutex_lock(&sc->mutex);

1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143
	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;

1144
	/* setup initial channel */
1145

1146
	sc->chan_idx = curchan->hw_value;
1147

1148
	init_channel = ath_get_curchannel(sc, hw);
S
Sujith 已提交
1149 1150

	/* Reset SERDES registers */
1151
	ath9k_hw_configpcipowersave(ah, 0, 0);
S
Sujith 已提交
1152 1153 1154 1155 1156 1157 1158 1159 1160

	/*
	 * 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);
1161
	r = ath9k_hw_reset(ah, init_channel, false);
1162
	if (r) {
1163 1164 1165 1166
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to reset hardware; reset status %d "
			  "(freq %u MHz)\n", r,
			  curchan->center_freq);
S
Sujith 已提交
1167
		spin_unlock_bh(&sc->sc_resetlock);
1168
		goto mutex_unlock;
S
Sujith 已提交
1169 1170 1171 1172 1173 1174 1175 1176
	}
	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);
1177

S
Sujith 已提交
1178 1179 1180 1181 1182 1183 1184 1185
	/*
	 * 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) {
1186 1187
		ath_print(common, ATH_DBG_FATAL,
			  "Unable to start recv logic\n");
1188 1189
		r = -EIO;
		goto mutex_unlock;
1190
	}
1191

S
Sujith 已提交
1192
	/* Setup our intr mask. */
F
Felix Fietkau 已提交
1193 1194 1195 1196 1197 1198 1199 1200
	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 已提交
1201

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

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

1208
	ath_cache_conf_rate(sc, &hw->conf);
S
Sujith 已提交
1209 1210 1211 1212

	sc->sc_flags &= ~SC_OP_INVALID;

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

1216
	ieee80211_wake_queues(hw);
S
Sujith 已提交
1217

1218
	ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
1219

1220 1221
	if ((ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE) &&
	    !ah->btcoex_hw.enabled) {
1222 1223
		ath9k_hw_btcoex_set_weight(ah, AR_BT_COEX_WGHT,
					   AR_STOMP_LOW_WLAN_WGHT);
1224
		ath9k_hw_btcoex_enable(ah);
1225

1226 1227
		if (common->bus_ops->bt_coex_prep)
			common->bus_ops->bt_coex_prep(common);
1228
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1229
			ath9k_btcoex_timer_resume(sc);
1230 1231
	}

1232 1233 1234
mutex_unlock:
	mutex_unlock(&sc->mutex);

1235
	return r;
1236 1237
}

1238 1239
static int ath9k_tx(struct ieee80211_hw *hw,
		    struct sk_buff *skb)
1240
{
S
Sujith 已提交
1241
	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
1242 1243
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1244
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
S
Sujith 已提交
1245
	struct ath_tx_control txctl;
1246 1247
	int padpos, padsize;
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
S
Sujith 已提交
1248

1249
	if (aphy->state != ATH_WIPHY_ACTIVE && aphy->state != ATH_WIPHY_SCAN) {
1250 1251 1252
		ath_print(common, ATH_DBG_XMIT,
			  "ath9k: %s: TX in unexpected wiphy state "
			  "%d\n", wiphy_name(hw->wiphy), aphy->state);
1253 1254 1255
		goto exit;
	}

1256
	if (sc->ps_enabled) {
1257 1258 1259 1260 1261 1262 1263
		/*
		 * 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)) {
1264 1265
			ath_print(common, ATH_DBG_PS, "Add PM=1 for a TX frame "
				  "while in PS mode\n");
1266 1267 1268 1269
			hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
		}
	}

1270 1271 1272 1273 1274 1275 1276 1277 1278
	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)) {
1279 1280
			ath_print(common, ATH_DBG_PS,
				  "Sending PS-Poll to pick a buffered frame\n");
S
Sujith 已提交
1281
			sc->ps_flags |= PS_WAIT_FOR_PSPOLL_DATA;
1282
		} else {
1283 1284
			ath_print(common, ATH_DBG_PS,
				  "Wake up to complete TX\n");
S
Sujith 已提交
1285
			sc->ps_flags |= PS_WAIT_FOR_TX_ACK;
1286 1287 1288 1289 1290 1291 1292 1293 1294
		}
		/*
		 * 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 已提交
1295
	memset(&txctl, 0, sizeof(struct ath_tx_control));
1296

1297 1298 1299 1300 1301 1302 1303
	/*
	 * 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 已提交
1304
			sc->tx.seq_no += 0x10;
1305
		hdr->seq_ctrl &= cpu_to_le16(IEEE80211_SCTL_FRAG);
S
Sujith 已提交
1306
		hdr->seq_ctrl |= cpu_to_le16(sc->tx.seq_no);
1307
	}
1308

1309
	/* Add the padding after the header if this is not already done */
1310 1311 1312
	padpos = ath9k_cmn_padpos(hdr->frame_control);
	padsize = padpos & 3;
	if (padsize && skb->len>padpos) {
1313 1314 1315
		if (skb_headroom(skb) < padsize)
			return -1;
		skb_push(skb, padsize);
1316
		memmove(skb->data, skb->data + padsize, padpos);
1317 1318
	}

S
Sujith 已提交
1319 1320 1321 1322 1323 1324
	/* Check if a tx queue is available */

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

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

1327
	if (ath_tx_start(hw, skb, &txctl) != 0) {
1328
		ath_print(common, ATH_DBG_XMIT, "TX failed\n");
S
Sujith 已提交
1329
		goto exit;
1330 1331
	}

S
Sujith 已提交
1332 1333 1334
	return 0;
exit:
	dev_kfree_skb_any(skb);
1335
	return 0;
1336 1337
}

1338
static void ath9k_stop(struct ieee80211_hw *hw)
1339
{
1340 1341
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1342
	struct ath_hw *ah = sc->sc_ah;
1343
	struct ath_common *common = ath9k_hw_common(ah);
1344

S
Sujith 已提交
1345 1346
	mutex_lock(&sc->mutex);

1347 1348
	aphy->state = ATH_WIPHY_INACTIVE;

1349 1350 1351 1352 1353 1354 1355 1356
	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 已提交
1357
	if (sc->sc_flags & SC_OP_INVALID) {
1358
		ath_print(common, ATH_DBG_ANY, "Device not present\n");
S
Sujith 已提交
1359
		mutex_unlock(&sc->mutex);
S
Sujith 已提交
1360 1361
		return;
	}
1362

1363 1364 1365 1366 1367
	if (ath9k_wiphy_started(sc)) {
		mutex_unlock(&sc->mutex);
		return; /* another wiphy still in use */
	}

1368 1369 1370
	/* Ensure HW is awake when we try to shut it down. */
	ath9k_ps_wakeup(sc);

1371
	if (ah->btcoex_hw.enabled) {
1372
		ath9k_hw_btcoex_disable(ah);
1373
		if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1374
			ath9k_btcoex_timer_pause(sc);
1375 1376
	}

S
Sujith 已提交
1377 1378
	/* make sure h/w will not generate any interrupt
	 * before setting the invalid flag. */
1379
	ath9k_hw_set_interrupts(ah, 0);
S
Sujith 已提交
1380 1381

	if (!(sc->sc_flags & SC_OP_INVALID)) {
S
Sujith 已提交
1382
		ath_drain_all_txq(sc, false);
S
Sujith 已提交
1383
		ath_stoprecv(sc);
1384
		ath9k_hw_phy_disable(ah);
S
Sujith 已提交
1385
	} else
S
Sujith 已提交
1386
		sc->rx.rxlink = NULL;
S
Sujith 已提交
1387 1388

	/* disable HAL and put h/w to sleep */
1389 1390
	ath9k_hw_disable(ah);
	ath9k_hw_configpcipowersave(ah, 1, 1);
1391 1392 1393
	ath9k_ps_restore(sc);

	/* Finally, put the chip in FULL SLEEP mode */
1394
	ath9k_setpower(sc, ATH9K_PM_FULL_SLEEP);
S
Sujith 已提交
1395 1396

	sc->sc_flags |= SC_OP_INVALID;
1397

1398 1399
	mutex_unlock(&sc->mutex);

1400
	ath_print(common, ATH_DBG_CONFIG, "Driver halt\n");
1401 1402
}

1403
static int ath9k_add_interface(struct ieee80211_hw *hw,
1404
			       struct ieee80211_vif *vif)
1405
{
1406 1407
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
P
Pavel Roskin 已提交
1408 1409
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
1410
	struct ath_vif *avp = (void *)vif->drv_priv;
1411
	enum nl80211_iftype ic_opmode = NL80211_IFTYPE_UNSPECIFIED;
1412
	int ret = 0;
1413

1414 1415
	mutex_lock(&sc->mutex);

P
Pavel Roskin 已提交
1416
	if (!(ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK) &&
1417 1418 1419 1420 1421
	    sc->nvifs > 0) {
		ret = -ENOBUFS;
		goto out;
	}

1422
	switch (vif->type) {
1423
	case NL80211_IFTYPE_STATION:
1424
		ic_opmode = NL80211_IFTYPE_STATION;
1425
		break;
1426 1427
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_AP:
1428
	case NL80211_IFTYPE_MESH_POINT:
1429 1430 1431 1432
		if (sc->nbcnvifs >= ATH_BCBUF) {
			ret = -ENOBUFS;
			goto out;
		}
1433
		ic_opmode = vif->type;
1434 1435
		break;
	default:
1436
		ath_print(common, ATH_DBG_FATAL,
1437
			"Interface type %d not yet supported\n", vif->type);
1438 1439
		ret = -EOPNOTSUPP;
		goto out;
1440 1441
	}

1442 1443
	ath_print(common, ATH_DBG_CONFIG,
		  "Attach a VIF of type: %d\n", ic_opmode);
1444

S
Sujith 已提交
1445
	/* Set the VIF opmode */
S
Sujith 已提交
1446 1447 1448
	avp->av_opmode = ic_opmode;
	avp->av_bslot = -1;

1449
	sc->nvifs++;
1450

P
Pavel Roskin 已提交
1451
	if (ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK)
1452 1453
		ath9k_set_bssid_mask(hw);

1454 1455 1456
	if (sc->nvifs > 1)
		goto out; /* skip global settings for secondary vif */

S
Sujith 已提交
1457
	if (ic_opmode == NL80211_IFTYPE_AP) {
P
Pavel Roskin 已提交
1458
		ath9k_hw_set_tsfadjust(ah, 1);
S
Sujith 已提交
1459 1460
		sc->sc_flags |= SC_OP_TSF_RESET;
	}
S
Sujith 已提交
1461 1462

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

1465 1466 1467 1468
	/*
	 * Enable MIB interrupts when there are hardware phy counters.
	 * Note we only do this (at the moment) for station mode.
	 */
1469 1470 1471
	if ((vif->type == NL80211_IFTYPE_STATION) ||
	    (vif->type == NL80211_IFTYPE_ADHOC) ||
	    (vif->type == NL80211_IFTYPE_MESH_POINT)) {
1472 1473
		if (ah->config.enable_ani)
			ah->imask |= ATH9K_INT_MIB;
P
Pavel Roskin 已提交
1474
		ah->imask |= ATH9K_INT_TSFOOR;
1475 1476
	}

P
Pavel Roskin 已提交
1477
	ath9k_hw_set_interrupts(ah, ah->imask);
1478

1479 1480 1481
	if (vif->type == NL80211_IFTYPE_AP    ||
	    vif->type == NL80211_IFTYPE_ADHOC ||
	    vif->type == NL80211_IFTYPE_MONITOR)
1482
		ath_start_ani(common);
1483

1484
out:
1485
	mutex_unlock(&sc->mutex);
1486
	return ret;
1487 1488
}

1489
static void ath9k_remove_interface(struct ieee80211_hw *hw,
1490
				   struct ieee80211_vif *vif)
1491
{
1492 1493
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1494
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1495
	struct ath_vif *avp = (void *)vif->drv_priv;
1496
	int i;
1497

1498
	ath_print(common, ATH_DBG_CONFIG, "Detach Interface\n");
1499

1500 1501
	mutex_lock(&sc->mutex);

1502
	/* Stop ANI */
1503
	del_timer_sync(&common->ani.timer);
J
Jouni Malinen 已提交
1504

1505
	/* Reclaim beacon resources */
1506 1507 1508
	if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) ||
	    (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC) ||
	    (sc->sc_ah->opmode == NL80211_IFTYPE_MESH_POINT)) {
1509
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
1510
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
1511
		ath9k_ps_restore(sc);
J
Jouni Malinen 已提交
1512
	}
1513

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

1517
	for (i = 0; i < ARRAY_SIZE(sc->beacon.bslot); i++) {
1518
		if (sc->beacon.bslot[i] == vif) {
1519 1520 1521
			printk(KERN_DEBUG "%s: vif had allocated beacon "
			       "slot\n", __func__);
			sc->beacon.bslot[i] = NULL;
1522
			sc->beacon.bslot_aphy[i] = NULL;
1523 1524 1525
		}
	}

S
Sujith 已提交
1526
	sc->nvifs--;
1527 1528

	mutex_unlock(&sc->mutex);
1529 1530
}

1531 1532
void ath9k_enable_ps(struct ath_softc *sc)
{
P
Pavel Roskin 已提交
1533 1534
	struct ath_hw *ah = sc->sc_ah;

1535
	sc->ps_enabled = true;
P
Pavel Roskin 已提交
1536 1537 1538 1539
	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);
1540 1541
		}
	}
P
Pavel Roskin 已提交
1542
	ath9k_hw_setrxabort(ah, 1);
1543 1544
}

1545
static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
1546
{
1547 1548
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1549
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1550
	struct ieee80211_conf *conf = &hw->conf;
1551
	struct ath_hw *ah = sc->sc_ah;
1552
	bool disable_radio;
1553

1554
	mutex_lock(&sc->mutex);
1555

1556 1557 1558 1559 1560 1561
	/*
	 * 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.
	 */
1562
	if (changed & IEEE80211_CONF_CHANGE_IDLE) {
1563 1564 1565
		bool enable_radio;
		bool all_wiphys_idle;
		bool idle = !!(conf->flags & IEEE80211_CONF_IDLE);
1566 1567 1568

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

1571
		enable_radio = (!idle && all_wiphys_idle);
1572 1573 1574 1575 1576 1577 1578

		/*
		 * 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.
		 */
1579 1580
		spin_unlock_bh(&sc->wiphy_lock);

1581
		if (enable_radio) {
1582
			sc->ps_idle = false;
1583
			ath_radio_enable(sc, hw);
1584 1585
			ath_print(common, ATH_DBG_CONFIG,
				  "not-idle: enabling radio\n");
1586 1587 1588
		}
	}

1589 1590 1591 1592 1593 1594
	/*
	 * 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.
	 */
1595 1596
	if (changed & IEEE80211_CONF_CHANGE_PS) {
		if (conf->flags & IEEE80211_CONF_PS) {
S
Sujith 已提交
1597
			sc->ps_flags |= PS_ENABLED;
1598 1599 1600 1601
			/*
			 * At this point we know hardware has received an ACK
			 * of a previously sent null data frame.
			 */
S
Sujith 已提交
1602 1603
			if ((sc->ps_flags & PS_NULLFUNC_COMPLETED)) {
				sc->ps_flags &= ~PS_NULLFUNC_COMPLETED;
1604
				ath9k_enable_ps(sc);
1605
                        }
1606
		} else {
1607
			sc->ps_enabled = false;
S
Sujith 已提交
1608 1609
			sc->ps_flags &= ~(PS_ENABLED |
					  PS_NULLFUNC_COMPLETED);
1610
			ath9k_setpower(sc, ATH9K_PM_AWAKE);
1611 1612 1613
			if (!(ah->caps.hw_caps &
			      ATH9K_HW_CAP_AUTOSLEEP)) {
				ath9k_hw_setrxabort(sc->sc_ah, 0);
S
Sujith 已提交
1614 1615 1616 1617
				sc->ps_flags &= ~(PS_WAIT_FOR_BEACON |
						  PS_WAIT_FOR_CAB |
						  PS_WAIT_FOR_PSPOLL_DATA |
						  PS_WAIT_FOR_TX_ACK);
P
Pavel Roskin 已提交
1618 1619
				if (ah->imask & ATH9K_INT_TIM_TIMER) {
					ah->imask &= ~ATH9K_INT_TIM_TIMER;
1620
					ath9k_hw_set_interrupts(sc->sc_ah,
P
Pavel Roskin 已提交
1621
							ah->imask);
1622
				}
1623 1624 1625 1626
			}
		}
	}

S
Sujith 已提交
1627 1628 1629 1630 1631 1632 1633 1634
	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;
		}
	}

1635
	if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
1636
		struct ieee80211_channel *curchan = hw->conf.channel;
1637
		int pos = curchan->hw_value;
J
Johannes Berg 已提交
1638

1639 1640 1641
		aphy->chan_idx = pos;
		aphy->chan_is_ht = conf_is_ht(conf);

1642 1643 1644 1645 1646 1647 1648 1649 1650 1651
		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;
		}
1652

1653 1654
		ath_print(common, ATH_DBG_CONFIG, "Set channel: %d MHz\n",
			  curchan->center_freq);
1655

1656
		/* XXX: remove me eventualy */
1657
		ath9k_update_ichannel(sc, hw, &sc->sc_ah->channels[pos]);
1658

1659
		ath_update_chainmask(sc, conf_is_ht(conf));
S
Sujith 已提交
1660

1661
		if (ath_set_channel(sc, hw, &sc->sc_ah->channels[pos]) < 0) {
1662 1663
			ath_print(common, ATH_DBG_FATAL,
				  "Unable to set channel\n");
1664
			mutex_unlock(&sc->mutex);
1665 1666
			return -EINVAL;
		}
S
Sujith 已提交
1667
	}
1668

1669
skip_chan_change:
1670
	if (changed & IEEE80211_CONF_CHANGE_POWER) {
S
Sujith 已提交
1671
		sc->config.txpowlimit = 2 * conf->power_level;
1672 1673
		ath_update_txpow(sc);
	}
1674

1675 1676 1677 1678
	spin_lock_bh(&sc->wiphy_lock);
	disable_radio = ath9k_all_wiphys_idle(sc);
	spin_unlock_bh(&sc->wiphy_lock);

1679
	if (disable_radio) {
1680
		ath_print(common, ATH_DBG_CONFIG, "idle: disabling radio\n");
1681
		sc->ps_idle = true;
1682
		ath_radio_disable(sc, hw);
1683 1684
	}

1685
	mutex_unlock(&sc->mutex);
1686

1687 1688 1689
	return 0;
}

1690 1691 1692 1693
#define SUPPORTED_FILTERS			\
	(FIF_PROMISC_IN_BSS |			\
	FIF_ALLMULTI |				\
	FIF_CONTROL |				\
1694
	FIF_PSPOLL |				\
1695 1696 1697
	FIF_OTHER_BSS |				\
	FIF_BCN_PRBRESP_PROMISC |		\
	FIF_FCSFAIL)
1698

1699 1700 1701 1702
/* FIXME: sc->sc_full_reset ? */
static void ath9k_configure_filter(struct ieee80211_hw *hw,
				   unsigned int changed_flags,
				   unsigned int *total_flags,
1703
				   u64 multicast)
1704
{
1705 1706
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1707
	u32 rfilt;
1708

1709 1710
	changed_flags &= SUPPORTED_FILTERS;
	*total_flags &= SUPPORTED_FILTERS;
1711

S
Sujith 已提交
1712
	sc->rx.rxfilter = *total_flags;
1713
	ath9k_ps_wakeup(sc);
1714 1715
	rfilt = ath_calcrxfilter(sc);
	ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1716
	ath9k_ps_restore(sc);
1717

1718 1719
	ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_CONFIG,
		  "Set HW RX filter: 0x%x\n", rfilt);
1720
}
1721

1722 1723 1724
static int ath9k_sta_add(struct ieee80211_hw *hw,
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta)
1725
{
1726 1727
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1728

1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743
	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;
1744 1745
}

1746
static int ath9k_conf_tx(struct ieee80211_hw *hw, u16 queue,
1747
			 const struct ieee80211_tx_queue_params *params)
1748
{
1749 1750
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1751
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1752 1753
	struct ath9k_tx_queue_info qi;
	int ret = 0, qnum;
1754

1755 1756
	if (queue >= WME_NUM_AC)
		return 0;
1757

1758 1759
	mutex_lock(&sc->mutex);

1760 1761
	memset(&qi, 0, sizeof(struct ath9k_tx_queue_info));

1762 1763 1764 1765 1766
	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);
1767

1768 1769 1770 1771 1772
	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);
1773

1774 1775
	ret = ath_txq_update(sc, qnum, &qi);
	if (ret)
1776
		ath_print(common, ATH_DBG_FATAL, "TXQ Update failed\n");
1777

1778 1779 1780 1781
	if (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC)
		if ((qnum == sc->tx.hwq_map[ATH9K_WME_AC_BE]) && !ret)
			ath_beaconq_config(sc);

1782 1783
	mutex_unlock(&sc->mutex);

1784 1785
	return ret;
}
1786

1787 1788
static int ath9k_set_key(struct ieee80211_hw *hw,
			 enum set_key_cmd cmd,
1789 1790
			 struct ieee80211_vif *vif,
			 struct ieee80211_sta *sta,
1791 1792
			 struct ieee80211_key_conf *key)
{
1793 1794
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1795
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1796
	int ret = 0;
1797

1798 1799 1800
	if (modparam_nohwcrypt)
		return -ENOSPC;

1801
	mutex_lock(&sc->mutex);
1802
	ath9k_ps_wakeup(sc);
1803
	ath_print(common, ATH_DBG_CONFIG, "Set HW Key\n");
1804

1805 1806
	switch (cmd) {
	case SET_KEY:
1807
		ret = ath_key_config(common, vif, sta, key);
1808 1809
		if (ret >= 0) {
			key->hw_key_idx = ret;
1810 1811 1812 1813
			/* 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;
1814 1815
			if (sc->sc_ah->sw_mgmt_crypto && key->alg == ALG_CCMP)
				key->flags |= IEEE80211_KEY_FLAG_SW_MGMT;
1816
			ret = 0;
1817 1818 1819
		}
		break;
	case DISABLE_KEY:
1820
		ath_key_delete(common, key);
1821 1822 1823 1824
		break;
	default:
		ret = -EINVAL;
	}
1825

1826
	ath9k_ps_restore(sc);
1827 1828
	mutex_unlock(&sc->mutex);

1829 1830
	return ret;
}
1831

1832 1833 1834 1835 1836
static void ath9k_bss_info_changed(struct ieee80211_hw *hw,
				   struct ieee80211_vif *vif,
				   struct ieee80211_bss_conf *bss_conf,
				   u32 changed)
{
1837 1838
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1839
	struct ath_hw *ah = sc->sc_ah;
1840
	struct ath_common *common = ath9k_hw_common(ah);
1841
	struct ath_vif *avp = (void *)vif->drv_priv;
1842
	int slottime;
S
Sujith 已提交
1843
	int error;
1844

1845 1846
	mutex_lock(&sc->mutex);

S
Sujith 已提交
1847 1848 1849 1850
	if (changed & BSS_CHANGED_BSSID) {
		/* Set BSSID */
		memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
		memcpy(avp->bssid, bss_conf->bssid, ETH_ALEN);
1851
		common->curaid = 0;
1852
		ath9k_hw_write_associd(ah);
1853

S
Sujith 已提交
1854 1855
		/* Set aggregation protection mode parameters */
		sc->config.ath_aggr_prot = 0;
1856

S
Sujith 已提交
1857 1858 1859
		/* Only legacy IBSS for now */
		if (vif->type == NL80211_IFTYPE_ADHOC)
			ath_update_chainmask(sc, 0);
1860

S
Sujith 已提交
1861 1862 1863
		ath_print(common, ATH_DBG_CONFIG,
			  "BSSID: %pM aid: 0x%x\n",
			  common->curbssid, common->curaid);
1864

S
Sujith 已提交
1865 1866 1867
		/* need to reconfigure the beacon */
		sc->sc_flags &= ~SC_OP_BEACONS ;
	}
1868

S
Sujith 已提交
1869 1870 1871 1872 1873 1874 1875
	/* 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);
1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894
	}

	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);
		}
1895 1896
	}

S
Sujith 已提交
1897 1898 1899
	/* Disable transmission of beacons */
	if ((changed & BSS_CHANGED_BEACON_ENABLED) && !bss_conf->enable_beacon)
		ath9k_hw_stoptxdma(sc->sc_ah, sc->beacon.beaconq);
1900

S
Sujith 已提交
1901 1902 1903 1904 1905 1906 1907 1908 1909
	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);
1910 1911 1912
			error = ath_beacon_alloc(aphy, vif);
			if (!error)
				ath_beacon_config(sc, vif);
S
Sujith 已提交
1913 1914
		} else {
			ath_beacon_config(sc, vif);
1915 1916 1917
		}
	}

1918
	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
1919 1920
		ath_print(common, ATH_DBG_CONFIG, "BSS Changed PREAMBLE %d\n",
			  bss_conf->use_short_preamble);
1921 1922 1923 1924 1925
		if (bss_conf->use_short_preamble)
			sc->sc_flags |= SC_OP_PREAMBLE_SHORT;
		else
			sc->sc_flags &= ~SC_OP_PREAMBLE_SHORT;
	}
1926

1927
	if (changed & BSS_CHANGED_ERP_CTS_PROT) {
1928 1929
		ath_print(common, ATH_DBG_CONFIG, "BSS Changed CTS PROT %d\n",
			  bss_conf->use_cts_prot);
1930 1931 1932 1933 1934 1935
		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;
	}
1936

1937
	if (changed & BSS_CHANGED_ASSOC) {
1938
		ath_print(common, ATH_DBG_CONFIG, "BSS Changed ASSOC %d\n",
1939
			bss_conf->assoc);
S
Sujith 已提交
1940
		ath9k_bss_assoc_info(sc, vif, bss_conf);
1941
	}
1942 1943

	mutex_unlock(&sc->mutex);
1944
}
1945

1946 1947 1948
static u64 ath9k_get_tsf(struct ieee80211_hw *hw)
{
	u64 tsf;
1949 1950
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1951

1952 1953 1954
	mutex_lock(&sc->mutex);
	tsf = ath9k_hw_gettsf64(sc->sc_ah);
	mutex_unlock(&sc->mutex);
1955

1956 1957
	return tsf;
}
1958

1959 1960
static void ath9k_set_tsf(struct ieee80211_hw *hw, u64 tsf)
{
1961 1962
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1963

1964 1965 1966
	mutex_lock(&sc->mutex);
	ath9k_hw_settsf64(sc->sc_ah, tsf);
	mutex_unlock(&sc->mutex);
1967 1968
}

1969 1970
static void ath9k_reset_tsf(struct ieee80211_hw *hw)
{
1971 1972
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1973

1974
	mutex_lock(&sc->mutex);
1975 1976

	ath9k_ps_wakeup(sc);
1977
	ath9k_hw_reset_tsf(sc->sc_ah);
1978 1979
	ath9k_ps_restore(sc);

1980
	mutex_unlock(&sc->mutex);
1981
}
1982

1983
static int ath9k_ampdu_action(struct ieee80211_hw *hw,
1984
			      struct ieee80211_vif *vif,
1985 1986 1987
			      enum ieee80211_ampdu_mlme_action action,
			      struct ieee80211_sta *sta,
			      u16 tid, u16 *ssn)
1988
{
1989 1990
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
1991
	int ret = 0;
1992

1993 1994
	switch (action) {
	case IEEE80211_AMPDU_RX_START:
1995 1996
		if (!(sc->sc_flags & SC_OP_RXAGGR))
			ret = -ENOTSUPP;
1997 1998 1999 2000
		break;
	case IEEE80211_AMPDU_RX_STOP:
		break;
	case IEEE80211_AMPDU_TX_START:
2001
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
2002
		ath_tx_aggr_start(sc, sta, tid, ssn);
2003
		ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2004
		ath9k_ps_restore(sc);
2005 2006
		break;
	case IEEE80211_AMPDU_TX_STOP:
2007
		ath9k_ps_wakeup(sc);
S
Sujith 已提交
2008
		ath_tx_aggr_stop(sc, sta, tid);
2009
		ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2010
		ath9k_ps_restore(sc);
2011
		break;
2012
	case IEEE80211_AMPDU_TX_OPERATIONAL:
2013
		ath9k_ps_wakeup(sc);
2014
		ath_tx_aggr_resume(sc, sta, tid);
2015
		ath9k_ps_restore(sc);
2016
		break;
2017
	default:
2018 2019
		ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_FATAL,
			  "Unknown AMPDU action\n");
2020 2021 2022
	}

	return ret;
2023 2024
}

2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043
static int ath9k_get_survey(struct ieee80211_hw *hw, int idx,
			     struct survey_info *survey)
{
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
	struct ath_hw *ah = sc->sc_ah;
	struct ath_common *common = ath9k_hw_common(ah);
	struct ieee80211_conf *conf = &hw->conf;

	 if (idx != 0)
		return -ENOENT;

	survey->channel = conf->channel;
	survey->filled = SURVEY_INFO_NOISE_DBM;
	survey->noise = common->ani.noise_floor;

	return 0;
}

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

2050
	mutex_lock(&sc->mutex);
2051 2052 2053 2054 2055 2056 2057
	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.
		 */
2058
		mutex_unlock(&sc->mutex);
2059 2060 2061 2062 2063
		return;
	}

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

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

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

2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097
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);
}

2098
struct ieee80211_ops ath9k_ops = {
2099 2100 2101 2102 2103 2104 2105
	.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,
2106 2107
	.sta_add	    = ath9k_sta_add,
	.sta_remove	    = ath9k_sta_remove,
2108 2109 2110 2111
	.conf_tx 	    = ath9k_conf_tx,
	.bss_info_changed   = ath9k_bss_info_changed,
	.set_key            = ath9k_set_key,
	.get_tsf 	    = ath9k_get_tsf,
2112
	.set_tsf 	    = ath9k_set_tsf,
2113
	.reset_tsf 	    = ath9k_reset_tsf,
2114
	.ampdu_action       = ath9k_ampdu_action,
2115
	.get_survey	    = ath9k_get_survey,
2116 2117
	.sw_scan_start      = ath9k_sw_scan_start,
	.sw_scan_complete   = ath9k_sw_scan_complete,
J
Johannes Berg 已提交
2118
	.rfkill_poll        = ath9k_rfkill_poll_state,
2119
	.set_coverage_class = ath9k_set_coverage_class,
2120
};