hw.c 102.9 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 18 19
 *
 * 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/io.h>
#include <asm/unaligned.h>

S
Sujith 已提交
20
#include "ath9k.h"
21 22
#include "initvals.h"

23 24 25 26
static int btcoex_enable;
module_param(btcoex_enable, bool, 0);
MODULE_PARM_DESC(btcoex_enable, "Enable Bluetooth coexistence support");

27 28 29
#define ATH9K_CLOCK_RATE_CCK		22
#define ATH9K_CLOCK_RATE_5GHZ_OFDM	40
#define ATH9K_CLOCK_RATE_2GHZ_OFDM	44
30

31 32
static bool ath9k_hw_set_reset_reg(struct ath_hw *ah, u32 type);
static void ath9k_hw_set_regs(struct ath_hw *ah, struct ath9k_channel *chan,
S
Sujith 已提交
33
			      enum ath9k_ht_macmode macmode);
34
static u32 ath9k_hw_ini_fixup(struct ath_hw *ah,
35
			      struct ar5416_eeprom_def *pEepData,
S
Sujith 已提交
36
			      u32 reg, u32 value);
37 38
static void ath9k_hw_9280_spur_mitigate(struct ath_hw *ah, struct ath9k_channel *chan);
static void ath9k_hw_spur_mitigate(struct ath_hw *ah, struct ath9k_channel *chan);
39

S
Sujith 已提交
40 41 42
/********************/
/* Helper Functions */
/********************/
43

44
static u32 ath9k_hw_mac_usec(struct ath_hw *ah, u32 clks)
S
Sujith 已提交
45
{
46
	struct ieee80211_conf *conf = &ah->ah_sc->hw->conf;
47

48
	if (!ah->curchan) /* should really check for CCK instead */
49 50 51
		return clks / ATH9K_CLOCK_RATE_CCK;
	if (conf->channel->band == IEEE80211_BAND_2GHZ)
		return clks / ATH9K_CLOCK_RATE_2GHZ_OFDM;
52

53
	return clks / ATH9K_CLOCK_RATE_5GHZ_OFDM;
S
Sujith 已提交
54
}
55

56
static u32 ath9k_hw_mac_to_usec(struct ath_hw *ah, u32 clks)
S
Sujith 已提交
57
{
58
	struct ieee80211_conf *conf = &ah->ah_sc->hw->conf;
59

60
	if (conf_is_ht40(conf))
S
Sujith 已提交
61 62 63 64
		return ath9k_hw_mac_usec(ah, clks) / 2;
	else
		return ath9k_hw_mac_usec(ah, clks);
}
65

66
static u32 ath9k_hw_mac_clks(struct ath_hw *ah, u32 usecs)
S
Sujith 已提交
67
{
68
	struct ieee80211_conf *conf = &ah->ah_sc->hw->conf;
69

70
	if (!ah->curchan) /* should really check for CCK instead */
71 72 73 74
		return usecs *ATH9K_CLOCK_RATE_CCK;
	if (conf->channel->band == IEEE80211_BAND_2GHZ)
		return usecs *ATH9K_CLOCK_RATE_2GHZ_OFDM;
	return usecs *ATH9K_CLOCK_RATE_5GHZ_OFDM;
S
Sujith 已提交
75 76
}

77
static u32 ath9k_hw_mac_to_clks(struct ath_hw *ah, u32 usecs)
S
Sujith 已提交
78
{
79
	struct ieee80211_conf *conf = &ah->ah_sc->hw->conf;
80

81
	if (conf_is_ht40(conf))
S
Sujith 已提交
82 83 84 85
		return ath9k_hw_mac_clks(ah, usecs) * 2;
	else
		return ath9k_hw_mac_clks(ah, usecs);
}
86

87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118
/*
 * Read and write, they both share the same lock. We do this to serialize
 * reads and writes on Atheros 802.11n PCI devices only. This is required
 * as the FIFO on these devices can only accept sanely 2 requests. After
 * that the device goes bananas. Serializing the reads/writes prevents this
 * from happening.
 */

void ath9k_iowrite32(struct ath_hw *ah, u32 reg_offset, u32 val)
{
	if (ah->config.serialize_regmode == SER_REG_MODE_ON) {
		unsigned long flags;
		spin_lock_irqsave(&ah->ah_sc->sc_serial_rw, flags);
		iowrite32(val, ah->ah_sc->mem + reg_offset);
		spin_unlock_irqrestore(&ah->ah_sc->sc_serial_rw, flags);
	} else
		iowrite32(val, ah->ah_sc->mem + reg_offset);
}

unsigned int ath9k_ioread32(struct ath_hw *ah, u32 reg_offset)
{
	u32 val;
	if (ah->config.serialize_regmode == SER_REG_MODE_ON) {
		unsigned long flags;
		spin_lock_irqsave(&ah->ah_sc->sc_serial_rw, flags);
		val = ioread32(ah->ah_sc->mem + reg_offset);
		spin_unlock_irqrestore(&ah->ah_sc->sc_serial_rw, flags);
	} else
		val = ioread32(ah->ah_sc->mem + reg_offset);
	return val;
}

S
Sujith 已提交
119
bool ath9k_hw_wait(struct ath_hw *ah, u32 reg, u32 mask, u32 val, u32 timeout)
120 121 122
{
	int i;

S
Sujith 已提交
123 124 125
	BUG_ON(timeout < AH_TIME_QUANTUM);

	for (i = 0; i < (timeout / AH_TIME_QUANTUM); i++) {
126 127 128 129 130
		if ((REG_READ(ah, reg) & mask) == val)
			return true;

		udelay(AH_TIME_QUANTUM);
	}
S
Sujith 已提交
131

S
Sujith 已提交
132
	DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
133 134
		"timeout (%d us) on reg 0x%x: 0x%08x & 0x%08x != 0x%08x\n",
		timeout, reg, REG_READ(ah, reg), mask, val);
135

S
Sujith 已提交
136
	return false;
137 138 139 140 141 142 143 144 145 146 147 148 149 150
}

u32 ath9k_hw_reverse_bits(u32 val, u32 n)
{
	u32 retval;
	int i;

	for (i = 0, retval = 0; i < n; i++) {
		retval = (retval << 1) | (val & 1);
		val >>= 1;
	}
	return retval;
}

151
bool ath9k_get_channel_edges(struct ath_hw *ah,
S
Sujith 已提交
152 153
			     u16 flags, u16 *low,
			     u16 *high)
154
{
155
	struct ath9k_hw_capabilities *pCap = &ah->caps;
156

S
Sujith 已提交
157 158 159 160
	if (flags & CHANNEL_5GHZ) {
		*low = pCap->low_5ghz_chan;
		*high = pCap->high_5ghz_chan;
		return true;
161
	}
S
Sujith 已提交
162 163 164 165 166 167
	if ((flags & CHANNEL_2GHZ)) {
		*low = pCap->low_2ghz_chan;
		*high = pCap->high_2ghz_chan;
		return true;
	}
	return false;
168 169
}

170
u16 ath9k_hw_computetxtime(struct ath_hw *ah,
171
			   const struct ath_rate_table *rates,
S
Sujith 已提交
172 173
			   u32 frameLen, u16 rateix,
			   bool shortPreamble)
174
{
S
Sujith 已提交
175 176
	u32 bitsPerSymbol, numBits, numSymbols, phyTime, txTime;
	u32 kbps;
177

S
Sujith 已提交
178
	kbps = rates->info[rateix].ratekbps;
179

S
Sujith 已提交
180 181
	if (kbps == 0)
		return 0;
182

S
Sujith 已提交
183
	switch (rates->info[rateix].phy) {
S
Sujith 已提交
184
	case WLAN_RC_PHY_CCK:
S
Sujith 已提交
185
		phyTime = CCK_PREAMBLE_BITS + CCK_PLCP_BITS;
S
Sujith 已提交
186
		if (shortPreamble && rates->info[rateix].short_preamble)
S
Sujith 已提交
187 188 189 190
			phyTime >>= 1;
		numBits = frameLen << 3;
		txTime = CCK_SIFS_TIME + phyTime + ((numBits * 1000) / kbps);
		break;
S
Sujith 已提交
191
	case WLAN_RC_PHY_OFDM:
192
		if (ah->curchan && IS_CHAN_QUARTER_RATE(ah->curchan)) {
S
Sujith 已提交
193 194 195 196 197 198
			bitsPerSymbol =	(kbps * OFDM_SYMBOL_TIME_QUARTER) / 1000;
			numBits = OFDM_PLCP_BITS + (frameLen << 3);
			numSymbols = DIV_ROUND_UP(numBits, bitsPerSymbol);
			txTime = OFDM_SIFS_TIME_QUARTER
				+ OFDM_PREAMBLE_TIME_QUARTER
				+ (numSymbols * OFDM_SYMBOL_TIME_QUARTER);
199 200
		} else if (ah->curchan &&
			   IS_CHAN_HALF_RATE(ah->curchan)) {
S
Sujith 已提交
201 202 203 204 205 206 207 208 209 210 211 212 213 214 215
			bitsPerSymbol =	(kbps * OFDM_SYMBOL_TIME_HALF) / 1000;
			numBits = OFDM_PLCP_BITS + (frameLen << 3);
			numSymbols = DIV_ROUND_UP(numBits, bitsPerSymbol);
			txTime = OFDM_SIFS_TIME_HALF +
				OFDM_PREAMBLE_TIME_HALF
				+ (numSymbols * OFDM_SYMBOL_TIME_HALF);
		} else {
			bitsPerSymbol = (kbps * OFDM_SYMBOL_TIME) / 1000;
			numBits = OFDM_PLCP_BITS + (frameLen << 3);
			numSymbols = DIV_ROUND_UP(numBits, bitsPerSymbol);
			txTime = OFDM_SIFS_TIME + OFDM_PREAMBLE_TIME
				+ (numSymbols * OFDM_SYMBOL_TIME);
		}
		break;
	default:
S
Sujith 已提交
216
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
217
			"Unknown phy %u (rate ix %u)\n",
S
Sujith 已提交
218 219 220 221
			rates->info[rateix].phy, rateix);
		txTime = 0;
		break;
	}
222

S
Sujith 已提交
223 224
	return txTime;
}
225

226
void ath9k_hw_get_channel_centers(struct ath_hw *ah,
S
Sujith 已提交
227 228
				  struct ath9k_channel *chan,
				  struct chan_centers *centers)
229
{
S
Sujith 已提交
230
	int8_t extoff;
231

S
Sujith 已提交
232 233 234 235
	if (!IS_CHAN_HT40(chan)) {
		centers->ctl_center = centers->ext_center =
			centers->synth_center = chan->channel;
		return;
236 237
	}

S
Sujith 已提交
238 239 240 241 242 243 244 245 246 247
	if ((chan->chanmode == CHANNEL_A_HT40PLUS) ||
	    (chan->chanmode == CHANNEL_G_HT40PLUS)) {
		centers->synth_center =
			chan->channel + HT40_CHANNEL_CENTER_SHIFT;
		extoff = 1;
	} else {
		centers->synth_center =
			chan->channel - HT40_CHANNEL_CENTER_SHIFT;
		extoff = -1;
	}
248

S
Sujith 已提交
249 250 251 252
	centers->ctl_center =
		centers->synth_center - (extoff * HT40_CHANNEL_CENTER_SHIFT);
	centers->ext_center =
		centers->synth_center + (extoff *
253
			 ((ah->extprotspacing == ATH9K_HT_EXTPROTSPACING_20) ?
S
Sujith 已提交
254
			  HT40_CHANNEL_CENTER_SHIFT : 15));
255 256
}

S
Sujith 已提交
257 258 259 260
/******************/
/* Chip Revisions */
/******************/

261
static void ath9k_hw_read_revisions(struct ath_hw *ah)
262
{
S
Sujith 已提交
263
	u32 val;
264

S
Sujith 已提交
265
	val = REG_READ(ah, AR_SREV) & AR_SREV_ID;
266

S
Sujith 已提交
267 268
	if (val == 0xFF) {
		val = REG_READ(ah, AR_SREV);
269 270 271
		ah->hw_version.macVersion =
			(val & AR_SREV_VERSION2) >> AR_SREV_TYPE2_S;
		ah->hw_version.macRev = MS(val, AR_SREV_REVISION2);
272
		ah->is_pciexpress = (val & AR_SREV_TYPE2_HOST_MODE) ? 0 : 1;
S
Sujith 已提交
273 274
	} else {
		if (!AR_SREV_9100(ah))
275
			ah->hw_version.macVersion = MS(val, AR_SREV_VERSION);
276

277
		ah->hw_version.macRev = val & AR_SREV_REVISION;
278

279
		if (ah->hw_version.macVersion == AR_SREV_VERSION_5416_PCIE)
280
			ah->is_pciexpress = true;
S
Sujith 已提交
281
	}
282 283
}

284
static int ath9k_hw_get_radiorev(struct ath_hw *ah)
285
{
S
Sujith 已提交
286 287
	u32 val;
	int i;
288

S
Sujith 已提交
289
	REG_WRITE(ah, AR_PHY(0x36), 0x00007058);
290

S
Sujith 已提交
291 292 293 294
	for (i = 0; i < 8; i++)
		REG_WRITE(ah, AR_PHY(0x20), 0x00010000);
	val = (REG_READ(ah, AR_PHY(256)) >> 24) & 0xff;
	val = ((val & 0xf0) >> 4) | ((val & 0x0f) << 4);
295

S
Sujith 已提交
296
	return ath9k_hw_reverse_bits(val, 8);
297 298
}

S
Sujith 已提交
299 300 301 302
/************************************/
/* HW Attach, Detach, Init Routines */
/************************************/

303
static void ath9k_hw_disablepcie(struct ath_hw *ah)
304
{
305
	if (AR_SREV_9100(ah))
S
Sujith 已提交
306
		return;
307

S
Sujith 已提交
308 309 310 311 312 313 314 315 316
	REG_WRITE(ah, AR_PCIE_SERDES, 0x9248fc00);
	REG_WRITE(ah, AR_PCIE_SERDES, 0x24924924);
	REG_WRITE(ah, AR_PCIE_SERDES, 0x28000029);
	REG_WRITE(ah, AR_PCIE_SERDES, 0x57160824);
	REG_WRITE(ah, AR_PCIE_SERDES, 0x25980579);
	REG_WRITE(ah, AR_PCIE_SERDES, 0x00000000);
	REG_WRITE(ah, AR_PCIE_SERDES, 0x1aaabe40);
	REG_WRITE(ah, AR_PCIE_SERDES, 0xbe105554);
	REG_WRITE(ah, AR_PCIE_SERDES, 0x000e1007);
317

S
Sujith 已提交
318
	REG_WRITE(ah, AR_PCIE_SERDES2, 0x00000000);
319 320
}

321
static bool ath9k_hw_chip_test(struct ath_hw *ah)
322
{
S
Sujith 已提交
323 324 325 326 327 328 329
	u32 regAddr[2] = { AR_STA_ID0, AR_PHY_BASE + (8 << 2) };
	u32 regHold[2];
	u32 patternData[4] = { 0x55555555,
			       0xaaaaaaaa,
			       0x66666666,
			       0x99999999 };
	int i, j;
330

S
Sujith 已提交
331 332 333
	for (i = 0; i < 2; i++) {
		u32 addr = regAddr[i];
		u32 wrData, rdData;
334

S
Sujith 已提交
335 336 337 338 339 340
		regHold[i] = REG_READ(ah, addr);
		for (j = 0; j < 0x100; j++) {
			wrData = (j << 16) | j;
			REG_WRITE(ah, addr, wrData);
			rdData = REG_READ(ah, addr);
			if (rdData != wrData) {
S
Sujith 已提交
341
				DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
342
					"address test failed "
S
Sujith 已提交
343
					"addr: 0x%08x - wr:0x%08x != rd:0x%08x\n",
S
Sujith 已提交
344
					addr, wrData, rdData);
S
Sujith 已提交
345 346 347 348 349 350 351 352
				return false;
			}
		}
		for (j = 0; j < 4; j++) {
			wrData = patternData[j];
			REG_WRITE(ah, addr, wrData);
			rdData = REG_READ(ah, addr);
			if (wrData != rdData) {
S
Sujith 已提交
353
				DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
354
					"address test failed "
S
Sujith 已提交
355
					"addr: 0x%08x - wr:0x%08x != rd:0x%08x\n",
S
Sujith 已提交
356
					addr, wrData, rdData);
S
Sujith 已提交
357 358
				return false;
			}
359
		}
S
Sujith 已提交
360
		REG_WRITE(ah, regAddr[i], regHold[i]);
361
	}
S
Sujith 已提交
362
	udelay(100);
363

364 365 366
	return true;
}

S
Sujith 已提交
367
static const char *ath9k_hw_devname(u16 devid)
368
{
S
Sujith 已提交
369 370 371
	switch (devid) {
	case AR5416_DEVID_PCI:
		return "Atheros 5416";
372 373
	case AR5416_DEVID_PCIE:
		return "Atheros 5418";
S
Sujith 已提交
374 375
	case AR9160_DEVID_PCI:
		return "Atheros 9160";
G
Gabor Juhos 已提交
376 377
	case AR5416_AR9100_DEVID:
		return "Atheros 9100";
S
Sujith 已提交
378 379 380
	case AR9280_DEVID_PCI:
	case AR9280_DEVID_PCIE:
		return "Atheros 9280";
381 382
	case AR9285_DEVID_PCIE:
		return "Atheros 9285";
383 384
	}

S
Sujith 已提交
385 386
	return NULL;
}
387

388
static void ath9k_hw_set_defaults(struct ath_hw *ah)
S
Sujith 已提交
389 390
{
	int i;
391

392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408
	ah->config.dma_beacon_response_time = 2;
	ah->config.sw_beacon_response_time = 10;
	ah->config.additional_swba_backoff = 0;
	ah->config.ack_6mb = 0x0;
	ah->config.cwm_ignore_extcca = 0;
	ah->config.pcie_powersave_enable = 0;
	ah->config.pcie_clock_req = 0;
	ah->config.pcie_waen = 0;
	ah->config.analog_shiftreg = 1;
	ah->config.ht_enable = 1;
	ah->config.ofdm_trig_low = 200;
	ah->config.ofdm_trig_high = 500;
	ah->config.cck_trig_high = 200;
	ah->config.cck_trig_low = 100;
	ah->config.enable_ani = 1;
	ah->config.diversity_control = 0;
	ah->config.antenna_switch_swap = 0;
409

S
Sujith 已提交
410
	for (i = 0; i < AR_EEPROM_MODAL_SPURS; i++) {
411 412
		ah->config.spurchans[i][0] = AR_NO_SPUR;
		ah->config.spurchans[i][1] = AR_NO_SPUR;
413 414
	}

415
	ah->config.intr_mitigation = true;
416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433

	/*
	 * We need this for PCI devices only (Cardbus, PCI, miniPCI)
	 * _and_ if on non-uniprocessor systems (Multiprocessor/HT).
	 * This means we use it for all AR5416 devices, and the few
	 * minor PCI AR9280 devices out there.
	 *
	 * Serialization is required because these devices do not handle
	 * well the case of two concurrent reads/writes due to the latency
	 * involved. During one read/write another read/write can be issued
	 * on another CPU while the previous read/write may still be working
	 * on our hardware, if we hit this case the hardware poops in a loop.
	 * We prevent this by serializing reads and writes.
	 *
	 * This issue is not present on PCI-Express devices or pre-AR5416
	 * devices (legacy, 802.11abg).
	 */
	if (num_possible_cpus() > 1)
434
		ah->config.serialize_regmode = SER_REG_MODE_AUTO;
435 436
}

437 438
static struct ath_hw *ath9k_hw_newstate(u16 devid, struct ath_softc *sc,
					int *status)
439
{
440
	struct ath_hw *ah;
441

442 443
	ah = kzalloc(sizeof(struct ath_hw), GFP_KERNEL);
	if (ah == NULL) {
444
		DPRINTF(sc, ATH_DBG_FATAL,
S
Sujith 已提交
445
			"Cannot allocate memory for state block\n");
446 447 448 449 450
		*status = -ENOMEM;
		return NULL;
	}

	ah->ah_sc = sc;
451
	ah->hw_version.magic = AR5416_MAGIC;
452
	ah->regulatory.country_code = CTRY_DEFAULT;
453 454
	ah->hw_version.devid = devid;
	ah->hw_version.subvendorid = 0;
455 456 457

	ah->ah_flags = 0;
	if ((devid == AR5416_AR9100_DEVID))
458
		ah->hw_version.macVersion = AR_SREV_VERSION_9100;
459 460 461
	if (!AR_SREV_9100(ah))
		ah->ah_flags = AH_USE_EEPROM;

462 463
	ah->regulatory.power_limit = MAX_RATE_POWER;
	ah->regulatory.tp_scale = ATH9K_TP_SCALE_MAX;
464 465 466 467 468 469 470 471 472 473 474 475 476
	ah->atim_window = 0;
	ah->diversity_control = ah->config.diversity_control;
	ah->antenna_switch_swap =
		ah->config.antenna_switch_swap;
	ah->sta_id1_defaults = AR_STA_ID1_CRPT_MIC_ENABLE;
	ah->beacon_interval = 100;
	ah->enable_32kHz_clock = DONT_USE_32KHZ;
	ah->slottime = (u32) -1;
	ah->acktimeout = (u32) -1;
	ah->ctstimeout = (u32) -1;
	ah->globaltxtimeout = (u32) -1;

	ah->gbeacon_rate = 0;
477

478
	return ah;
479 480
}

481
static int ath9k_hw_rfattach(struct ath_hw *ah)
482
{
S
Sujith 已提交
483 484
	bool rfStatus = false;
	int ecode = 0;
485

S
Sujith 已提交
486 487
	rfStatus = ath9k_hw_init_rf(ah, &ecode);
	if (!rfStatus) {
S
Sujith 已提交
488 489
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"RF setup failed, status: %u\n", ecode);
S
Sujith 已提交
490 491
		return ecode;
	}
492

S
Sujith 已提交
493
	return 0;
494 495
}

496
static int ath9k_hw_rf_claim(struct ath_hw *ah)
497
{
S
Sujith 已提交
498 499 500 501 502 503 504 505 506 507 508 509 510 511
	u32 val;

	REG_WRITE(ah, AR_PHY(0), 0x00000007);

	val = ath9k_hw_get_radiorev(ah);
	switch (val & AR_RADIO_SREV_MAJOR) {
	case 0:
		val = AR_RAD5133_SREV_MAJOR;
		break;
	case AR_RAD5133_SREV_MAJOR:
	case AR_RAD5122_SREV_MAJOR:
	case AR_RAD2133_SREV_MAJOR:
	case AR_RAD2122_SREV_MAJOR:
		break;
512
	default:
S
Sujith 已提交
513 514 515
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"Radio Chip Rev 0x%02X not supported\n",
			val & AR_RADIO_SREV_MAJOR);
S
Sujith 已提交
516
		return -EOPNOTSUPP;
517 518
	}

519
	ah->hw_version.analog5GhzRev = val;
520

S
Sujith 已提交
521
	return 0;
522 523
}

524
static int ath9k_hw_init_macaddr(struct ath_hw *ah)
525 526 527 528 529 530 531
{
	u32 sum;
	int i;
	u16 eeval;

	sum = 0;
	for (i = 0; i < 3; i++) {
S
Sujith 已提交
532
		eeval = ah->eep_ops->get_eeprom(ah, AR_EEPROM_MAC(i));
533
		sum += eeval;
S
Sujith 已提交
534 535
		ah->macaddr[2 * i] = eeval >> 8;
		ah->macaddr[2 * i + 1] = eeval & 0xff;
536
	}
S
Sujith 已提交
537
	if (sum == 0 || sum == 0xffff * 3)
538 539 540 541 542
		return -EADDRNOTAVAIL;

	return 0;
}

543
static void ath9k_hw_init_rxgain_ini(struct ath_hw *ah)
544 545 546
{
	u32 rxgain_type;

S
Sujith 已提交
547 548
	if (ah->eep_ops->get_eeprom(ah, EEP_MINOR_REV) >= AR5416_EEP_MINOR_VER_17) {
		rxgain_type = ah->eep_ops->get_eeprom(ah, EEP_RXGAIN_TYPE);
549 550

		if (rxgain_type == AR5416_EEP_RXGAIN_13DB_BACKOFF)
551
			INIT_INI_ARRAY(&ah->iniModesRxGain,
552 553 554
			ar9280Modes_backoff_13db_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_backoff_13db_rxgain_9280_2), 6);
		else if (rxgain_type == AR5416_EEP_RXGAIN_23DB_BACKOFF)
555
			INIT_INI_ARRAY(&ah->iniModesRxGain,
556 557 558
			ar9280Modes_backoff_23db_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_backoff_23db_rxgain_9280_2), 6);
		else
559
			INIT_INI_ARRAY(&ah->iniModesRxGain,
560 561
			ar9280Modes_original_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_original_rxgain_9280_2), 6);
562
	} else {
563
		INIT_INI_ARRAY(&ah->iniModesRxGain,
564 565
			ar9280Modes_original_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_original_rxgain_9280_2), 6);
566
	}
567 568
}

569
static void ath9k_hw_init_txgain_ini(struct ath_hw *ah)
570 571 572
{
	u32 txgain_type;

S
Sujith 已提交
573 574
	if (ah->eep_ops->get_eeprom(ah, EEP_MINOR_REV) >= AR5416_EEP_MINOR_VER_19) {
		txgain_type = ah->eep_ops->get_eeprom(ah, EEP_TXGAIN_TYPE);
575 576

		if (txgain_type == AR5416_EEP_TXGAIN_HIGH_POWER)
577
			INIT_INI_ARRAY(&ah->iniModesTxGain,
578 579 580
			ar9280Modes_high_power_tx_gain_9280_2,
			ARRAY_SIZE(ar9280Modes_high_power_tx_gain_9280_2), 6);
		else
581
			INIT_INI_ARRAY(&ah->iniModesTxGain,
582 583
			ar9280Modes_original_tx_gain_9280_2,
			ARRAY_SIZE(ar9280Modes_original_tx_gain_9280_2), 6);
584
	} else {
585
		INIT_INI_ARRAY(&ah->iniModesTxGain,
586 587
		ar9280Modes_original_tx_gain_9280_2,
		ARRAY_SIZE(ar9280Modes_original_tx_gain_9280_2), 6);
588
	}
589 590
}

591
static int ath9k_hw_post_attach(struct ath_hw *ah)
592
{
S
Sujith 已提交
593
	int ecode;
594

S
Sujith 已提交
595
	if (!ath9k_hw_chip_test(ah))
S
Sujith 已提交
596
		return -ENODEV;
597

S
Sujith 已提交
598 599
	ecode = ath9k_hw_rf_claim(ah);
	if (ecode != 0)
600 601
		return ecode;

S
Sujith 已提交
602 603 604
	ecode = ath9k_hw_eeprom_attach(ah);
	if (ecode != 0)
		return ecode;
605 606 607 608

	DPRINTF(ah->ah_sc, ATH_DBG_CONFIG, "Eeprom VER: %d, REV: %d\n",
		ah->eep_ops->get_eeprom_ver(ah), ah->eep_ops->get_eeprom_rev(ah));

S
Sujith 已提交
609 610 611
	ecode = ath9k_hw_rfattach(ah);
	if (ecode != 0)
		return ecode;
612

S
Sujith 已提交
613 614 615
	if (!AR_SREV_9100(ah)) {
		ath9k_hw_ani_setup(ah);
		ath9k_hw_ani_attach(ah);
616 617 618 619 620
	}

	return 0;
}

621 622
static struct ath_hw *ath9k_hw_do_attach(u16 devid, struct ath_softc *sc,
					 int *status)
623
{
624
	struct ath_hw *ah;
S
Sujith 已提交
625
	int ecode;
626
	u32 i, j;
627

628 629
	ah = ath9k_hw_newstate(devid, sc, status);
	if (ah == NULL)
S
Sujith 已提交
630
		return NULL;
631

S
Sujith 已提交
632
	ath9k_hw_set_defaults(ah);
633

S
Sujith 已提交
634
	if (!ath9k_hw_set_reset_reg(ah, ATH9K_RESET_POWER_ON)) {
S
Sujith 已提交
635
		DPRINTF(sc, ATH_DBG_FATAL, "Couldn't reset chip\n");
S
Sujith 已提交
636 637 638
		ecode = -EIO;
		goto bad;
	}
639

S
Sujith 已提交
640
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE)) {
S
Sujith 已提交
641
		DPRINTF(sc, ATH_DBG_FATAL, "Couldn't wakeup chip\n");
S
Sujith 已提交
642 643 644
		ecode = -EIO;
		goto bad;
	}
645

646
	if (ah->config.serialize_regmode == SER_REG_MODE_AUTO) {
647 648
		if (ah->hw_version.macVersion == AR_SREV_VERSION_5416_PCI ||
		    (AR_SREV_9280(ah) && !ah->is_pciexpress)) {
649
			ah->config.serialize_regmode =
S
Sujith 已提交
650
				SER_REG_MODE_ON;
651
		} else {
652
			ah->config.serialize_regmode =
S
Sujith 已提交
653
				SER_REG_MODE_OFF;
654 655 656
		}
	}

657
	DPRINTF(sc, ATH_DBG_RESET, "serialize_regmode is %d\n",
658
		ah->config.serialize_regmode);
659

660 661 662
	if ((ah->hw_version.macVersion != AR_SREV_VERSION_5416_PCI) &&
	    (ah->hw_version.macVersion != AR_SREV_VERSION_5416_PCIE) &&
	    (ah->hw_version.macVersion != AR_SREV_VERSION_9160) &&
663
	    (!AR_SREV_9100(ah)) && (!AR_SREV_9280(ah)) && (!AR_SREV_9285(ah))) {
S
Sujith 已提交
664
		DPRINTF(sc, ATH_DBG_FATAL,
S
Sujith 已提交
665
			"Mac Chip Rev 0x%02x.%x is not supported by "
666 667
			"this driver\n", ah->hw_version.macVersion,
			ah->hw_version.macRev);
S
Sujith 已提交
668 669 670
		ecode = -EOPNOTSUPP;
		goto bad;
	}
671

S
Sujith 已提交
672
	if (AR_SREV_9100(ah)) {
673 674 675
		ah->iq_caldata.calData = &iq_cal_multi_sample;
		ah->supp_cals = IQ_MISMATCH_CAL;
		ah->is_pciexpress = false;
S
Sujith 已提交
676
	}
677
	ah->hw_version.phyRev = REG_READ(ah, AR_PHY_CHIP_ID);
678

S
Sujith 已提交
679 680
	if (AR_SREV_9160_10_OR_LATER(ah)) {
		if (AR_SREV_9280_10_OR_LATER(ah)) {
681 682
			ah->iq_caldata.calData = &iq_cal_single_sample;
			ah->adcgain_caldata.calData =
S
Sujith 已提交
683
				&adc_gain_cal_single_sample;
684
			ah->adcdc_caldata.calData =
S
Sujith 已提交
685
				&adc_dc_cal_single_sample;
686
			ah->adcdc_calinitdata.calData =
S
Sujith 已提交
687 688
				&adc_init_dc_cal;
		} else {
689 690
			ah->iq_caldata.calData = &iq_cal_multi_sample;
			ah->adcgain_caldata.calData =
S
Sujith 已提交
691
				&adc_gain_cal_multi_sample;
692
			ah->adcdc_caldata.calData =
S
Sujith 已提交
693
				&adc_dc_cal_multi_sample;
694
			ah->adcdc_calinitdata.calData =
S
Sujith 已提交
695 696
				&adc_init_dc_cal;
		}
697
		ah->supp_cals = ADC_GAIN_CAL | ADC_DC_CAL | IQ_MISMATCH_CAL;
S
Sujith 已提交
698
	}
699

S
Sujith 已提交
700 701 702
	ah->ani_function = ATH9K_ANI_ALL;
	if (AR_SREV_9280_10_OR_LATER(ah))
		ah->ani_function &= ~ATH9K_ANI_NOISE_IMMUNITY_LEVEL;
703

704
	if (AR_SREV_9285_12_OR_LATER(ah)) {
705

706
		INIT_INI_ARRAY(&ah->iniModes, ar9285Modes_9285_1_2,
707
			       ARRAY_SIZE(ar9285Modes_9285_1_2), 6);
708
		INIT_INI_ARRAY(&ah->iniCommon, ar9285Common_9285_1_2,
709 710
			       ARRAY_SIZE(ar9285Common_9285_1_2), 2);

711 712
		if (ah->config.pcie_clock_req) {
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
713 714 715
			ar9285PciePhy_clkreq_off_L1_9285_1_2,
			ARRAY_SIZE(ar9285PciePhy_clkreq_off_L1_9285_1_2), 2);
		} else {
716
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
717 718 719 720 721
			ar9285PciePhy_clkreq_always_on_L1_9285_1_2,
			ARRAY_SIZE(ar9285PciePhy_clkreq_always_on_L1_9285_1_2),
				  2);
		}
	} else if (AR_SREV_9285_10_OR_LATER(ah)) {
722
		INIT_INI_ARRAY(&ah->iniModes, ar9285Modes_9285,
723
			       ARRAY_SIZE(ar9285Modes_9285), 6);
724
		INIT_INI_ARRAY(&ah->iniCommon, ar9285Common_9285,
725 726
			       ARRAY_SIZE(ar9285Common_9285), 2);

727 728
		if (ah->config.pcie_clock_req) {
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
729 730 731
			ar9285PciePhy_clkreq_off_L1_9285,
			ARRAY_SIZE(ar9285PciePhy_clkreq_off_L1_9285), 2);
		} else {
732
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
733 734 735 736
			ar9285PciePhy_clkreq_always_on_L1_9285,
			ARRAY_SIZE(ar9285PciePhy_clkreq_always_on_L1_9285), 2);
		}
	} else if (AR_SREV_9280_20_OR_LATER(ah)) {
737
		INIT_INI_ARRAY(&ah->iniModes, ar9280Modes_9280_2,
S
Sujith 已提交
738
			       ARRAY_SIZE(ar9280Modes_9280_2), 6);
739
		INIT_INI_ARRAY(&ah->iniCommon, ar9280Common_9280_2,
S
Sujith 已提交
740
			       ARRAY_SIZE(ar9280Common_9280_2), 2);
741

742 743
		if (ah->config.pcie_clock_req) {
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
S
Sujith 已提交
744 745 746
			       ar9280PciePhy_clkreq_off_L1_9280,
			       ARRAY_SIZE(ar9280PciePhy_clkreq_off_L1_9280),2);
		} else {
747
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
S
Sujith 已提交
748 749 750
			       ar9280PciePhy_clkreq_always_on_L1_9280,
			       ARRAY_SIZE(ar9280PciePhy_clkreq_always_on_L1_9280), 2);
		}
751
		INIT_INI_ARRAY(&ah->iniModesAdditional,
S
Sujith 已提交
752 753 754
			       ar9280Modes_fast_clock_9280_2,
			       ARRAY_SIZE(ar9280Modes_fast_clock_9280_2), 3);
	} else if (AR_SREV_9280_10_OR_LATER(ah)) {
755
		INIT_INI_ARRAY(&ah->iniModes, ar9280Modes_9280,
S
Sujith 已提交
756
			       ARRAY_SIZE(ar9280Modes_9280), 6);
757
		INIT_INI_ARRAY(&ah->iniCommon, ar9280Common_9280,
S
Sujith 已提交
758 759
			       ARRAY_SIZE(ar9280Common_9280), 2);
	} else if (AR_SREV_9160_10_OR_LATER(ah)) {
760
		INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9160,
S
Sujith 已提交
761
			       ARRAY_SIZE(ar5416Modes_9160), 6);
762
		INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9160,
S
Sujith 已提交
763
			       ARRAY_SIZE(ar5416Common_9160), 2);
764
		INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0_9160,
S
Sujith 已提交
765
			       ARRAY_SIZE(ar5416Bank0_9160), 2);
766
		INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain_9160,
S
Sujith 已提交
767
			       ARRAY_SIZE(ar5416BB_RfGain_9160), 3);
768
		INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1_9160,
S
Sujith 已提交
769
			       ARRAY_SIZE(ar5416Bank1_9160), 2);
770
		INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2_9160,
S
Sujith 已提交
771
			       ARRAY_SIZE(ar5416Bank2_9160), 2);
772
		INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3_9160,
S
Sujith 已提交
773
			       ARRAY_SIZE(ar5416Bank3_9160), 3);
774
		INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6_9160,
S
Sujith 已提交
775
			       ARRAY_SIZE(ar5416Bank6_9160), 3);
776
		INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC_9160,
S
Sujith 已提交
777
			       ARRAY_SIZE(ar5416Bank6TPC_9160), 3);
778
		INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7_9160,
S
Sujith 已提交
779 780
			       ARRAY_SIZE(ar5416Bank7_9160), 2);
		if (AR_SREV_9160_11(ah)) {
781
			INIT_INI_ARRAY(&ah->iniAddac,
S
Sujith 已提交
782 783 784
				       ar5416Addac_91601_1,
				       ARRAY_SIZE(ar5416Addac_91601_1), 2);
		} else {
785
			INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9160,
S
Sujith 已提交
786 787 788
				       ARRAY_SIZE(ar5416Addac_9160), 2);
		}
	} else if (AR_SREV_9100_OR_LATER(ah)) {
789
		INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9100,
S
Sujith 已提交
790
			       ARRAY_SIZE(ar5416Modes_9100), 6);
791
		INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9100,
S
Sujith 已提交
792
			       ARRAY_SIZE(ar5416Common_9100), 2);
793
		INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0_9100,
S
Sujith 已提交
794
			       ARRAY_SIZE(ar5416Bank0_9100), 2);
795
		INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain_9100,
S
Sujith 已提交
796
			       ARRAY_SIZE(ar5416BB_RfGain_9100), 3);
797
		INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1_9100,
S
Sujith 已提交
798
			       ARRAY_SIZE(ar5416Bank1_9100), 2);
799
		INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2_9100,
S
Sujith 已提交
800
			       ARRAY_SIZE(ar5416Bank2_9100), 2);
801
		INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3_9100,
S
Sujith 已提交
802
			       ARRAY_SIZE(ar5416Bank3_9100), 3);
803
		INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6_9100,
S
Sujith 已提交
804
			       ARRAY_SIZE(ar5416Bank6_9100), 3);
805
		INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC_9100,
S
Sujith 已提交
806
			       ARRAY_SIZE(ar5416Bank6TPC_9100), 3);
807
		INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7_9100,
S
Sujith 已提交
808
			       ARRAY_SIZE(ar5416Bank7_9100), 2);
809
		INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9100,
S
Sujith 已提交
810 811
			       ARRAY_SIZE(ar5416Addac_9100), 2);
	} else {
812
		INIT_INI_ARRAY(&ah->iniModes, ar5416Modes,
S
Sujith 已提交
813
			       ARRAY_SIZE(ar5416Modes), 6);
814
		INIT_INI_ARRAY(&ah->iniCommon, ar5416Common,
S
Sujith 已提交
815
			       ARRAY_SIZE(ar5416Common), 2);
816
		INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0,
S
Sujith 已提交
817
			       ARRAY_SIZE(ar5416Bank0), 2);
818
		INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain,
S
Sujith 已提交
819
			       ARRAY_SIZE(ar5416BB_RfGain), 3);
820
		INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1,
S
Sujith 已提交
821
			       ARRAY_SIZE(ar5416Bank1), 2);
822
		INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2,
S
Sujith 已提交
823
			       ARRAY_SIZE(ar5416Bank2), 2);
824
		INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3,
S
Sujith 已提交
825
			       ARRAY_SIZE(ar5416Bank3), 3);
826
		INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6,
S
Sujith 已提交
827
			       ARRAY_SIZE(ar5416Bank6), 3);
828
		INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC,
S
Sujith 已提交
829
			       ARRAY_SIZE(ar5416Bank6TPC), 3);
830
		INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7,
S
Sujith 已提交
831
			       ARRAY_SIZE(ar5416Bank7), 2);
832
		INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac,
S
Sujith 已提交
833
			       ARRAY_SIZE(ar5416Addac), 2);
834 835
	}

836
	if (ah->is_pciexpress)
S
Sujith 已提交
837 838 839
		ath9k_hw_configpcipowersave(ah, 0);
	else
		ath9k_hw_disablepcie(ah);
840

S
Sujith 已提交
841 842 843
	ecode = ath9k_hw_post_attach(ah);
	if (ecode != 0)
		goto bad;
844

845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860
	if (AR_SREV_9285_12_OR_LATER(ah)) {
		u32 txgain_type = ah->eep_ops->get_eeprom(ah, EEP_TXGAIN_TYPE);

		/* txgain table */
		if (txgain_type == AR5416_EEP_TXGAIN_HIGH_POWER) {
			INIT_INI_ARRAY(&ah->iniModesTxGain,
			ar9285Modes_high_power_tx_gain_9285_1_2,
			ARRAY_SIZE(ar9285Modes_high_power_tx_gain_9285_1_2), 6);
		} else {
			INIT_INI_ARRAY(&ah->iniModesTxGain,
			ar9285Modes_original_tx_gain_9285_1_2,
			ARRAY_SIZE(ar9285Modes_original_tx_gain_9285_1_2), 6);
		}

	}

861
	/* rxgain table */
862
	if (AR_SREV_9280_20(ah))
863 864 865
		ath9k_hw_init_rxgain_ini(ah);

	/* txgain table */
866
	if (AR_SREV_9280_20(ah))
867 868
		ath9k_hw_init_txgain_ini(ah);

869
	ath9k_hw_fill_cap_info(ah);
S
Sujith 已提交
870 871 872 873 874

	if ((ah->hw_version.devid == AR9280_DEVID_PCI) &&
	    test_bit(ATH9K_MODE_11A, ah->caps.wireless_modes)) {

		/* EEPROM Fixup */
875 876
		for (i = 0; i < ah->iniModes.ia_rows; i++) {
			u32 reg = INI_RA(&ah->iniModes, i, 0);
877

878 879
			for (j = 1; j < ah->iniModes.ia_columns; j++) {
				u32 val = INI_RA(&ah->iniModes, i, j);
880

881
				INI_RA(&ah->iniModes, i, j) =
882
					ath9k_hw_ini_fixup(ah,
883
							   &ah->eeprom.def,
S
Sujith 已提交
884 885
							   reg, val);
			}
886
		}
S
Sujith 已提交
887
	}
888

S
Sujith 已提交
889 890
	ecode = ath9k_hw_init_macaddr(ah);
	if (ecode != 0) {
S
Sujith 已提交
891 892
		DPRINTF(sc, ATH_DBG_FATAL,
			"Failed to initialize MAC address\n");
S
Sujith 已提交
893
		goto bad;
894 895
	}

S
Sujith 已提交
896
	if (AR_SREV_9285(ah))
897
		ah->tx_trig_level = (AR_FTRIG_256B >> AR_FTRIG_S);
S
Sujith 已提交
898
	else
899
		ah->tx_trig_level = (AR_FTRIG_512B >> AR_FTRIG_S);
900

S
Sujith 已提交
901
	ath9k_init_nfcal_hist_buffer(ah);
902

S
Sujith 已提交
903 904
	return ah;
bad:
905 906
	if (ah)
		ath9k_hw_detach(ah);
S
Sujith 已提交
907 908
	if (status)
		*status = ecode;
909

S
Sujith 已提交
910
	return NULL;
911 912
}

913
static void ath9k_hw_init_bb(struct ath_hw *ah,
S
Sujith 已提交
914
			     struct ath9k_channel *chan)
915
{
S
Sujith 已提交
916
	u32 synthDelay;
917

S
Sujith 已提交
918
	synthDelay = REG_READ(ah, AR_PHY_RX_DELAY) & AR_PHY_RX_DELAY_DELAY;
919
	if (IS_CHAN_B(chan))
S
Sujith 已提交
920 921 922
		synthDelay = (4 * synthDelay) / 22;
	else
		synthDelay /= 10;
923

S
Sujith 已提交
924
	REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
925

S
Sujith 已提交
926
	udelay(synthDelay + BASE_ACTIVATE_DELAY);
927 928
}

929
static void ath9k_hw_init_qos(struct ath_hw *ah)
930
{
S
Sujith 已提交
931 932
	REG_WRITE(ah, AR_MIC_QOS_CONTROL, 0x100aa);
	REG_WRITE(ah, AR_MIC_QOS_SELECT, 0x3210);
933

S
Sujith 已提交
934 935 936 937 938 939 940 941 942 943
	REG_WRITE(ah, AR_QOS_NO_ACK,
		  SM(2, AR_QOS_NO_ACK_TWO_BIT) |
		  SM(5, AR_QOS_NO_ACK_BIT_OFF) |
		  SM(0, AR_QOS_NO_ACK_BYTE_OFF));

	REG_WRITE(ah, AR_TXOP_X, AR_TXOP_X_VAL);
	REG_WRITE(ah, AR_TXOP_0_3, 0xFFFFFFFF);
	REG_WRITE(ah, AR_TXOP_4_7, 0xFFFFFFFF);
	REG_WRITE(ah, AR_TXOP_8_11, 0xFFFFFFFF);
	REG_WRITE(ah, AR_TXOP_12_15, 0xFFFFFFFF);
944 945
}

946
static void ath9k_hw_init_pll(struct ath_hw *ah,
S
Sujith 已提交
947
			      struct ath9k_channel *chan)
948
{
S
Sujith 已提交
949
	u32 pll;
950

S
Sujith 已提交
951 952 953
	if (AR_SREV_9100(ah)) {
		if (chan && IS_CHAN_5GHZ(chan))
			pll = 0x1450;
954
		else
S
Sujith 已提交
955 956 957 958
			pll = 0x1458;
	} else {
		if (AR_SREV_9280_10_OR_LATER(ah)) {
			pll = SM(0x5, AR_RTC_9160_PLL_REFDIV);
959

S
Sujith 已提交
960 961 962 963
			if (chan && IS_CHAN_HALF_RATE(chan))
				pll |= SM(0x1, AR_RTC_9160_PLL_CLKSEL);
			else if (chan && IS_CHAN_QUARTER_RATE(chan))
				pll |= SM(0x2, AR_RTC_9160_PLL_CLKSEL);
964

S
Sujith 已提交
965 966
			if (chan && IS_CHAN_5GHZ(chan)) {
				pll |= SM(0x28, AR_RTC_9160_PLL_DIV);
967 968


S
Sujith 已提交
969 970 971 972 973 974 975 976 977 978
				if (AR_SREV_9280_20(ah)) {
					if (((chan->channel % 20) == 0)
					    || ((chan->channel % 10) == 0))
						pll = 0x2850;
					else
						pll = 0x142c;
				}
			} else {
				pll |= SM(0x2c, AR_RTC_9160_PLL_DIV);
			}
979

S
Sujith 已提交
980
		} else if (AR_SREV_9160_10_OR_LATER(ah)) {
981

S
Sujith 已提交
982
			pll = SM(0x5, AR_RTC_9160_PLL_REFDIV);
983

S
Sujith 已提交
984 985 986 987
			if (chan && IS_CHAN_HALF_RATE(chan))
				pll |= SM(0x1, AR_RTC_9160_PLL_CLKSEL);
			else if (chan && IS_CHAN_QUARTER_RATE(chan))
				pll |= SM(0x2, AR_RTC_9160_PLL_CLKSEL);
988

S
Sujith 已提交
989 990 991 992 993 994
			if (chan && IS_CHAN_5GHZ(chan))
				pll |= SM(0x50, AR_RTC_9160_PLL_DIV);
			else
				pll |= SM(0x58, AR_RTC_9160_PLL_DIV);
		} else {
			pll = AR_RTC_PLL_REFDIV_5 | AR_RTC_PLL_DIV2;
995

S
Sujith 已提交
996 997 998 999
			if (chan && IS_CHAN_HALF_RATE(chan))
				pll |= SM(0x1, AR_RTC_PLL_CLKSEL);
			else if (chan && IS_CHAN_QUARTER_RATE(chan))
				pll |= SM(0x2, AR_RTC_PLL_CLKSEL);
1000

S
Sujith 已提交
1001 1002 1003 1004 1005 1006
			if (chan && IS_CHAN_5GHZ(chan))
				pll |= SM(0xa, AR_RTC_PLL_DIV);
			else
				pll |= SM(0xb, AR_RTC_PLL_DIV);
		}
	}
1007
	REG_WRITE(ah, AR_RTC_PLL_CONTROL, pll);
1008

S
Sujith 已提交
1009 1010 1011
	udelay(RTC_PLL_SETTLE_DELAY);

	REG_WRITE(ah, AR_RTC_SLEEP_CLK, AR_RTC_FORCE_DERIVED_CLK);
1012 1013
}

1014
static void ath9k_hw_init_chain_masks(struct ath_hw *ah)
1015 1016 1017
{
	int rx_chainmask, tx_chainmask;

1018 1019
	rx_chainmask = ah->rxchainmask;
	tx_chainmask = ah->txchainmask;
1020 1021 1022 1023 1024 1025

	switch (rx_chainmask) {
	case 0x5:
		REG_SET_BIT(ah, AR_PHY_ANALOG_SWAP,
			    AR_PHY_SWAP_ALT_CHAIN);
	case 0x3:
1026
		if (((ah)->hw_version.macVersion <= AR_SREV_VERSION_9160)) {
1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050
			REG_WRITE(ah, AR_PHY_RX_CHAINMASK, 0x7);
			REG_WRITE(ah, AR_PHY_CAL_CHAINMASK, 0x7);
			break;
		}
	case 0x1:
	case 0x2:
	case 0x7:
		REG_WRITE(ah, AR_PHY_RX_CHAINMASK, rx_chainmask);
		REG_WRITE(ah, AR_PHY_CAL_CHAINMASK, rx_chainmask);
		break;
	default:
		break;
	}

	REG_WRITE(ah, AR_SELFGEN_MASK, tx_chainmask);
	if (tx_chainmask == 0x5) {
		REG_SET_BIT(ah, AR_PHY_ANALOG_SWAP,
			    AR_PHY_SWAP_ALT_CHAIN);
	}
	if (AR_SREV_9100(ah))
		REG_WRITE(ah, AR_PHY_ANALOG_SWAP,
			  REG_READ(ah, AR_PHY_ANALOG_SWAP) | 0x00000001);
}

1051
static void ath9k_hw_init_interrupt_masks(struct ath_hw *ah,
1052
					  enum nl80211_iftype opmode)
1053
{
1054
	ah->mask_reg = AR_IMR_TXERR |
S
Sujith 已提交
1055 1056 1057 1058
		AR_IMR_TXURN |
		AR_IMR_RXERR |
		AR_IMR_RXORN |
		AR_IMR_BCNMISC;
1059

1060
	if (ah->config.intr_mitigation)
1061
		ah->mask_reg |= AR_IMR_RXINTM | AR_IMR_RXMINTR;
1062
	else
1063
		ah->mask_reg |= AR_IMR_RXOK;
1064

1065
	ah->mask_reg |= AR_IMR_TXOK;
1066

1067
	if (opmode == NL80211_IFTYPE_AP)
1068
		ah->mask_reg |= AR_IMR_MIB;
1069

1070
	REG_WRITE(ah, AR_IMR, ah->mask_reg);
S
Sujith 已提交
1071
	REG_WRITE(ah, AR_IMR_S2, REG_READ(ah, AR_IMR_S2) | AR_IMR_S2_GTT);
1072

S
Sujith 已提交
1073 1074 1075 1076 1077
	if (!AR_SREV_9100(ah)) {
		REG_WRITE(ah, AR_INTR_SYNC_CAUSE, 0xFFFFFFFF);
		REG_WRITE(ah, AR_INTR_SYNC_ENABLE, AR_INTR_SYNC_DEFAULT);
		REG_WRITE(ah, AR_INTR_SYNC_MASK, 0);
	}
1078 1079
}

1080
static bool ath9k_hw_set_ack_timeout(struct ath_hw *ah, u32 us)
1081 1082
{
	if (us > ath9k_hw_mac_to_usec(ah, MS(0xffffffff, AR_TIME_OUT_ACK))) {
S
Sujith 已提交
1083
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "bad ack timeout %u\n", us);
1084
		ah->acktimeout = (u32) -1;
1085 1086 1087 1088
		return false;
	} else {
		REG_RMW_FIELD(ah, AR_TIME_OUT,
			      AR_TIME_OUT_ACK, ath9k_hw_mac_to_clks(ah, us));
1089
		ah->acktimeout = us;
1090 1091 1092 1093
		return true;
	}
}

1094
static bool ath9k_hw_set_cts_timeout(struct ath_hw *ah, u32 us)
1095 1096
{
	if (us > ath9k_hw_mac_to_usec(ah, MS(0xffffffff, AR_TIME_OUT_CTS))) {
S
Sujith 已提交
1097
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "bad cts timeout %u\n", us);
1098
		ah->ctstimeout = (u32) -1;
1099 1100 1101 1102
		return false;
	} else {
		REG_RMW_FIELD(ah, AR_TIME_OUT,
			      AR_TIME_OUT_CTS, ath9k_hw_mac_to_clks(ah, us));
1103
		ah->ctstimeout = us;
1104 1105 1106
		return true;
	}
}
S
Sujith 已提交
1107

1108
static bool ath9k_hw_set_global_txtimeout(struct ath_hw *ah, u32 tu)
1109 1110 1111
{
	if (tu > 0xFFFF) {
		DPRINTF(ah->ah_sc, ATH_DBG_XMIT,
S
Sujith 已提交
1112
			"bad global tx timeout %u\n", tu);
1113
		ah->globaltxtimeout = (u32) -1;
1114 1115 1116
		return false;
	} else {
		REG_RMW_FIELD(ah, AR_GTXTO, AR_GTXTO_TIMEOUT_LIMIT, tu);
1117
		ah->globaltxtimeout = tu;
1118 1119 1120 1121
		return true;
	}
}

1122
static void ath9k_hw_init_user_settings(struct ath_hw *ah)
1123
{
1124 1125
	DPRINTF(ah->ah_sc, ATH_DBG_RESET, "ah->misc_mode 0x%x\n",
		ah->misc_mode);
1126

1127
	if (ah->misc_mode != 0)
S
Sujith 已提交
1128
		REG_WRITE(ah, AR_PCU_MISC,
1129 1130 1131 1132 1133 1134 1135 1136 1137
			  REG_READ(ah, AR_PCU_MISC) | ah->misc_mode);
	if (ah->slottime != (u32) -1)
		ath9k_hw_setslottime(ah, ah->slottime);
	if (ah->acktimeout != (u32) -1)
		ath9k_hw_set_ack_timeout(ah, ah->acktimeout);
	if (ah->ctstimeout != (u32) -1)
		ath9k_hw_set_cts_timeout(ah, ah->ctstimeout);
	if (ah->globaltxtimeout != (u32) -1)
		ath9k_hw_set_global_txtimeout(ah, ah->globaltxtimeout);
S
Sujith 已提交
1138 1139 1140 1141 1142 1143 1144 1145
}

const char *ath9k_hw_probe(u16 vendorid, u16 devid)
{
	return vendorid == ATHEROS_VENDOR_ID ?
		ath9k_hw_devname(devid) : NULL;
}

1146
void ath9k_hw_detach(struct ath_hw *ah)
S
Sujith 已提交
1147 1148 1149 1150 1151 1152 1153 1154 1155
{
	if (!AR_SREV_9100(ah))
		ath9k_hw_ani_detach(ah);

	ath9k_hw_rfdetach(ah);
	ath9k_hw_setpower(ah, ATH9K_PM_FULL_SLEEP);
	kfree(ah);
}

1156
struct ath_hw *ath9k_hw_attach(u16 devid, struct ath_softc *sc, int *error)
S
Sujith 已提交
1157
{
1158
	struct ath_hw *ah = NULL;
S
Sujith 已提交
1159 1160 1161 1162

	switch (devid) {
	case AR5416_DEVID_PCI:
	case AR5416_DEVID_PCIE:
G
Gabor Juhos 已提交
1163
	case AR5416_AR9100_DEVID:
S
Sujith 已提交
1164 1165 1166
	case AR9160_DEVID_PCI:
	case AR9280_DEVID_PCI:
	case AR9280_DEVID_PCIE:
1167
	case AR9285_DEVID_PCIE:
1168
		ah = ath9k_hw_do_attach(devid, sc, error);
S
Sujith 已提交
1169 1170 1171 1172
		break;
	default:
		*error = -ENXIO;
		break;
1173
	}
S
Sujith 已提交
1174 1175 1176 1177 1178 1179 1180 1181

	return ah;
}

/*******/
/* INI */
/*******/

1182
static void ath9k_hw_override_ini(struct ath_hw *ah,
S
Sujith 已提交
1183 1184
				  struct ath9k_channel *chan)
{
1185 1186 1187 1188 1189 1190 1191 1192
	/*
	 * Set the RX_ABORT and RX_DIS and clear if off only after
	 * RXE is set for MAC. This prevents frames with corrupted
	 * descriptor status.
	 */
	REG_SET_BIT(ah, AR_DIAG_SW, (AR_DIAG_RX_DIS | AR_DIAG_RX_ABORT));


1193
	if (!AR_SREV_5416_20_OR_LATER(ah) ||
S
Sujith 已提交
1194 1195 1196 1197
	    AR_SREV_9280_10_OR_LATER(ah))
		return;

	REG_WRITE(ah, 0x9800 + (651 << 2), 0x11);
1198 1199
}

1200
static u32 ath9k_hw_def_ini_fixup(struct ath_hw *ah,
1201
			      struct ar5416_eeprom_def *pEepData,
S
Sujith 已提交
1202
			      u32 reg, u32 value)
1203
{
S
Sujith 已提交
1204
	struct base_eep_header *pBase = &(pEepData->baseEepHeader);
1205

1206
	switch (ah->hw_version.devid) {
S
Sujith 已提交
1207 1208
	case AR9280_DEVID_PCI:
		if (reg == 0x7894) {
S
Sujith 已提交
1209
			DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1210 1211 1212 1213
				"ini VAL: %x  EEPROM: %x\n", value,
				(pBase->version & 0xff));

			if ((pBase->version & 0xff) > 0x0a) {
S
Sujith 已提交
1214
				DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1215 1216 1217 1218 1219 1220
					"PWDCLKIND: %d\n",
					pBase->pwdclkind);
				value &= ~AR_AN_TOP2_PWDCLKIND;
				value |= AR_AN_TOP2_PWDCLKIND &
					(pBase->pwdclkind << AR_AN_TOP2_PWDCLKIND_S);
			} else {
S
Sujith 已提交
1221
				DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1222 1223 1224
					"PWDCLKIND Earlier Rev\n");
			}

S
Sujith 已提交
1225
			DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1226 1227 1228 1229 1230 1231
				"final ini VAL: %x\n", value);
		}
		break;
	}

	return value;
1232 1233
}

1234
static u32 ath9k_hw_ini_fixup(struct ath_hw *ah,
1235 1236 1237
			      struct ar5416_eeprom_def *pEepData,
			      u32 reg, u32 value)
{
1238
	if (ah->eep_map == EEP_MAP_4KBITS)
1239 1240 1241 1242 1243
		return value;
	else
		return ath9k_hw_def_ini_fixup(ah, pEepData, reg, value);
}

1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254
static void ath9k_olc_init(struct ath_hw *ah)
{
	u32 i;

	for (i = 0; i < AR9280_TX_GAIN_TABLE_SIZE; i++)
		ah->originalGain[i] =
			MS(REG_READ(ah, AR_PHY_TX_GAIN_TBL1 + i * 4),
					AR_PHY_TX_GAIN);
	ah->PDADCdelta = 0;
}

1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269
static u32 ath9k_regd_get_ctl(struct ath_regulatory *reg,
			      struct ath9k_channel *chan)
{
	u32 ctl = ath_regd_get_band_ctl(reg, chan->chan->band);

	if (IS_CHAN_B(chan))
		ctl |= CTL_11B;
	else if (IS_CHAN_G(chan))
		ctl |= CTL_11G;
	else
		ctl |= CTL_11A;

	return ctl;
}

1270
static int ath9k_hw_process_ini(struct ath_hw *ah,
S
Sujith 已提交
1271 1272
				struct ath9k_channel *chan,
				enum ath9k_ht_macmode macmode)
1273 1274
{
	int i, regWrites = 0;
1275
	struct ieee80211_channel *channel = chan->chan;
1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306
	u32 modesIndex, freqIndex;

	switch (chan->chanmode) {
	case CHANNEL_A:
	case CHANNEL_A_HT20:
		modesIndex = 1;
		freqIndex = 1;
		break;
	case CHANNEL_A_HT40PLUS:
	case CHANNEL_A_HT40MINUS:
		modesIndex = 2;
		freqIndex = 1;
		break;
	case CHANNEL_G:
	case CHANNEL_G_HT20:
	case CHANNEL_B:
		modesIndex = 4;
		freqIndex = 2;
		break;
	case CHANNEL_G_HT40PLUS:
	case CHANNEL_G_HT40MINUS:
		modesIndex = 3;
		freqIndex = 2;
		break;

	default:
		return -EINVAL;
	}

	REG_WRITE(ah, AR_PHY(0), 0x00000007);
	REG_WRITE(ah, AR_PHY_ADC_SERIAL_CTL, AR_PHY_SEL_EXTERNAL_RADIO);
S
Sujith 已提交
1307
	ah->eep_ops->set_addac(ah, chan);
1308

1309
	if (AR_SREV_5416_22_OR_LATER(ah)) {
1310
		REG_WRITE_ARRAY(&ah->iniAddac, 1, regWrites);
1311 1312 1313
	} else {
		struct ar5416IniArray temp;
		u32 addacSize =
1314 1315
			sizeof(u32) * ah->iniAddac.ia_rows *
			ah->iniAddac.ia_columns;
1316

1317 1318
		memcpy(ah->addac5416_21,
		       ah->iniAddac.ia_array, addacSize);
1319

1320
		(ah->addac5416_21)[31 * ah->iniAddac.ia_columns + 1] = 0;
1321

1322 1323 1324
		temp.ia_array = ah->addac5416_21;
		temp.ia_columns = ah->iniAddac.ia_columns;
		temp.ia_rows = ah->iniAddac.ia_rows;
1325 1326
		REG_WRITE_ARRAY(&temp, 1, regWrites);
	}
S
Sujith 已提交
1327

1328 1329
	REG_WRITE(ah, AR_PHY_ADC_SERIAL_CTL, AR_PHY_SEL_INTERNAL_ADDAC);

1330 1331 1332
	for (i = 0; i < ah->iniModes.ia_rows; i++) {
		u32 reg = INI_RA(&ah->iniModes, i, 0);
		u32 val = INI_RA(&ah->iniModes, i, modesIndex);
1333 1334 1335 1336

		REG_WRITE(ah, reg, val);

		if (reg >= 0x7800 && reg < 0x78a0
1337
		    && ah->config.analog_shiftreg) {
1338 1339 1340 1341 1342 1343
			udelay(100);
		}

		DO_DELAY(regWrites);
	}

1344
	if (AR_SREV_9280(ah))
1345
		REG_WRITE_ARRAY(&ah->iniModesRxGain, modesIndex, regWrites);
1346

1347
	if (AR_SREV_9280(ah) || AR_SREV_9285_12_OR_LATER(ah))
1348
		REG_WRITE_ARRAY(&ah->iniModesTxGain, modesIndex, regWrites);
1349

1350 1351 1352
	for (i = 0; i < ah->iniCommon.ia_rows; i++) {
		u32 reg = INI_RA(&ah->iniCommon, i, 0);
		u32 val = INI_RA(&ah->iniCommon, i, 1);
1353 1354 1355 1356

		REG_WRITE(ah, reg, val);

		if (reg >= 0x7800 && reg < 0x78a0
1357
		    && ah->config.analog_shiftreg) {
1358 1359 1360 1361 1362 1363 1364 1365 1366
			udelay(100);
		}

		DO_DELAY(regWrites);
	}

	ath9k_hw_write_regs(ah, modesIndex, freqIndex, regWrites);

	if (AR_SREV_9280_20(ah) && IS_CHAN_A_5MHZ_SPACED(chan)) {
1367
		REG_WRITE_ARRAY(&ah->iniModesAdditional, modesIndex,
1368 1369 1370 1371 1372 1373 1374
				regWrites);
	}

	ath9k_hw_override_ini(ah, chan);
	ath9k_hw_set_regs(ah, chan, macmode);
	ath9k_hw_init_chain_masks(ah);

1375 1376 1377
	if (OLC_FOR_AR9280_20_LATER)
		ath9k_olc_init(ah);

1378 1379 1380 1381 1382 1383
	ah->eep_ops->set_txpower(ah, chan,
				 ath9k_regd_get_ctl(&ah->regulatory, chan),
				 channel->max_antenna_gain * 2,
				 channel->max_power * 2,
				 min((u32) MAX_RATE_POWER,
				 (u32) ah->regulatory.power_limit));
1384 1385

	if (!ath9k_hw_set_rf_regs(ah, chan, freqIndex)) {
S
Sujith 已提交
1386
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
1387
			"ar5416SetRfRegs failed\n");
1388 1389 1390 1391 1392 1393
		return -EIO;
	}

	return 0;
}

S
Sujith 已提交
1394 1395 1396 1397
/****************************************/
/* Reset and Channel Switching Routines */
/****************************************/

1398
static void ath9k_hw_set_rfmode(struct ath_hw *ah, struct ath9k_channel *chan)
1399
{
S
Sujith 已提交
1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417
	u32 rfMode = 0;

	if (chan == NULL)
		return;

	rfMode |= (IS_CHAN_B(chan) || IS_CHAN_G(chan))
		? AR_PHY_MODE_DYNAMIC : AR_PHY_MODE_OFDM;

	if (!AR_SREV_9280_10_OR_LATER(ah))
		rfMode |= (IS_CHAN_5GHZ(chan)) ?
			AR_PHY_MODE_RF5GHZ : AR_PHY_MODE_RF2GHZ;

	if (AR_SREV_9280_20(ah) && IS_CHAN_A_5MHZ_SPACED(chan))
		rfMode |= (AR_PHY_MODE_DYNAMIC | AR_PHY_MODE_DYN_CCK_DISABLE);

	REG_WRITE(ah, AR_PHY_MODE, rfMode);
}

1418
static void ath9k_hw_mark_phy_inactive(struct ath_hw *ah)
S
Sujith 已提交
1419 1420 1421 1422
{
	REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_DIS);
}

1423
static inline void ath9k_hw_set_dma(struct ath_hw *ah)
S
Sujith 已提交
1424 1425 1426 1427 1428 1429 1430 1431 1432
{
	u32 regval;

	regval = REG_READ(ah, AR_AHB_MODE);
	REG_WRITE(ah, AR_AHB_MODE, regval | AR_AHB_PREFETCH_RD_EN);

	regval = REG_READ(ah, AR_TXCFG) & ~AR_TXCFG_DMASZ_MASK;
	REG_WRITE(ah, AR_TXCFG, regval | AR_TXCFG_DMASZ_128B);

1433
	REG_RMW_FIELD(ah, AR_TXCFG, AR_FTRIG, ah->tx_trig_level);
S
Sujith 已提交
1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448

	regval = REG_READ(ah, AR_RXCFG) & ~AR_RXCFG_DMASZ_MASK;
	REG_WRITE(ah, AR_RXCFG, regval | AR_RXCFG_DMASZ_128B);

	REG_WRITE(ah, AR_RXFIFO_CFG, 0x200);

	if (AR_SREV_9285(ah)) {
		REG_WRITE(ah, AR_PCU_TXBUF_CTRL,
			  AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE);
	} else {
		REG_WRITE(ah, AR_PCU_TXBUF_CTRL,
			  AR_PCU_TXBUF_CTRL_USABLE_SIZE);
	}
}

1449
static void ath9k_hw_set_operating_mode(struct ath_hw *ah, int opmode)
S
Sujith 已提交
1450 1451 1452 1453 1454 1455
{
	u32 val;

	val = REG_READ(ah, AR_STA_ID1);
	val &= ~(AR_STA_ID1_STA_AP | AR_STA_ID1_ADHOC);
	switch (opmode) {
1456
	case NL80211_IFTYPE_AP:
S
Sujith 已提交
1457 1458 1459
		REG_WRITE(ah, AR_STA_ID1, val | AR_STA_ID1_STA_AP
			  | AR_STA_ID1_KSRCH_MODE);
		REG_CLR_BIT(ah, AR_CFG, AR_CFG_AP_ADHOC_INDICATION);
1460
		break;
1461
	case NL80211_IFTYPE_ADHOC:
1462
	case NL80211_IFTYPE_MESH_POINT:
S
Sujith 已提交
1463 1464 1465
		REG_WRITE(ah, AR_STA_ID1, val | AR_STA_ID1_ADHOC
			  | AR_STA_ID1_KSRCH_MODE);
		REG_SET_BIT(ah, AR_CFG, AR_CFG_AP_ADHOC_INDICATION);
1466
		break;
1467 1468
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_MONITOR:
S
Sujith 已提交
1469
		REG_WRITE(ah, AR_STA_ID1, val | AR_STA_ID1_KSRCH_MODE);
1470
		break;
S
Sujith 已提交
1471 1472 1473
	}
}

1474
static inline void ath9k_hw_get_delta_slope_vals(struct ath_hw *ah,
S
Sujith 已提交
1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492
						 u32 coef_scaled,
						 u32 *coef_mantissa,
						 u32 *coef_exponent)
{
	u32 coef_exp, coef_man;

	for (coef_exp = 31; coef_exp > 0; coef_exp--)
		if ((coef_scaled >> coef_exp) & 0x1)
			break;

	coef_exp = 14 - (coef_exp - COEF_SCALE_S);

	coef_man = coef_scaled + (1 << (COEF_SCALE_S - coef_exp - 1));

	*coef_mantissa = coef_man >> (COEF_SCALE_S - coef_exp);
	*coef_exponent = coef_exp - 16;
}

1493
static void ath9k_hw_set_delta_slope(struct ath_hw *ah,
S
Sujith 已提交
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526
				     struct ath9k_channel *chan)
{
	u32 coef_scaled, ds_coef_exp, ds_coef_man;
	u32 clockMhzScaled = 0x64000000;
	struct chan_centers centers;

	if (IS_CHAN_HALF_RATE(chan))
		clockMhzScaled = clockMhzScaled >> 1;
	else if (IS_CHAN_QUARTER_RATE(chan))
		clockMhzScaled = clockMhzScaled >> 2;

	ath9k_hw_get_channel_centers(ah, chan, &centers);
	coef_scaled = clockMhzScaled / centers.synth_center;

	ath9k_hw_get_delta_slope_vals(ah, coef_scaled, &ds_coef_man,
				      &ds_coef_exp);

	REG_RMW_FIELD(ah, AR_PHY_TIMING3,
		      AR_PHY_TIMING3_DSC_MAN, ds_coef_man);
	REG_RMW_FIELD(ah, AR_PHY_TIMING3,
		      AR_PHY_TIMING3_DSC_EXP, ds_coef_exp);

	coef_scaled = (9 * coef_scaled) / 10;

	ath9k_hw_get_delta_slope_vals(ah, coef_scaled, &ds_coef_man,
				      &ds_coef_exp);

	REG_RMW_FIELD(ah, AR_PHY_HALFGI,
		      AR_PHY_HALFGI_DSC_MAN, ds_coef_man);
	REG_RMW_FIELD(ah, AR_PHY_HALFGI,
		      AR_PHY_HALFGI_DSC_EXP, ds_coef_exp);
}

1527
static bool ath9k_hw_set_reset(struct ath_hw *ah, int type)
S
Sujith 已提交
1528 1529 1530 1531
{
	u32 rst_flags;
	u32 tmpReg;

1532 1533 1534 1535 1536 1537 1538 1539
	if (AR_SREV_9100(ah)) {
		u32 val = REG_READ(ah, AR_RTC_DERIVED_CLK);
		val &= ~AR_RTC_DERIVED_CLK_PERIOD;
		val |= SM(1, AR_RTC_DERIVED_CLK_PERIOD);
		REG_WRITE(ah, AR_RTC_DERIVED_CLK, val);
		(void)REG_READ(ah, AR_RTC_DERIVED_CLK);
	}

S
Sujith 已提交
1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561
	REG_WRITE(ah, AR_RTC_FORCE_WAKE, AR_RTC_FORCE_WAKE_EN |
		  AR_RTC_FORCE_WAKE_ON_INT);

	if (AR_SREV_9100(ah)) {
		rst_flags = AR_RTC_RC_MAC_WARM | AR_RTC_RC_MAC_COLD |
			AR_RTC_RC_COLD_RESET | AR_RTC_RC_WARM_RESET;
	} else {
		tmpReg = REG_READ(ah, AR_INTR_SYNC_CAUSE);
		if (tmpReg &
		    (AR_INTR_SYNC_LOCAL_TIMEOUT |
		     AR_INTR_SYNC_RADM_CPL_TIMEOUT)) {
			REG_WRITE(ah, AR_INTR_SYNC_ENABLE, 0);
			REG_WRITE(ah, AR_RC, AR_RC_AHB | AR_RC_HOSTIF);
		} else {
			REG_WRITE(ah, AR_RC, AR_RC_AHB);
		}

		rst_flags = AR_RTC_RC_MAC_WARM;
		if (type == ATH9K_RESET_COLD)
			rst_flags |= AR_RTC_RC_MAC_COLD;
	}

1562
	REG_WRITE(ah, AR_RTC_RC, rst_flags);
S
Sujith 已提交
1563 1564
	udelay(50);

1565
	REG_WRITE(ah, AR_RTC_RC, 0);
S
Sujith 已提交
1566
	if (!ath9k_hw_wait(ah, AR_RTC_RC, AR_RTC_RC_M, 0, AH_WAIT_TIMEOUT)) {
S
Sujith 已提交
1567
		DPRINTF(ah->ah_sc, ATH_DBG_RESET,
S
Sujith 已提交
1568
			"RTC stuck in MAC reset\n");
S
Sujith 已提交
1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582
		return false;
	}

	if (!AR_SREV_9100(ah))
		REG_WRITE(ah, AR_RC, 0);

	ath9k_hw_init_pll(ah, NULL);

	if (AR_SREV_9100(ah))
		udelay(50);

	return true;
}

1583
static bool ath9k_hw_set_reset_power_on(struct ath_hw *ah)
S
Sujith 已提交
1584 1585 1586 1587
{
	REG_WRITE(ah, AR_RTC_FORCE_WAKE, AR_RTC_FORCE_WAKE_EN |
		  AR_RTC_FORCE_WAKE_ON_INT);

1588
	REG_WRITE(ah, AR_RTC_RESET, 0);
1589
	udelay(2);
1590
	REG_WRITE(ah, AR_RTC_RESET, 1);
S
Sujith 已提交
1591 1592 1593 1594

	if (!ath9k_hw_wait(ah,
			   AR_RTC_STATUS,
			   AR_RTC_STATUS_M,
S
Sujith 已提交
1595 1596
			   AR_RTC_STATUS_ON,
			   AH_WAIT_TIMEOUT)) {
S
Sujith 已提交
1597
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "RTC not waking up\n");
S
Sujith 已提交
1598
		return false;
1599 1600
	}

S
Sujith 已提交
1601 1602 1603 1604 1605
	ath9k_hw_read_revisions(ah);

	return ath9k_hw_set_reset(ah, ATH9K_RESET_WARM);
}

1606
static bool ath9k_hw_set_reset_reg(struct ath_hw *ah, u32 type)
S
Sujith 已提交
1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619
{
	REG_WRITE(ah, AR_RTC_FORCE_WAKE,
		  AR_RTC_FORCE_WAKE_EN | AR_RTC_FORCE_WAKE_ON_INT);

	switch (type) {
	case ATH9K_RESET_POWER_ON:
		return ath9k_hw_set_reset_power_on(ah);
	case ATH9K_RESET_WARM:
	case ATH9K_RESET_COLD:
		return ath9k_hw_set_reset(ah, type);
	default:
		return false;
	}
1620 1621
}

1622
static void ath9k_hw_set_regs(struct ath_hw *ah, struct ath9k_channel *chan,
S
Sujith 已提交
1623
			      enum ath9k_ht_macmode macmode)
1624
{
S
Sujith 已提交
1625
	u32 phymode;
1626
	u32 enableDacFifo = 0;
1627

1628 1629 1630 1631
	if (AR_SREV_9285_10_OR_LATER(ah))
		enableDacFifo = (REG_READ(ah, AR_PHY_TURBO) &
					 AR_PHY_FC_ENABLE_DAC_FIFO);

S
Sujith 已提交
1632
	phymode = AR_PHY_FC_HT_EN | AR_PHY_FC_SHORT_GI_40
1633
		| AR_PHY_FC_SINGLE_HT_LTF1 | AR_PHY_FC_WALSH | enableDacFifo;
S
Sujith 已提交
1634 1635 1636

	if (IS_CHAN_HT40(chan)) {
		phymode |= AR_PHY_FC_DYN2040_EN;
1637

S
Sujith 已提交
1638 1639 1640
		if ((chan->chanmode == CHANNEL_A_HT40PLUS) ||
		    (chan->chanmode == CHANNEL_G_HT40PLUS))
			phymode |= AR_PHY_FC_DYN2040_PRI_CH;
1641

1642
		if (ah->extprotspacing == ATH9K_HT_EXTPROTSPACING_25)
S
Sujith 已提交
1643
			phymode |= AR_PHY_FC_DYN2040_EXT_CH;
1644
	}
S
Sujith 已提交
1645 1646 1647
	REG_WRITE(ah, AR_PHY_TURBO, phymode);

	ath9k_hw_set11nmac2040(ah, macmode);
1648

S
Sujith 已提交
1649 1650
	REG_WRITE(ah, AR_GTXTO, 25 << AR_GTXTO_TIMEOUT_LIMIT_S);
	REG_WRITE(ah, AR_CST, 0xF << AR_CST_TIMEOUT_LIMIT_S);
1651 1652
}

1653
static bool ath9k_hw_chip_reset(struct ath_hw *ah,
S
Sujith 已提交
1654
				struct ath9k_channel *chan)
1655
{
1656 1657 1658 1659
	if (OLC_FOR_AR9280_20_LATER) {
		if (!ath9k_hw_set_reset_reg(ah, ATH9K_RESET_POWER_ON))
			return false;
	} else if (!ath9k_hw_set_reset_reg(ah, ATH9K_RESET_WARM))
S
Sujith 已提交
1660
		return false;
1661

S
Sujith 已提交
1662 1663
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE))
		return false;
1664

1665
	ah->chip_fullsleep = false;
S
Sujith 已提交
1666 1667
	ath9k_hw_init_pll(ah, chan);
	ath9k_hw_set_rfmode(ah, chan);
1668

S
Sujith 已提交
1669
	return true;
1670 1671
}

1672
static bool ath9k_hw_channel_change(struct ath_hw *ah,
S
Sujith 已提交
1673 1674
				    struct ath9k_channel *chan,
				    enum ath9k_ht_macmode macmode)
1675
{
1676
	struct ieee80211_channel *channel = chan->chan;
1677 1678 1679 1680 1681
	u32 synthDelay, qnum;

	for (qnum = 0; qnum < AR_NUM_QCU; qnum++) {
		if (ath9k_hw_numtxpending(ah, qnum)) {
			DPRINTF(ah->ah_sc, ATH_DBG_QUEUE,
S
Sujith 已提交
1682
				"Transmit frames pending on queue %d\n", qnum);
1683 1684 1685 1686 1687 1688
			return false;
		}
	}

	REG_WRITE(ah, AR_PHY_RFBUS_REQ, AR_PHY_RFBUS_REQ_EN);
	if (!ath9k_hw_wait(ah, AR_PHY_RFBUS_GRANT, AR_PHY_RFBUS_GRANT_EN,
S
Sujith 已提交
1689
			   AR_PHY_RFBUS_GRANT_EN, AH_WAIT_TIMEOUT)) {
S
Sujith 已提交
1690
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
1691
			"Could not kill baseband RX\n");
1692 1693 1694 1695 1696 1697
		return false;
	}

	ath9k_hw_set_regs(ah, chan, macmode);

	if (AR_SREV_9280_10_OR_LATER(ah)) {
1698
		ath9k_hw_ar9280_set_channel(ah, chan);
1699 1700
	} else {
		if (!(ath9k_hw_set_channel(ah, chan))) {
S
Sujith 已提交
1701 1702
			DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
				"Failed to set channel\n");
1703 1704 1705 1706
			return false;
		}
	}

1707
	ah->eep_ops->set_txpower(ah, chan,
1708
			     ath9k_regd_get_ctl(&ah->regulatory, chan),
S
Sujith 已提交
1709 1710 1711
			     channel->max_antenna_gain * 2,
			     channel->max_power * 2,
			     min((u32) MAX_RATE_POWER,
1712
			     (u32) ah->regulatory.power_limit));
1713 1714

	synthDelay = REG_READ(ah, AR_PHY_RX_DELAY) & AR_PHY_RX_DELAY_DELAY;
1715
	if (IS_CHAN_B(chan))
1716 1717 1718 1719 1720 1721 1722 1723
		synthDelay = (4 * synthDelay) / 22;
	else
		synthDelay /= 10;

	udelay(synthDelay + BASE_ACTIVATE_DELAY);

	REG_WRITE(ah, AR_PHY_RFBUS_REQ, 0);

S
Sujith 已提交
1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737
	if (IS_CHAN_OFDM(chan) || IS_CHAN_HT(chan))
		ath9k_hw_set_delta_slope(ah, chan);

	if (AR_SREV_9280_10_OR_LATER(ah))
		ath9k_hw_9280_spur_mitigate(ah, chan);
	else
		ath9k_hw_spur_mitigate(ah, chan);

	if (!chan->oneTimeCalsDone)
		chan->oneTimeCalsDone = true;

	return true;
}

1738
static void ath9k_hw_9280_spur_mitigate(struct ath_hw *ah, struct ath9k_channel *chan)
S
Sujith 已提交
1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771
{
	int bb_spur = AR_NO_SPUR;
	int freq;
	int bin, cur_bin;
	int bb_spur_off, spur_subchannel_sd;
	int spur_freq_sd;
	int spur_delta_phase;
	int denominator;
	int upper, lower, cur_vit_mask;
	int tmp, newVal;
	int i;
	int pilot_mask_reg[4] = { AR_PHY_TIMING7, AR_PHY_TIMING8,
			  AR_PHY_PILOT_MASK_01_30, AR_PHY_PILOT_MASK_31_60
	};
	int chan_mask_reg[4] = { AR_PHY_TIMING9, AR_PHY_TIMING10,
			 AR_PHY_CHANNEL_MASK_01_30, AR_PHY_CHANNEL_MASK_31_60
	};
	int inc[4] = { 0, 100, 0, 0 };
	struct chan_centers centers;

	int8_t mask_m[123];
	int8_t mask_p[123];
	int8_t mask_amt;
	int tmp_mask;
	int cur_bb_spur;
	bool is2GHz = IS_CHAN_2GHZ(chan);

	memset(&mask_m, 0, sizeof(int8_t) * 123);
	memset(&mask_p, 0, sizeof(int8_t) * 123);

	ath9k_hw_get_channel_centers(ah, chan, &centers);
	freq = centers.synth_center;

1772
	ah->config.spurmode = SPUR_ENABLE_EEPROM;
S
Sujith 已提交
1773
	for (i = 0; i < AR_EEPROM_MODAL_SPURS; i++) {
S
Sujith 已提交
1774
		cur_bb_spur = ah->eep_ops->get_spur_channel(ah, i, is2GHz);
S
Sujith 已提交
1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884

		if (is2GHz)
			cur_bb_spur = (cur_bb_spur / 10) + AR_BASE_FREQ_2GHZ;
		else
			cur_bb_spur = (cur_bb_spur / 10) + AR_BASE_FREQ_5GHZ;

		if (AR_NO_SPUR == cur_bb_spur)
			break;
		cur_bb_spur = cur_bb_spur - freq;

		if (IS_CHAN_HT40(chan)) {
			if ((cur_bb_spur > -AR_SPUR_FEEQ_BOUND_HT40) &&
			    (cur_bb_spur < AR_SPUR_FEEQ_BOUND_HT40)) {
				bb_spur = cur_bb_spur;
				break;
			}
		} else if ((cur_bb_spur > -AR_SPUR_FEEQ_BOUND_HT20) &&
			   (cur_bb_spur < AR_SPUR_FEEQ_BOUND_HT20)) {
			bb_spur = cur_bb_spur;
			break;
		}
	}

	if (AR_NO_SPUR == bb_spur) {
		REG_CLR_BIT(ah, AR_PHY_FORCE_CLKEN_CCK,
			    AR_PHY_FORCE_CLKEN_CCK_MRC_MUX);
		return;
	} else {
		REG_CLR_BIT(ah, AR_PHY_FORCE_CLKEN_CCK,
			    AR_PHY_FORCE_CLKEN_CCK_MRC_MUX);
	}

	bin = bb_spur * 320;

	tmp = REG_READ(ah, AR_PHY_TIMING_CTRL4(0));

	newVal = tmp | (AR_PHY_TIMING_CTRL4_ENABLE_SPUR_RSSI |
			AR_PHY_TIMING_CTRL4_ENABLE_SPUR_FILTER |
			AR_PHY_TIMING_CTRL4_ENABLE_CHAN_MASK |
			AR_PHY_TIMING_CTRL4_ENABLE_PILOT_MASK);
	REG_WRITE(ah, AR_PHY_TIMING_CTRL4(0), newVal);

	newVal = (AR_PHY_SPUR_REG_MASK_RATE_CNTL |
		  AR_PHY_SPUR_REG_ENABLE_MASK_PPM |
		  AR_PHY_SPUR_REG_MASK_RATE_SELECT |
		  AR_PHY_SPUR_REG_ENABLE_VIT_SPUR_RSSI |
		  SM(SPUR_RSSI_THRESH, AR_PHY_SPUR_REG_SPUR_RSSI_THRESH));
	REG_WRITE(ah, AR_PHY_SPUR_REG, newVal);

	if (IS_CHAN_HT40(chan)) {
		if (bb_spur < 0) {
			spur_subchannel_sd = 1;
			bb_spur_off = bb_spur + 10;
		} else {
			spur_subchannel_sd = 0;
			bb_spur_off = bb_spur - 10;
		}
	} else {
		spur_subchannel_sd = 0;
		bb_spur_off = bb_spur;
	}

	if (IS_CHAN_HT40(chan))
		spur_delta_phase =
			((bb_spur * 262144) /
			 10) & AR_PHY_TIMING11_SPUR_DELTA_PHASE;
	else
		spur_delta_phase =
			((bb_spur * 524288) /
			 10) & AR_PHY_TIMING11_SPUR_DELTA_PHASE;

	denominator = IS_CHAN_2GHZ(chan) ? 44 : 40;
	spur_freq_sd = ((bb_spur_off * 2048) / denominator) & 0x3ff;

	newVal = (AR_PHY_TIMING11_USE_SPUR_IN_AGC |
		  SM(spur_freq_sd, AR_PHY_TIMING11_SPUR_FREQ_SD) |
		  SM(spur_delta_phase, AR_PHY_TIMING11_SPUR_DELTA_PHASE));
	REG_WRITE(ah, AR_PHY_TIMING11, newVal);

	newVal = spur_subchannel_sd << AR_PHY_SFCORR_SPUR_SUBCHNL_SD_S;
	REG_WRITE(ah, AR_PHY_SFCORR_EXT, newVal);

	cur_bin = -6000;
	upper = bin + 100;
	lower = bin - 100;

	for (i = 0; i < 4; i++) {
		int pilot_mask = 0;
		int chan_mask = 0;
		int bp = 0;
		for (bp = 0; bp < 30; bp++) {
			if ((cur_bin > lower) && (cur_bin < upper)) {
				pilot_mask = pilot_mask | 0x1 << bp;
				chan_mask = chan_mask | 0x1 << bp;
			}
			cur_bin += 100;
		}
		cur_bin += inc[i];
		REG_WRITE(ah, pilot_mask_reg[i], pilot_mask);
		REG_WRITE(ah, chan_mask_reg[i], chan_mask);
	}

	cur_vit_mask = 6100;
	upper = bin + 120;
	lower = bin - 120;

	for (i = 0; i < 123; i++) {
		if ((cur_vit_mask > lower) && (cur_vit_mask < upper)) {

			/* workaround for gcc bug #37014 */
L
Luis R. Rodriguez 已提交
1885
			volatile int tmp_v = abs(cur_vit_mask - bin);
S
Sujith 已提交
1886

L
Luis R. Rodriguez 已提交
1887
			if (tmp_v < 75)
S
Sujith 已提交
1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952
				mask_amt = 1;
			else
				mask_amt = 0;
			if (cur_vit_mask < 0)
				mask_m[abs(cur_vit_mask / 100)] = mask_amt;
			else
				mask_p[cur_vit_mask / 100] = mask_amt;
		}
		cur_vit_mask -= 100;
	}

	tmp_mask = (mask_m[46] << 30) | (mask_m[47] << 28)
		| (mask_m[48] << 26) | (mask_m[49] << 24)
		| (mask_m[50] << 22) | (mask_m[51] << 20)
		| (mask_m[52] << 18) | (mask_m[53] << 16)
		| (mask_m[54] << 14) | (mask_m[55] << 12)
		| (mask_m[56] << 10) | (mask_m[57] << 8)
		| (mask_m[58] << 6) | (mask_m[59] << 4)
		| (mask_m[60] << 2) | (mask_m[61] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK_1, tmp_mask);
	REG_WRITE(ah, AR_PHY_VIT_MASK2_M_46_61, tmp_mask);

	tmp_mask = (mask_m[31] << 28)
		| (mask_m[32] << 26) | (mask_m[33] << 24)
		| (mask_m[34] << 22) | (mask_m[35] << 20)
		| (mask_m[36] << 18) | (mask_m[37] << 16)
		| (mask_m[48] << 14) | (mask_m[39] << 12)
		| (mask_m[40] << 10) | (mask_m[41] << 8)
		| (mask_m[42] << 6) | (mask_m[43] << 4)
		| (mask_m[44] << 2) | (mask_m[45] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK_2, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_M_31_45, tmp_mask);

	tmp_mask = (mask_m[16] << 30) | (mask_m[16] << 28)
		| (mask_m[18] << 26) | (mask_m[18] << 24)
		| (mask_m[20] << 22) | (mask_m[20] << 20)
		| (mask_m[22] << 18) | (mask_m[22] << 16)
		| (mask_m[24] << 14) | (mask_m[24] << 12)
		| (mask_m[25] << 10) | (mask_m[26] << 8)
		| (mask_m[27] << 6) | (mask_m[28] << 4)
		| (mask_m[29] << 2) | (mask_m[30] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK_3, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_M_16_30, tmp_mask);

	tmp_mask = (mask_m[0] << 30) | (mask_m[1] << 28)
		| (mask_m[2] << 26) | (mask_m[3] << 24)
		| (mask_m[4] << 22) | (mask_m[5] << 20)
		| (mask_m[6] << 18) | (mask_m[7] << 16)
		| (mask_m[8] << 14) | (mask_m[9] << 12)
		| (mask_m[10] << 10) | (mask_m[11] << 8)
		| (mask_m[12] << 6) | (mask_m[13] << 4)
		| (mask_m[14] << 2) | (mask_m[15] << 0);
	REG_WRITE(ah, AR_PHY_MASK_CTL, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_M_00_15, tmp_mask);

	tmp_mask = (mask_p[15] << 28)
		| (mask_p[14] << 26) | (mask_p[13] << 24)
		| (mask_p[12] << 22) | (mask_p[11] << 20)
		| (mask_p[10] << 18) | (mask_p[9] << 16)
		| (mask_p[8] << 14) | (mask_p[7] << 12)
		| (mask_p[6] << 10) | (mask_p[5] << 8)
		| (mask_p[4] << 6) | (mask_p[3] << 4)
		| (mask_p[2] << 2) | (mask_p[1] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_1, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_15_01, tmp_mask);
1953

S
Sujith 已提交
1954 1955 1956 1957 1958 1959 1960 1961 1962 1963
	tmp_mask = (mask_p[30] << 28)
		| (mask_p[29] << 26) | (mask_p[28] << 24)
		| (mask_p[27] << 22) | (mask_p[26] << 20)
		| (mask_p[25] << 18) | (mask_p[24] << 16)
		| (mask_p[23] << 14) | (mask_p[22] << 12)
		| (mask_p[21] << 10) | (mask_p[20] << 8)
		| (mask_p[19] << 6) | (mask_p[18] << 4)
		| (mask_p[17] << 2) | (mask_p[16] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_2, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_30_16, tmp_mask);
1964

S
Sujith 已提交
1965 1966 1967 1968 1969 1970 1971 1972 1973 1974
	tmp_mask = (mask_p[45] << 28)
		| (mask_p[44] << 26) | (mask_p[43] << 24)
		| (mask_p[42] << 22) | (mask_p[41] << 20)
		| (mask_p[40] << 18) | (mask_p[39] << 16)
		| (mask_p[38] << 14) | (mask_p[37] << 12)
		| (mask_p[36] << 10) | (mask_p[35] << 8)
		| (mask_p[34] << 6) | (mask_p[33] << 4)
		| (mask_p[32] << 2) | (mask_p[31] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_3, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_45_31, tmp_mask);
1975

S
Sujith 已提交
1976 1977 1978 1979 1980 1981 1982 1983 1984 1985
	tmp_mask = (mask_p[61] << 30) | (mask_p[60] << 28)
		| (mask_p[59] << 26) | (mask_p[58] << 24)
		| (mask_p[57] << 22) | (mask_p[56] << 20)
		| (mask_p[55] << 18) | (mask_p[54] << 16)
		| (mask_p[53] << 14) | (mask_p[52] << 12)
		| (mask_p[51] << 10) | (mask_p[50] << 8)
		| (mask_p[49] << 6) | (mask_p[48] << 4)
		| (mask_p[47] << 2) | (mask_p[46] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_4, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_61_45, tmp_mask);
1986 1987
}

1988
static void ath9k_hw_spur_mitigate(struct ath_hw *ah, struct ath9k_channel *chan)
1989
{
S
Sujith 已提交
1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004
	int bb_spur = AR_NO_SPUR;
	int bin, cur_bin;
	int spur_freq_sd;
	int spur_delta_phase;
	int denominator;
	int upper, lower, cur_vit_mask;
	int tmp, new;
	int i;
	int pilot_mask_reg[4] = { AR_PHY_TIMING7, AR_PHY_TIMING8,
			  AR_PHY_PILOT_MASK_01_30, AR_PHY_PILOT_MASK_31_60
	};
	int chan_mask_reg[4] = { AR_PHY_TIMING9, AR_PHY_TIMING10,
			 AR_PHY_CHANNEL_MASK_01_30, AR_PHY_CHANNEL_MASK_31_60
	};
	int inc[4] = { 0, 100, 0, 0 };
2005

S
Sujith 已提交
2006 2007 2008 2009 2010 2011
	int8_t mask_m[123];
	int8_t mask_p[123];
	int8_t mask_amt;
	int tmp_mask;
	int cur_bb_spur;
	bool is2GHz = IS_CHAN_2GHZ(chan);
2012

S
Sujith 已提交
2013 2014
	memset(&mask_m, 0, sizeof(int8_t) * 123);
	memset(&mask_p, 0, sizeof(int8_t) * 123);
2015

S
Sujith 已提交
2016
	for (i = 0; i < AR_EEPROM_MODAL_SPURS; i++) {
S
Sujith 已提交
2017
		cur_bb_spur = ah->eep_ops->get_spur_channel(ah, i, is2GHz);
S
Sujith 已提交
2018 2019 2020 2021 2022 2023 2024 2025
		if (AR_NO_SPUR == cur_bb_spur)
			break;
		cur_bb_spur = cur_bb_spur - (chan->channel * 10);
		if ((cur_bb_spur > -95) && (cur_bb_spur < 95)) {
			bb_spur = cur_bb_spur;
			break;
		}
	}
2026

S
Sujith 已提交
2027 2028
	if (AR_NO_SPUR == bb_spur)
		return;
2029

S
Sujith 已提交
2030
	bin = bb_spur * 32;
2031

S
Sujith 已提交
2032 2033 2034 2035 2036
	tmp = REG_READ(ah, AR_PHY_TIMING_CTRL4(0));
	new = tmp | (AR_PHY_TIMING_CTRL4_ENABLE_SPUR_RSSI |
		     AR_PHY_TIMING_CTRL4_ENABLE_SPUR_FILTER |
		     AR_PHY_TIMING_CTRL4_ENABLE_CHAN_MASK |
		     AR_PHY_TIMING_CTRL4_ENABLE_PILOT_MASK);
2037

S
Sujith 已提交
2038
	REG_WRITE(ah, AR_PHY_TIMING_CTRL4(0), new);
2039

S
Sujith 已提交
2040 2041 2042 2043 2044 2045
	new = (AR_PHY_SPUR_REG_MASK_RATE_CNTL |
	       AR_PHY_SPUR_REG_ENABLE_MASK_PPM |
	       AR_PHY_SPUR_REG_MASK_RATE_SELECT |
	       AR_PHY_SPUR_REG_ENABLE_VIT_SPUR_RSSI |
	       SM(SPUR_RSSI_THRESH, AR_PHY_SPUR_REG_SPUR_RSSI_THRESH));
	REG_WRITE(ah, AR_PHY_SPUR_REG, new);
2046

S
Sujith 已提交
2047 2048
	spur_delta_phase = ((bb_spur * 524288) / 100) &
		AR_PHY_TIMING11_SPUR_DELTA_PHASE;
2049

S
Sujith 已提交
2050 2051
	denominator = IS_CHAN_2GHZ(chan) ? 440 : 400;
	spur_freq_sd = ((bb_spur * 2048) / denominator) & 0x3ff;
2052

S
Sujith 已提交
2053 2054 2055 2056
	new = (AR_PHY_TIMING11_USE_SPUR_IN_AGC |
	       SM(spur_freq_sd, AR_PHY_TIMING11_SPUR_FREQ_SD) |
	       SM(spur_delta_phase, AR_PHY_TIMING11_SPUR_DELTA_PHASE));
	REG_WRITE(ah, AR_PHY_TIMING11, new);
2057

S
Sujith 已提交
2058 2059 2060
	cur_bin = -6000;
	upper = bin + 100;
	lower = bin - 100;
2061

S
Sujith 已提交
2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075
	for (i = 0; i < 4; i++) {
		int pilot_mask = 0;
		int chan_mask = 0;
		int bp = 0;
		for (bp = 0; bp < 30; bp++) {
			if ((cur_bin > lower) && (cur_bin < upper)) {
				pilot_mask = pilot_mask | 0x1 << bp;
				chan_mask = chan_mask | 0x1 << bp;
			}
			cur_bin += 100;
		}
		cur_bin += inc[i];
		REG_WRITE(ah, pilot_mask_reg[i], pilot_mask);
		REG_WRITE(ah, chan_mask_reg[i], chan_mask);
2076 2077
	}

S
Sujith 已提交
2078 2079 2080
	cur_vit_mask = 6100;
	upper = bin + 120;
	lower = bin - 120;
2081

S
Sujith 已提交
2082 2083
	for (i = 0; i < 123; i++) {
		if ((cur_vit_mask > lower) && (cur_vit_mask < upper)) {
2084

S
Sujith 已提交
2085
			/* workaround for gcc bug #37014 */
L
Luis R. Rodriguez 已提交
2086
			volatile int tmp_v = abs(cur_vit_mask - bin);
2087

L
Luis R. Rodriguez 已提交
2088
			if (tmp_v < 75)
S
Sujith 已提交
2089 2090 2091 2092 2093 2094 2095 2096 2097
				mask_amt = 1;
			else
				mask_amt = 0;
			if (cur_vit_mask < 0)
				mask_m[abs(cur_vit_mask / 100)] = mask_amt;
			else
				mask_p[cur_vit_mask / 100] = mask_amt;
		}
		cur_vit_mask -= 100;
2098 2099
	}

S
Sujith 已提交
2100 2101 2102 2103 2104 2105 2106 2107 2108 2109
	tmp_mask = (mask_m[46] << 30) | (mask_m[47] << 28)
		| (mask_m[48] << 26) | (mask_m[49] << 24)
		| (mask_m[50] << 22) | (mask_m[51] << 20)
		| (mask_m[52] << 18) | (mask_m[53] << 16)
		| (mask_m[54] << 14) | (mask_m[55] << 12)
		| (mask_m[56] << 10) | (mask_m[57] << 8)
		| (mask_m[58] << 6) | (mask_m[59] << 4)
		| (mask_m[60] << 2) | (mask_m[61] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK_1, tmp_mask);
	REG_WRITE(ah, AR_PHY_VIT_MASK2_M_46_61, tmp_mask);
2110

S
Sujith 已提交
2111 2112 2113 2114 2115 2116 2117 2118 2119 2120
	tmp_mask = (mask_m[31] << 28)
		| (mask_m[32] << 26) | (mask_m[33] << 24)
		| (mask_m[34] << 22) | (mask_m[35] << 20)
		| (mask_m[36] << 18) | (mask_m[37] << 16)
		| (mask_m[48] << 14) | (mask_m[39] << 12)
		| (mask_m[40] << 10) | (mask_m[41] << 8)
		| (mask_m[42] << 6) | (mask_m[43] << 4)
		| (mask_m[44] << 2) | (mask_m[45] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK_2, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_M_31_45, tmp_mask);
2121

S
Sujith 已提交
2122 2123 2124 2125 2126 2127 2128 2129 2130 2131
	tmp_mask = (mask_m[16] << 30) | (mask_m[16] << 28)
		| (mask_m[18] << 26) | (mask_m[18] << 24)
		| (mask_m[20] << 22) | (mask_m[20] << 20)
		| (mask_m[22] << 18) | (mask_m[22] << 16)
		| (mask_m[24] << 14) | (mask_m[24] << 12)
		| (mask_m[25] << 10) | (mask_m[26] << 8)
		| (mask_m[27] << 6) | (mask_m[28] << 4)
		| (mask_m[29] << 2) | (mask_m[30] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK_3, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_M_16_30, tmp_mask);
2132

S
Sujith 已提交
2133 2134 2135 2136 2137 2138 2139 2140 2141 2142
	tmp_mask = (mask_m[0] << 30) | (mask_m[1] << 28)
		| (mask_m[2] << 26) | (mask_m[3] << 24)
		| (mask_m[4] << 22) | (mask_m[5] << 20)
		| (mask_m[6] << 18) | (mask_m[7] << 16)
		| (mask_m[8] << 14) | (mask_m[9] << 12)
		| (mask_m[10] << 10) | (mask_m[11] << 8)
		| (mask_m[12] << 6) | (mask_m[13] << 4)
		| (mask_m[14] << 2) | (mask_m[15] << 0);
	REG_WRITE(ah, AR_PHY_MASK_CTL, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_M_00_15, tmp_mask);
2143

S
Sujith 已提交
2144 2145 2146 2147 2148 2149 2150 2151 2152 2153
	tmp_mask = (mask_p[15] << 28)
		| (mask_p[14] << 26) | (mask_p[13] << 24)
		| (mask_p[12] << 22) | (mask_p[11] << 20)
		| (mask_p[10] << 18) | (mask_p[9] << 16)
		| (mask_p[8] << 14) | (mask_p[7] << 12)
		| (mask_p[6] << 10) | (mask_p[5] << 8)
		| (mask_p[4] << 6) | (mask_p[3] << 4)
		| (mask_p[2] << 2) | (mask_p[1] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_1, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_15_01, tmp_mask);
2154

S
Sujith 已提交
2155 2156 2157 2158 2159 2160 2161 2162 2163 2164
	tmp_mask = (mask_p[30] << 28)
		| (mask_p[29] << 26) | (mask_p[28] << 24)
		| (mask_p[27] << 22) | (mask_p[26] << 20)
		| (mask_p[25] << 18) | (mask_p[24] << 16)
		| (mask_p[23] << 14) | (mask_p[22] << 12)
		| (mask_p[21] << 10) | (mask_p[20] << 8)
		| (mask_p[19] << 6) | (mask_p[18] << 4)
		| (mask_p[17] << 2) | (mask_p[16] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_2, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_30_16, tmp_mask);
2165

S
Sujith 已提交
2166 2167 2168 2169 2170 2171 2172 2173 2174 2175
	tmp_mask = (mask_p[45] << 28)
		| (mask_p[44] << 26) | (mask_p[43] << 24)
		| (mask_p[42] << 22) | (mask_p[41] << 20)
		| (mask_p[40] << 18) | (mask_p[39] << 16)
		| (mask_p[38] << 14) | (mask_p[37] << 12)
		| (mask_p[36] << 10) | (mask_p[35] << 8)
		| (mask_p[34] << 6) | (mask_p[33] << 4)
		| (mask_p[32] << 2) | (mask_p[31] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_3, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_45_31, tmp_mask);
2176

S
Sujith 已提交
2177 2178 2179 2180 2181 2182 2183 2184 2185 2186
	tmp_mask = (mask_p[61] << 30) | (mask_p[60] << 28)
		| (mask_p[59] << 26) | (mask_p[58] << 24)
		| (mask_p[57] << 22) | (mask_p[56] << 20)
		| (mask_p[55] << 18) | (mask_p[54] << 16)
		| (mask_p[53] << 14) | (mask_p[52] << 12)
		| (mask_p[51] << 10) | (mask_p[50] << 8)
		| (mask_p[49] << 6) | (mask_p[48] << 4)
		| (mask_p[47] << 2) | (mask_p[46] << 0);
	REG_WRITE(ah, AR_PHY_BIN_MASK2_4, tmp_mask);
	REG_WRITE(ah, AR_PHY_MASK2_P_61_45, tmp_mask);
2187 2188
}

J
Johannes Berg 已提交
2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200
static void ath9k_enable_rfkill(struct ath_hw *ah)
{
	REG_SET_BIT(ah, AR_GPIO_INPUT_EN_VAL,
		    AR_GPIO_INPUT_EN_VAL_RFSILENT_BB);

	REG_CLR_BIT(ah, AR_GPIO_INPUT_MUX2,
		    AR_GPIO_INPUT_MUX2_RFSILENT);

	ath9k_hw_cfg_gpio_input(ah, ah->rfkill_gpio);
	REG_SET_BIT(ah, AR_PHY_TEST, RFSILENT_BB);
}

2201
int ath9k_hw_reset(struct ath_hw *ah, struct ath9k_channel *chan,
2202
		    bool bChannelChange)
2203 2204
{
	u32 saveLedState;
2205
	struct ath_softc *sc = ah->ah_sc;
2206
	struct ath9k_channel *curchan = ah->curchan;
2207 2208
	u32 saveDefAntenna;
	u32 macStaId1;
2209
	int i, rx_chainmask, r;
2210

2211 2212 2213
	ah->extprotspacing = sc->ht_extprotspacing;
	ah->txchainmask = sc->tx_chainmask;
	ah->rxchainmask = sc->rx_chainmask;
2214

2215 2216
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE))
		return -EIO;
2217 2218 2219 2220 2221

	if (curchan)
		ath9k_hw_getnf(ah, curchan);

	if (bChannelChange &&
2222 2223 2224
	    (ah->chip_fullsleep != true) &&
	    (ah->curchan != NULL) &&
	    (chan->channel != ah->curchan->channel) &&
2225
	    ((chan->channelFlags & CHANNEL_ALL) ==
2226
	     (ah->curchan->channelFlags & CHANNEL_ALL)) &&
2227
	    (!AR_SREV_9280(ah) || (!IS_CHAN_A_5MHZ_SPACED(chan) &&
2228
				   !IS_CHAN_A_5MHZ_SPACED(ah->curchan)))) {
2229

2230
		if (ath9k_hw_channel_change(ah, chan, sc->tx_chan_width)) {
2231
			ath9k_hw_loadnf(ah, ah->curchan);
2232
			ath9k_hw_start_nfcal(ah);
2233
			return 0;
2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249
		}
	}

	saveDefAntenna = REG_READ(ah, AR_DEF_ANTENNA);
	if (saveDefAntenna == 0)
		saveDefAntenna = 1;

	macStaId1 = REG_READ(ah, AR_STA_ID1) & AR_STA_ID1_BASE_RATE_11B;

	saveLedState = REG_READ(ah, AR_CFG_LED) &
		(AR_CFG_LED_ASSOC_CTL | AR_CFG_LED_MODE_SEL |
		 AR_CFG_LED_BLINK_THRESH_SEL | AR_CFG_LED_BLINK_SLOW);

	ath9k_hw_mark_phy_inactive(ah);

	if (!ath9k_hw_chip_reset(ah, chan)) {
S
Sujith 已提交
2250
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL, "Chip reset failed\n");
2251
		return -EINVAL;
2252 2253
	}

2254 2255
	if (AR_SREV_9280_10_OR_LATER(ah))
		REG_SET_BIT(ah, AR_GPIO_INPUT_EN_VAL, AR_GPIO_JTAG_DISABLE);
2256

2257 2258 2259
	r = ath9k_hw_process_ini(ah, chan, sc->tx_chan_width);
	if (r)
		return r;
2260

2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277
	/* Setup MFP options for CCMP */
	if (AR_SREV_9280_20_OR_LATER(ah)) {
		/* Mask Retry(b11), PwrMgt(b12), MoreData(b13) to 0 in mgmt
		 * frames when constructing CCMP AAD. */
		REG_RMW_FIELD(ah, AR_AES_MUTE_MASK1, AR_AES_MUTE_MASK1_FC_MGMT,
			      0xc7ff);
		ah->sw_mgmt_crypto = false;
	} else if (AR_SREV_9160_10_OR_LATER(ah)) {
		/* Disable hardware crypto for management frames */
		REG_CLR_BIT(ah, AR_PCU_MISC_MODE2,
			    AR_PCU_MISC_MODE2_MGMT_CRYPTO_ENABLE);
		REG_SET_BIT(ah, AR_PCU_MISC_MODE2,
			    AR_PCU_MISC_MODE2_NO_CRYPTO_FOR_NON_DATA_PKT);
		ah->sw_mgmt_crypto = true;
	} else
		ah->sw_mgmt_crypto = true;

2278 2279 2280 2281 2282 2283 2284 2285
	if (IS_CHAN_OFDM(chan) || IS_CHAN_HT(chan))
		ath9k_hw_set_delta_slope(ah, chan);

	if (AR_SREV_9280_10_OR_LATER(ah))
		ath9k_hw_9280_spur_mitigate(ah, chan);
	else
		ath9k_hw_spur_mitigate(ah, chan);

2286
	ah->eep_ops->set_board_values(ah, chan);
2287 2288 2289

	ath9k_hw_decrease_chain_power(ah, chan);

S
Sujith 已提交
2290 2291
	REG_WRITE(ah, AR_STA_ID0, get_unaligned_le32(ah->macaddr));
	REG_WRITE(ah, AR_STA_ID1, get_unaligned_le16(ah->macaddr + 4)
2292 2293
		  | macStaId1
		  | AR_STA_ID1_RTS_USE_DEF
2294
		  | (ah->config.
2295
		     ack_6mb ? AR_STA_ID1_ACKCTS_6MB : 0)
2296 2297
		  | ah->sta_id1_defaults);
	ath9k_hw_set_operating_mode(ah, ah->opmode);
2298

S
Sujith 已提交
2299 2300
	REG_WRITE(ah, AR_BSSMSKL, get_unaligned_le32(sc->bssidmask));
	REG_WRITE(ah, AR_BSSMSKU, get_unaligned_le16(sc->bssidmask + 4));
2301 2302 2303

	REG_WRITE(ah, AR_DEF_ANTENNA, saveDefAntenna);

S
Sujith 已提交
2304 2305 2306
	REG_WRITE(ah, AR_BSS_ID0, get_unaligned_le32(sc->curbssid));
	REG_WRITE(ah, AR_BSS_ID1, get_unaligned_le16(sc->curbssid + 4) |
		  ((sc->curaid & 0x3fff) << AR_BSS_ID1_AID_S));
2307 2308 2309 2310 2311

	REG_WRITE(ah, AR_ISR, ~0);

	REG_WRITE(ah, AR_RSSI_THR, INIT_RSSI_THR);

2312 2313 2314
	if (AR_SREV_9280_10_OR_LATER(ah))
		ath9k_hw_ar9280_set_channel(ah, chan);
	else
2315 2316
		if (!(ath9k_hw_set_channel(ah, chan)))
			return -EIO;
2317 2318 2319 2320

	for (i = 0; i < AR_NUM_DCU; i++)
		REG_WRITE(ah, AR_DQCUMASK(i), 1 << i);

2321 2322
	ah->intr_txqs = 0;
	for (i = 0; i < ah->caps.total_queues; i++)
2323 2324
		ath9k_hw_resettxqueue(ah, i);

2325
	ath9k_hw_init_interrupt_masks(ah, ah->opmode);
2326 2327
	ath9k_hw_init_qos(ah);

2328
	if (ah->caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
2329
		ath9k_enable_rfkill(ah);
J
Johannes Berg 已提交
2330

2331 2332 2333 2334 2335 2336 2337 2338 2339
	ath9k_hw_init_user_settings(ah);

	REG_WRITE(ah, AR_STA_ID1,
		  REG_READ(ah, AR_STA_ID1) | AR_STA_ID1_PRESERVE_SEQNUM);

	ath9k_hw_set_dma(ah);

	REG_WRITE(ah, AR_OBS, 8);

2340
	if (ah->config.intr_mitigation) {
2341 2342 2343 2344 2345 2346
		REG_RMW_FIELD(ah, AR_RIMT, AR_RIMT_LAST, 500);
		REG_RMW_FIELD(ah, AR_RIMT, AR_RIMT_FIRST, 2000);
	}

	ath9k_hw_init_bb(ah, chan);

2347
	if (!ath9k_hw_init_cal(ah, chan))
2348
		return -EIO;
2349

2350
	rx_chainmask = ah->rxchainmask;
2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362
	if ((rx_chainmask == 0x5) || (rx_chainmask == 0x3)) {
		REG_WRITE(ah, AR_PHY_RX_CHAINMASK, rx_chainmask);
		REG_WRITE(ah, AR_PHY_CAL_CHAINMASK, rx_chainmask);
	}

	REG_WRITE(ah, AR_CFG_LED, saveLedState | AR_CFG_SCLK_32KHZ);

	if (AR_SREV_9100(ah)) {
		u32 mask;
		mask = REG_READ(ah, AR_CFG);
		if (mask & (AR_CFG_SWRB | AR_CFG_SWTB | AR_CFG_SWRG)) {
			DPRINTF(ah->ah_sc, ATH_DBG_RESET,
S
Sujith 已提交
2363
				"CFG Byte Swap Set 0x%x\n", mask);
2364 2365 2366 2367 2368
		} else {
			mask =
				INIT_CONFIG_STATUS | AR_CFG_SWRB | AR_CFG_SWTB;
			REG_WRITE(ah, AR_CFG, mask);
			DPRINTF(ah->ah_sc, ATH_DBG_RESET,
S
Sujith 已提交
2369
				"Setting CFG 0x%x\n", REG_READ(ah, AR_CFG));
2370 2371 2372 2373 2374 2375 2376
		}
	} else {
#ifdef __BIG_ENDIAN
		REG_WRITE(ah, AR_CFG, AR_CFG_SWTD | AR_CFG_SWRD);
#endif
	}

2377
	return 0;
2378 2379
}

S
Sujith 已提交
2380 2381 2382
/************************/
/* Key Cache Management */
/************************/
2383

2384
bool ath9k_hw_keyreset(struct ath_hw *ah, u16 entry)
2385
{
S
Sujith 已提交
2386
	u32 keyType;
2387

2388
	if (entry >= ah->caps.keycache_size) {
S
Sujith 已提交
2389 2390
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"keychache entry %u out of range\n", entry);
2391 2392 2393
		return false;
	}

S
Sujith 已提交
2394
	keyType = REG_READ(ah, AR_KEYTABLE_TYPE(entry));
2395

S
Sujith 已提交
2396 2397 2398 2399 2400 2401 2402 2403
	REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), 0);
	REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), 0);
	REG_WRITE(ah, AR_KEYTABLE_KEY2(entry), 0);
	REG_WRITE(ah, AR_KEYTABLE_KEY3(entry), 0);
	REG_WRITE(ah, AR_KEYTABLE_KEY4(entry), 0);
	REG_WRITE(ah, AR_KEYTABLE_TYPE(entry), AR_KEYTABLE_TYPE_CLR);
	REG_WRITE(ah, AR_KEYTABLE_MAC0(entry), 0);
	REG_WRITE(ah, AR_KEYTABLE_MAC1(entry), 0);
2404

S
Sujith 已提交
2405 2406
	if (keyType == AR_KEYTABLE_TYPE_TKIP && ATH9K_IS_MIC_ENABLED(ah)) {
		u16 micentry = entry + 64;
2407

S
Sujith 已提交
2408 2409 2410 2411
		REG_WRITE(ah, AR_KEYTABLE_KEY0(micentry), 0);
		REG_WRITE(ah, AR_KEYTABLE_KEY1(micentry), 0);
		REG_WRITE(ah, AR_KEYTABLE_KEY2(micentry), 0);
		REG_WRITE(ah, AR_KEYTABLE_KEY3(micentry), 0);
2412 2413 2414

	}

2415
	if (ah->curchan == NULL)
S
Sujith 已提交
2416
		return true;
2417 2418 2419 2420

	return true;
}

2421
bool ath9k_hw_keysetmac(struct ath_hw *ah, u16 entry, const u8 *mac)
2422
{
S
Sujith 已提交
2423
	u32 macHi, macLo;
2424

2425
	if (entry >= ah->caps.keycache_size) {
S
Sujith 已提交
2426 2427
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"keychache entry %u out of range\n", entry);
S
Sujith 已提交
2428
		return false;
2429 2430
	}

S
Sujith 已提交
2431 2432 2433 2434 2435 2436 2437 2438 2439
	if (mac != NULL) {
		macHi = (mac[5] << 8) | mac[4];
		macLo = (mac[3] << 24) |
			(mac[2] << 16) |
			(mac[1] << 8) |
			mac[0];
		macLo >>= 1;
		macLo |= (macHi & 1) << 31;
		macHi >>= 1;
2440
	} else {
S
Sujith 已提交
2441
		macLo = macHi = 0;
2442
	}
S
Sujith 已提交
2443 2444
	REG_WRITE(ah, AR_KEYTABLE_MAC0(entry), macLo);
	REG_WRITE(ah, AR_KEYTABLE_MAC1(entry), macHi | AR_KEYTABLE_VALID);
2445

S
Sujith 已提交
2446
	return true;
2447 2448
}

2449
bool ath9k_hw_set_keycache_entry(struct ath_hw *ah, u16 entry,
S
Sujith 已提交
2450
				 const struct ath9k_keyval *k,
J
Jouni Malinen 已提交
2451
				 const u8 *mac)
2452
{
2453
	const struct ath9k_hw_capabilities *pCap = &ah->caps;
S
Sujith 已提交
2454 2455
	u32 key0, key1, key2, key3, key4;
	u32 keyType;
2456

S
Sujith 已提交
2457
	if (entry >= pCap->keycache_size) {
S
Sujith 已提交
2458 2459
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"keycache entry %u out of range\n", entry);
S
Sujith 已提交
2460
		return false;
2461 2462
	}

S
Sujith 已提交
2463 2464 2465 2466 2467 2468
	switch (k->kv_type) {
	case ATH9K_CIPHER_AES_OCB:
		keyType = AR_KEYTABLE_TYPE_AES;
		break;
	case ATH9K_CIPHER_AES_CCM:
		if (!(pCap->hw_caps & ATH9K_HW_CAP_CIPHER_AESCCM)) {
S
Sujith 已提交
2469
			DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
2470
				"AES-CCM not supported by mac rev 0x%x\n",
2471
				ah->hw_version.macRev);
S
Sujith 已提交
2472 2473 2474 2475 2476 2477 2478 2479
			return false;
		}
		keyType = AR_KEYTABLE_TYPE_CCM;
		break;
	case ATH9K_CIPHER_TKIP:
		keyType = AR_KEYTABLE_TYPE_TKIP;
		if (ATH9K_IS_MIC_ENABLED(ah)
		    && entry + 64 >= pCap->keycache_size) {
S
Sujith 已提交
2480
			DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
2481
				"entry %u inappropriate for TKIP\n", entry);
S
Sujith 已提交
2482 2483 2484 2485
			return false;
		}
		break;
	case ATH9K_CIPHER_WEP:
2486
		if (k->kv_len < WLAN_KEY_LEN_WEP40) {
S
Sujith 已提交
2487
			DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
2488
				"WEP key length %u too small\n", k->kv_len);
S
Sujith 已提交
2489 2490
			return false;
		}
2491
		if (k->kv_len <= WLAN_KEY_LEN_WEP40)
S
Sujith 已提交
2492
			keyType = AR_KEYTABLE_TYPE_40;
2493
		else if (k->kv_len <= WLAN_KEY_LEN_WEP104)
S
Sujith 已提交
2494 2495 2496 2497 2498 2499 2500 2501
			keyType = AR_KEYTABLE_TYPE_104;
		else
			keyType = AR_KEYTABLE_TYPE_128;
		break;
	case ATH9K_CIPHER_CLR:
		keyType = AR_KEYTABLE_TYPE_CLR;
		break;
	default:
S
Sujith 已提交
2502
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
2503
			"cipher %u not supported\n", k->kv_type);
S
Sujith 已提交
2504
		return false;
2505 2506
	}

J
Jouni Malinen 已提交
2507 2508 2509 2510 2511
	key0 = get_unaligned_le32(k->kv_val + 0);
	key1 = get_unaligned_le16(k->kv_val + 4);
	key2 = get_unaligned_le32(k->kv_val + 6);
	key3 = get_unaligned_le16(k->kv_val + 10);
	key4 = get_unaligned_le32(k->kv_val + 12);
2512
	if (k->kv_len <= WLAN_KEY_LEN_WEP104)
S
Sujith 已提交
2513
		key4 &= 0xff;
2514

2515 2516 2517 2518 2519 2520 2521
	/*
	 * Note: Key cache registers access special memory area that requires
	 * two 32-bit writes to actually update the values in the internal
	 * memory. Consequently, the exact order and pairs used here must be
	 * maintained.
	 */

S
Sujith 已提交
2522 2523
	if (keyType == AR_KEYTABLE_TYPE_TKIP && ATH9K_IS_MIC_ENABLED(ah)) {
		u16 micentry = entry + 64;
2524

2525 2526 2527 2528 2529 2530
		/*
		 * Write inverted key[47:0] first to avoid Michael MIC errors
		 * on frames that could be sent or received at the same time.
		 * The correct key will be written in the end once everything
		 * else is ready.
		 */
S
Sujith 已提交
2531 2532
		REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), ~key0);
		REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), ~key1);
2533 2534

		/* Write key[95:48] */
S
Sujith 已提交
2535 2536
		REG_WRITE(ah, AR_KEYTABLE_KEY2(entry), key2);
		REG_WRITE(ah, AR_KEYTABLE_KEY3(entry), key3);
2537 2538

		/* Write key[127:96] and key type */
S
Sujith 已提交
2539 2540
		REG_WRITE(ah, AR_KEYTABLE_KEY4(entry), key4);
		REG_WRITE(ah, AR_KEYTABLE_TYPE(entry), keyType);
2541 2542

		/* Write MAC address for the entry */
S
Sujith 已提交
2543
		(void) ath9k_hw_keysetmac(ah, entry, mac);
2544

2545
		if (ah->misc_mode & AR_PCU_MIC_NEW_LOC_ENA) {
2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557
			/*
			 * TKIP uses two key cache entries:
			 * Michael MIC TX/RX keys in the same key cache entry
			 * (idx = main index + 64):
			 * key0 [31:0] = RX key [31:0]
			 * key1 [15:0] = TX key [31:16]
			 * key1 [31:16] = reserved
			 * key2 [31:0] = RX key [63:32]
			 * key3 [15:0] = TX key [15:0]
			 * key3 [31:16] = reserved
			 * key4 [31:0] = TX key [63:32]
			 */
S
Sujith 已提交
2558
			u32 mic0, mic1, mic2, mic3, mic4;
2559

S
Sujith 已提交
2560 2561 2562 2563 2564
			mic0 = get_unaligned_le32(k->kv_mic + 0);
			mic2 = get_unaligned_le32(k->kv_mic + 4);
			mic1 = get_unaligned_le16(k->kv_txmic + 2) & 0xffff;
			mic3 = get_unaligned_le16(k->kv_txmic + 0) & 0xffff;
			mic4 = get_unaligned_le32(k->kv_txmic + 4);
2565 2566

			/* Write RX[31:0] and TX[31:16] */
S
Sujith 已提交
2567 2568
			REG_WRITE(ah, AR_KEYTABLE_KEY0(micentry), mic0);
			REG_WRITE(ah, AR_KEYTABLE_KEY1(micentry), mic1);
2569 2570

			/* Write RX[63:32] and TX[15:0] */
S
Sujith 已提交
2571 2572
			REG_WRITE(ah, AR_KEYTABLE_KEY2(micentry), mic2);
			REG_WRITE(ah, AR_KEYTABLE_KEY3(micentry), mic3);
2573 2574

			/* Write TX[63:32] and keyType(reserved) */
S
Sujith 已提交
2575 2576 2577
			REG_WRITE(ah, AR_KEYTABLE_KEY4(micentry), mic4);
			REG_WRITE(ah, AR_KEYTABLE_TYPE(micentry),
				  AR_KEYTABLE_TYPE_CLR);
2578

S
Sujith 已提交
2579
		} else {
2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595
			/*
			 * TKIP uses four key cache entries (two for group
			 * keys):
			 * Michael MIC TX/RX keys are in different key cache
			 * entries (idx = main index + 64 for TX and
			 * main index + 32 + 96 for RX):
			 * key0 [31:0] = TX/RX MIC key [31:0]
			 * key1 [31:0] = reserved
			 * key2 [31:0] = TX/RX MIC key [63:32]
			 * key3 [31:0] = reserved
			 * key4 [31:0] = reserved
			 *
			 * Upper layer code will call this function separately
			 * for TX and RX keys when these registers offsets are
			 * used.
			 */
S
Sujith 已提交
2596
			u32 mic0, mic2;
2597

S
Sujith 已提交
2598 2599
			mic0 = get_unaligned_le32(k->kv_mic + 0);
			mic2 = get_unaligned_le32(k->kv_mic + 4);
2600 2601

			/* Write MIC key[31:0] */
S
Sujith 已提交
2602 2603
			REG_WRITE(ah, AR_KEYTABLE_KEY0(micentry), mic0);
			REG_WRITE(ah, AR_KEYTABLE_KEY1(micentry), 0);
2604 2605

			/* Write MIC key[63:32] */
S
Sujith 已提交
2606 2607
			REG_WRITE(ah, AR_KEYTABLE_KEY2(micentry), mic2);
			REG_WRITE(ah, AR_KEYTABLE_KEY3(micentry), 0);
2608 2609

			/* Write TX[63:32] and keyType(reserved) */
S
Sujith 已提交
2610 2611 2612 2613
			REG_WRITE(ah, AR_KEYTABLE_KEY4(micentry), 0);
			REG_WRITE(ah, AR_KEYTABLE_TYPE(micentry),
				  AR_KEYTABLE_TYPE_CLR);
		}
2614 2615

		/* MAC address registers are reserved for the MIC entry */
S
Sujith 已提交
2616 2617
		REG_WRITE(ah, AR_KEYTABLE_MAC0(micentry), 0);
		REG_WRITE(ah, AR_KEYTABLE_MAC1(micentry), 0);
2618 2619 2620 2621 2622 2623

		/*
		 * Write the correct (un-inverted) key[47:0] last to enable
		 * TKIP now that all other registers are set with correct
		 * values.
		 */
S
Sujith 已提交
2624 2625 2626
		REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), key0);
		REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), key1);
	} else {
2627
		/* Write key[47:0] */
S
Sujith 已提交
2628 2629
		REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), key0);
		REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), key1);
2630 2631

		/* Write key[95:48] */
S
Sujith 已提交
2632 2633
		REG_WRITE(ah, AR_KEYTABLE_KEY2(entry), key2);
		REG_WRITE(ah, AR_KEYTABLE_KEY3(entry), key3);
2634 2635

		/* Write key[127:96] and key type */
S
Sujith 已提交
2636 2637
		REG_WRITE(ah, AR_KEYTABLE_KEY4(entry), key4);
		REG_WRITE(ah, AR_KEYTABLE_TYPE(entry), keyType);
2638

2639
		/* Write MAC address for the entry */
S
Sujith 已提交
2640 2641
		(void) ath9k_hw_keysetmac(ah, entry, mac);
	}
2642 2643 2644 2645

	return true;
}

2646
bool ath9k_hw_keyisvalid(struct ath_hw *ah, u16 entry)
2647
{
2648
	if (entry < ah->caps.keycache_size) {
S
Sujith 已提交
2649 2650 2651 2652 2653
		u32 val = REG_READ(ah, AR_KEYTABLE_MAC1(entry));
		if (val & AR_KEYTABLE_VALID)
			return true;
	}
	return false;
2654 2655
}

S
Sujith 已提交
2656 2657 2658 2659
/******************************/
/* Power Management (Chipset) */
/******************************/

2660
static void ath9k_set_power_sleep(struct ath_hw *ah, int setChip)
2661
{
S
Sujith 已提交
2662 2663 2664 2665 2666 2667
	REG_SET_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SAV);
	if (setChip) {
		REG_CLR_BIT(ah, AR_RTC_FORCE_WAKE,
			    AR_RTC_FORCE_WAKE_EN);
		if (!AR_SREV_9100(ah))
			REG_WRITE(ah, AR_RC, AR_RC_AHB | AR_RC_HOSTIF);
2668

2669
		REG_CLR_BIT(ah, (AR_RTC_RESET),
S
Sujith 已提交
2670 2671
			    AR_RTC_RESET_EN);
	}
2672 2673
}

2674
static void ath9k_set_power_network_sleep(struct ath_hw *ah, int setChip)
2675
{
S
Sujith 已提交
2676 2677
	REG_SET_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SAV);
	if (setChip) {
2678
		struct ath9k_hw_capabilities *pCap = &ah->caps;
2679

S
Sujith 已提交
2680 2681 2682 2683 2684 2685
		if (!(pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
			REG_WRITE(ah, AR_RTC_FORCE_WAKE,
				  AR_RTC_FORCE_WAKE_ON_INT);
		} else {
			REG_CLR_BIT(ah, AR_RTC_FORCE_WAKE,
				    AR_RTC_FORCE_WAKE_EN);
2686 2687 2688 2689
		}
	}
}

2690
static bool ath9k_hw_set_power_awake(struct ath_hw *ah, int setChip)
2691
{
S
Sujith 已提交
2692 2693
	u32 val;
	int i;
2694

S
Sujith 已提交
2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705
	if (setChip) {
		if ((REG_READ(ah, AR_RTC_STATUS) &
		     AR_RTC_STATUS_M) == AR_RTC_STATUS_SHUTDOWN) {
			if (ath9k_hw_set_reset_reg(ah,
					   ATH9K_RESET_POWER_ON) != true) {
				return false;
			}
		}
		if (AR_SREV_9100(ah))
			REG_SET_BIT(ah, AR_RTC_RESET,
				    AR_RTC_RESET_EN);
2706

S
Sujith 已提交
2707 2708 2709
		REG_SET_BIT(ah, AR_RTC_FORCE_WAKE,
			    AR_RTC_FORCE_WAKE_EN);
		udelay(50);
2710

S
Sujith 已提交
2711 2712 2713 2714 2715 2716 2717
		for (i = POWER_UP_TIME / 50; i > 0; i--) {
			val = REG_READ(ah, AR_RTC_STATUS) & AR_RTC_STATUS_M;
			if (val == AR_RTC_STATUS_ON)
				break;
			udelay(50);
			REG_SET_BIT(ah, AR_RTC_FORCE_WAKE,
				    AR_RTC_FORCE_WAKE_EN);
2718
		}
S
Sujith 已提交
2719
		if (i == 0) {
S
Sujith 已提交
2720
			DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
2721
				"Failed to wakeup in %uus\n", POWER_UP_TIME / 20);
S
Sujith 已提交
2722
			return false;
2723 2724 2725
		}
	}

S
Sujith 已提交
2726
	REG_CLR_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SAV);
2727

S
Sujith 已提交
2728
	return true;
2729 2730
}

2731 2732
static bool ath9k_hw_setpower_nolock(struct ath_hw *ah,
				     enum ath9k_power_mode mode)
2733
{
2734
	int status = true, setChip = true;
S
Sujith 已提交
2735 2736 2737 2738 2739 2740 2741
	static const char *modes[] = {
		"AWAKE",
		"FULL-SLEEP",
		"NETWORK SLEEP",
		"UNDEFINED"
	};

S
Sujith 已提交
2742 2743
	DPRINTF(ah->ah_sc, ATH_DBG_RESET, "%s -> %s\n",
		modes[ah->power_mode], modes[mode]);
S
Sujith 已提交
2744 2745 2746 2747 2748 2749 2750

	switch (mode) {
	case ATH9K_PM_AWAKE:
		status = ath9k_hw_set_power_awake(ah, setChip);
		break;
	case ATH9K_PM_FULL_SLEEP:
		ath9k_set_power_sleep(ah, setChip);
2751
		ah->chip_fullsleep = true;
S
Sujith 已提交
2752 2753 2754 2755
		break;
	case ATH9K_PM_NETWORK_SLEEP:
		ath9k_set_power_network_sleep(ah, setChip);
		break;
2756
	default:
S
Sujith 已提交
2757
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
2758
			"Unknown power mode %u\n", mode);
2759 2760
		return false;
	}
2761
	ah->power_mode = mode;
S
Sujith 已提交
2762 2763

	return status;
2764 2765
}

2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777
bool ath9k_hw_setpower(struct ath_hw *ah, enum ath9k_power_mode mode)
{
	unsigned long flags;
	bool ret;

	spin_lock_irqsave(&ah->ah_sc->sc_pm_lock, flags);
	ret = ath9k_hw_setpower_nolock(ah, mode);
	spin_unlock_irqrestore(&ah->ah_sc->sc_pm_lock, flags);

	return ret;
}

2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798
void ath9k_ps_wakeup(struct ath_softc *sc)
{
	if (atomic_inc_return(&sc->ps_usecount) == 1)
		if (sc->sc_ah->power_mode != ATH9K_PM_AWAKE) {
			sc->sc_ah->restore_mode = sc->sc_ah->power_mode;
			ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
		}
}

void ath9k_ps_restore(struct ath_softc *sc)
{
	if (atomic_dec_and_test(&sc->ps_usecount))
		if ((sc->hw->conf.flags & IEEE80211_CONF_PS) &&
		    !(sc->sc_flags & (SC_OP_WAIT_FOR_BEACON |
				      SC_OP_WAIT_FOR_CAB |
				      SC_OP_WAIT_FOR_PSPOLL_DATA |
				      SC_OP_WAIT_FOR_TX_ACK)))
			ath9k_hw_setpower(sc->sc_ah,
					  sc->sc_ah->restore_mode);
}

2799 2800 2801 2802 2803 2804 2805 2806 2807
/*
 * Helper for ASPM support.
 *
 * Disable PLL when in L0s as well as receiver clock when in L1.
 * This power saving option must be enabled through the SerDes.
 *
 * Programming the SerDes must go through the same 288 bit serial shift
 * register as the other analog registers.  Hence the 9 writes.
 */
2808
void ath9k_hw_configpcipowersave(struct ath_hw *ah, int restore)
2809
{
S
Sujith 已提交
2810
	u8 i;
2811

2812
	if (ah->is_pciexpress != true)
S
Sujith 已提交
2813
		return;
2814

2815
	/* Do not touch SerDes registers */
2816
	if (ah->config.pcie_powersave_enable == 2)
S
Sujith 已提交
2817 2818
		return;

2819
	/* Nothing to do on restore for 11N */
S
Sujith 已提交
2820 2821 2822 2823
	if (restore)
		return;

	if (AR_SREV_9280_20_OR_LATER(ah)) {
2824 2825 2826 2827 2828
		/*
		 * AR9280 2.0 or later chips use SerDes values from the
		 * initvals.h initialized depending on chipset during
		 * ath9k_hw_do_attach()
		 */
2829 2830 2831
		for (i = 0; i < ah->iniPcieSerdes.ia_rows; i++) {
			REG_WRITE(ah, INI_RA(&ah->iniPcieSerdes, i, 0),
				  INI_RA(&ah->iniPcieSerdes, i, 1));
2832
		}
S
Sujith 已提交
2833
	} else if (AR_SREV_9280(ah) &&
2834
		   (ah->hw_version.macRev == AR_SREV_REVISION_9280_10)) {
S
Sujith 已提交
2835 2836 2837
		REG_WRITE(ah, AR_PCIE_SERDES, 0x9248fd00);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x24924924);

2838
		/* RX shut off when elecidle is asserted */
S
Sujith 已提交
2839 2840 2841 2842
		REG_WRITE(ah, AR_PCIE_SERDES, 0xa8000019);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x13160820);
		REG_WRITE(ah, AR_PCIE_SERDES, 0xe5980560);

2843
		/* Shut off CLKREQ active in L1 */
2844
		if (ah->config.pcie_clock_req)
S
Sujith 已提交
2845 2846 2847 2848 2849 2850 2851 2852
			REG_WRITE(ah, AR_PCIE_SERDES, 0x401deffc);
		else
			REG_WRITE(ah, AR_PCIE_SERDES, 0x401deffd);

		REG_WRITE(ah, AR_PCIE_SERDES, 0x1aaabe40);
		REG_WRITE(ah, AR_PCIE_SERDES, 0xbe105554);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x00043007);

2853
		/* Load the new settings */
S
Sujith 已提交
2854 2855 2856 2857 2858
		REG_WRITE(ah, AR_PCIE_SERDES2, 0x00000000);

	} else {
		REG_WRITE(ah, AR_PCIE_SERDES, 0x9248fc00);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x24924924);
2859 2860

		/* RX shut off when elecidle is asserted */
S
Sujith 已提交
2861 2862 2863
		REG_WRITE(ah, AR_PCIE_SERDES, 0x28000039);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x53160824);
		REG_WRITE(ah, AR_PCIE_SERDES, 0xe5980579);
2864 2865 2866 2867 2868

		/*
		 * Ignore ah->ah_config.pcie_clock_req setting for
		 * pre-AR9280 11n
		 */
S
Sujith 已提交
2869
		REG_WRITE(ah, AR_PCIE_SERDES, 0x001defff);
2870

S
Sujith 已提交
2871 2872 2873
		REG_WRITE(ah, AR_PCIE_SERDES, 0x1aaabe40);
		REG_WRITE(ah, AR_PCIE_SERDES, 0xbe105554);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x000e3007);
2874 2875

		/* Load the new settings */
S
Sujith 已提交
2876
		REG_WRITE(ah, AR_PCIE_SERDES2, 0x00000000);
2877 2878
	}

2879 2880
	udelay(1000);

2881
	/* set bit 19 to allow forcing of pcie core into L1 state */
S
Sujith 已提交
2882 2883
	REG_SET_BIT(ah, AR_PCIE_PM_CTRL, AR_PCIE_PM_CTRL_ENA);

2884
	/* Several PCIe massages to ensure proper behaviour */
2885 2886
	if (ah->config.pcie_waen) {
		REG_WRITE(ah, AR_WA, ah->config.pcie_waen);
S
Sujith 已提交
2887
	} else {
2888 2889
		if (AR_SREV_9285(ah))
			REG_WRITE(ah, AR_WA, AR9285_WA_DEFAULT);
2890 2891 2892 2893
		/*
		 * On AR9280 chips bit 22 of 0x4004 needs to be set to
		 * otherwise card may disappear.
		 */
2894 2895
		else if (AR_SREV_9280(ah))
			REG_WRITE(ah, AR_WA, AR9280_WA_DEFAULT);
S
Sujith 已提交
2896
		else
2897
			REG_WRITE(ah, AR_WA, AR_WA_DEFAULT);
S
Sujith 已提交
2898
	}
2899 2900
}

S
Sujith 已提交
2901 2902 2903 2904
/**********************/
/* Interrupt Handling */
/**********************/

2905
bool ath9k_hw_intrpend(struct ath_hw *ah)
2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923
{
	u32 host_isr;

	if (AR_SREV_9100(ah))
		return true;

	host_isr = REG_READ(ah, AR_INTR_ASYNC_CAUSE);
	if ((host_isr & AR_INTR_MAC_IRQ) && (host_isr != AR_INTR_SPURIOUS))
		return true;

	host_isr = REG_READ(ah, AR_INTR_SYNC_CAUSE);
	if ((host_isr & AR_INTR_SYNC_DEFAULT)
	    && (host_isr != AR_INTR_SPURIOUS))
		return true;

	return false;
}

2924
bool ath9k_hw_getisr(struct ath_hw *ah, enum ath9k_int *masked)
2925 2926 2927
{
	u32 isr = 0;
	u32 mask2 = 0;
2928
	struct ath9k_hw_capabilities *pCap = &ah->caps;
2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939
	u32 sync_cause = 0;
	bool fatal_int = false;

	if (!AR_SREV_9100(ah)) {
		if (REG_READ(ah, AR_INTR_ASYNC_CAUSE) & AR_INTR_MAC_IRQ) {
			if ((REG_READ(ah, AR_RTC_STATUS) & AR_RTC_STATUS_M)
			    == AR_RTC_STATUS_ON) {
				isr = REG_READ(ah, AR_ISR);
			}
		}

S
Sujith 已提交
2940 2941
		sync_cause = REG_READ(ah, AR_INTR_SYNC_CAUSE) &
			AR_INTR_SYNC_DEFAULT;
2942 2943 2944 2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967

		*masked = 0;

		if (!isr && !sync_cause)
			return false;
	} else {
		*masked = 0;
		isr = REG_READ(ah, AR_ISR);
	}

	if (isr) {
		if (isr & AR_ISR_BCNMISC) {
			u32 isr2;
			isr2 = REG_READ(ah, AR_ISR_S2);
			if (isr2 & AR_ISR_S2_TIM)
				mask2 |= ATH9K_INT_TIM;
			if (isr2 & AR_ISR_S2_DTIM)
				mask2 |= ATH9K_INT_DTIM;
			if (isr2 & AR_ISR_S2_DTIMSYNC)
				mask2 |= ATH9K_INT_DTIMSYNC;
			if (isr2 & (AR_ISR_S2_CABEND))
				mask2 |= ATH9K_INT_CABEND;
			if (isr2 & AR_ISR_S2_GTT)
				mask2 |= ATH9K_INT_GTT;
			if (isr2 & AR_ISR_S2_CST)
				mask2 |= ATH9K_INT_CST;
2968 2969
			if (isr2 & AR_ISR_S2_TSFOOR)
				mask2 |= ATH9K_INT_TSFOOR;
2970 2971 2972 2973 2974 2975 2976 2977 2978 2979
		}

		isr = REG_READ(ah, AR_ISR_RAC);
		if (isr == 0xffffffff) {
			*masked = 0;
			return false;
		}

		*masked = isr & ATH9K_INT_COMMON;

2980
		if (ah->config.intr_mitigation) {
2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994
			if (isr & (AR_ISR_RXMINTR | AR_ISR_RXINTM))
				*masked |= ATH9K_INT_RX;
		}

		if (isr & (AR_ISR_RXOK | AR_ISR_RXERR))
			*masked |= ATH9K_INT_RX;
		if (isr &
		    (AR_ISR_TXOK | AR_ISR_TXDESC | AR_ISR_TXERR |
		     AR_ISR_TXEOL)) {
			u32 s0_s, s1_s;

			*masked |= ATH9K_INT_TX;

			s0_s = REG_READ(ah, AR_ISR_S0_S);
2995 2996
			ah->intr_txqs |= MS(s0_s, AR_ISR_S0_QCU_TXOK);
			ah->intr_txqs |= MS(s0_s, AR_ISR_S0_QCU_TXDESC);
2997 2998

			s1_s = REG_READ(ah, AR_ISR_S1_S);
2999 3000
			ah->intr_txqs |= MS(s1_s, AR_ISR_S1_QCU_TXERR);
			ah->intr_txqs |= MS(s1_s, AR_ISR_S1_QCU_TXEOL);
3001 3002 3003 3004
		}

		if (isr & AR_ISR_RXORN) {
			DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT,
S
Sujith 已提交
3005
				"receive FIFO overrun interrupt\n");
3006 3007 3008
		}

		if (!AR_SREV_9100(ah)) {
3009
			if (!(pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
3010 3011 3012 3013 3014 3015 3016 3017
				u32 isr5 = REG_READ(ah, AR_ISR_S5_S);
				if (isr5 & AR_ISR_S5_TIM_TIMER)
					*masked |= ATH9K_INT_TIM_TIMER;
			}
		}

		*masked |= mask2;
	}
S
Sujith 已提交
3018

3019 3020
	if (AR_SREV_9100(ah))
		return true;
S
Sujith 已提交
3021

3022 3023 3024 3025 3026 3027 3028 3029 3030
	if (sync_cause) {
		fatal_int =
			(sync_cause &
			 (AR_INTR_SYNC_HOST1_FATAL | AR_INTR_SYNC_HOST1_PERR))
			? true : false;

		if (fatal_int) {
			if (sync_cause & AR_INTR_SYNC_HOST1_FATAL) {
				DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
3031
					"received PCI FATAL interrupt\n");
3032 3033 3034
			}
			if (sync_cause & AR_INTR_SYNC_HOST1_PERR) {
				DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
3035
					"received PCI PERR interrupt\n");
3036
			}
3037
			*masked |= ATH9K_INT_FATAL;
3038 3039 3040
		}
		if (sync_cause & AR_INTR_SYNC_RADM_CPL_TIMEOUT) {
			DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT,
S
Sujith 已提交
3041
				"AR_INTR_SYNC_RADM_CPL_TIMEOUT\n");
3042 3043 3044 3045 3046 3047
			REG_WRITE(ah, AR_RC, AR_RC_HOSTIF);
			REG_WRITE(ah, AR_RC, 0);
			*masked |= ATH9K_INT_FATAL;
		}
		if (sync_cause & AR_INTR_SYNC_LOCAL_TIMEOUT) {
			DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT,
S
Sujith 已提交
3048
				"AR_INTR_SYNC_LOCAL_TIMEOUT\n");
3049 3050 3051 3052 3053
		}

		REG_WRITE(ah, AR_INTR_SYNC_CAUSE_CLR, sync_cause);
		(void) REG_READ(ah, AR_INTR_SYNC_CAUSE_CLR);
	}
S
Sujith 已提交
3054

3055 3056 3057
	return true;
}

3058
enum ath9k_int ath9k_hw_intrget(struct ath_hw *ah)
3059
{
3060
	return ah->mask_reg;
3061 3062
}

3063
enum ath9k_int ath9k_hw_set_interrupts(struct ath_hw *ah, enum ath9k_int ints)
3064
{
3065
	u32 omask = ah->mask_reg;
3066
	u32 mask, mask2;
3067
	struct ath9k_hw_capabilities *pCap = &ah->caps;
3068

S
Sujith 已提交
3069
	DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "0x%x => 0x%x\n", omask, ints);
3070 3071

	if (omask & ATH9K_INT_GLOBAL) {
S
Sujith 已提交
3072
		DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "disable IER\n");
3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087
		REG_WRITE(ah, AR_IER, AR_IER_DISABLE);
		(void) REG_READ(ah, AR_IER);
		if (!AR_SREV_9100(ah)) {
			REG_WRITE(ah, AR_INTR_ASYNC_ENABLE, 0);
			(void) REG_READ(ah, AR_INTR_ASYNC_ENABLE);

			REG_WRITE(ah, AR_INTR_SYNC_ENABLE, 0);
			(void) REG_READ(ah, AR_INTR_SYNC_ENABLE);
		}
	}

	mask = ints & ATH9K_INT_COMMON;
	mask2 = 0;

	if (ints & ATH9K_INT_TX) {
3088
		if (ah->txok_interrupt_mask)
3089
			mask |= AR_IMR_TXOK;
3090
		if (ah->txdesc_interrupt_mask)
3091
			mask |= AR_IMR_TXDESC;
3092
		if (ah->txerr_interrupt_mask)
3093
			mask |= AR_IMR_TXERR;
3094
		if (ah->txeol_interrupt_mask)
3095 3096 3097 3098
			mask |= AR_IMR_TXEOL;
	}
	if (ints & ATH9K_INT_RX) {
		mask |= AR_IMR_RXERR;
3099
		if (ah->config.intr_mitigation)
3100 3101 3102
			mask |= AR_IMR_RXMINTR | AR_IMR_RXINTM;
		else
			mask |= AR_IMR_RXOK | AR_IMR_RXDESC;
3103
		if (!(pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
3104 3105 3106 3107 3108 3109 3110 3111 3112 3113 3114 3115
			mask |= AR_IMR_GENTMR;
	}

	if (ints & (ATH9K_INT_BMISC)) {
		mask |= AR_IMR_BCNMISC;
		if (ints & ATH9K_INT_TIM)
			mask2 |= AR_IMR_S2_TIM;
		if (ints & ATH9K_INT_DTIM)
			mask2 |= AR_IMR_S2_DTIM;
		if (ints & ATH9K_INT_DTIMSYNC)
			mask2 |= AR_IMR_S2_DTIMSYNC;
		if (ints & ATH9K_INT_CABEND)
3116 3117 3118
			mask2 |= AR_IMR_S2_CABEND;
		if (ints & ATH9K_INT_TSFOOR)
			mask2 |= AR_IMR_S2_TSFOOR;
3119 3120 3121 3122 3123 3124 3125 3126 3127 3128
	}

	if (ints & (ATH9K_INT_GTT | ATH9K_INT_CST)) {
		mask |= AR_IMR_BCNMISC;
		if (ints & ATH9K_INT_GTT)
			mask2 |= AR_IMR_S2_GTT;
		if (ints & ATH9K_INT_CST)
			mask2 |= AR_IMR_S2_CST;
	}

S
Sujith 已提交
3129
	DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "new IMR 0x%x\n", mask);
3130 3131 3132 3133 3134 3135 3136 3137 3138
	REG_WRITE(ah, AR_IMR, mask);
	mask = REG_READ(ah, AR_IMR_S2) & ~(AR_IMR_S2_TIM |
					   AR_IMR_S2_DTIM |
					   AR_IMR_S2_DTIMSYNC |
					   AR_IMR_S2_CABEND |
					   AR_IMR_S2_CABTO |
					   AR_IMR_S2_TSFOOR |
					   AR_IMR_S2_GTT | AR_IMR_S2_CST);
	REG_WRITE(ah, AR_IMR_S2, mask | mask2);
3139
	ah->mask_reg = ints;
3140

3141
	if (!(pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
3142 3143 3144 3145 3146 3147 3148
		if (ints & ATH9K_INT_TIM_TIMER)
			REG_SET_BIT(ah, AR_IMR_S5, AR_IMR_S5_TIM_TIMER);
		else
			REG_CLR_BIT(ah, AR_IMR_S5, AR_IMR_S5_TIM_TIMER);
	}

	if (ints & ATH9K_INT_GLOBAL) {
S
Sujith 已提交
3149
		DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "enable IER\n");
3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168
		REG_WRITE(ah, AR_IER, AR_IER_ENABLE);
		if (!AR_SREV_9100(ah)) {
			REG_WRITE(ah, AR_INTR_ASYNC_ENABLE,
				  AR_INTR_MAC_IRQ);
			REG_WRITE(ah, AR_INTR_ASYNC_MASK, AR_INTR_MAC_IRQ);


			REG_WRITE(ah, AR_INTR_SYNC_ENABLE,
				  AR_INTR_SYNC_DEFAULT);
			REG_WRITE(ah, AR_INTR_SYNC_MASK,
				  AR_INTR_SYNC_DEFAULT);
		}
		DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "AR_IMR 0x%x IER 0x%x\n",
			 REG_READ(ah, AR_IMR), REG_READ(ah, AR_IER));
	}

	return omask;
}

S
Sujith 已提交
3169 3170 3171 3172
/*******************/
/* Beacon Handling */
/*******************/

3173
void ath9k_hw_beaconinit(struct ath_hw *ah, u32 next_beacon, u32 beacon_period)
3174 3175 3176
{
	int flags = 0;

3177
	ah->beacon_interval = beacon_period;
3178

3179
	switch (ah->opmode) {
3180 3181
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_MONITOR:
3182 3183 3184 3185 3186
		REG_WRITE(ah, AR_NEXT_TBTT_TIMER, TU_TO_USEC(next_beacon));
		REG_WRITE(ah, AR_NEXT_DMA_BEACON_ALERT, 0xffff);
		REG_WRITE(ah, AR_NEXT_SWBA, 0x7ffff);
		flags |= AR_TBTT_TIMER_EN;
		break;
3187
	case NL80211_IFTYPE_ADHOC:
3188
	case NL80211_IFTYPE_MESH_POINT:
3189 3190 3191 3192
		REG_SET_BIT(ah, AR_TXCFG,
			    AR_TXCFG_ADHOC_BEACON_ATIM_TX_POLICY);
		REG_WRITE(ah, AR_NEXT_NDP_TIMER,
			  TU_TO_USEC(next_beacon +
3193 3194
				     (ah->atim_window ? ah->
				      atim_window : 1)));
3195
		flags |= AR_NDP_TIMER_EN;
3196
	case NL80211_IFTYPE_AP:
3197 3198 3199
		REG_WRITE(ah, AR_NEXT_TBTT_TIMER, TU_TO_USEC(next_beacon));
		REG_WRITE(ah, AR_NEXT_DMA_BEACON_ALERT,
			  TU_TO_USEC(next_beacon -
3200
				     ah->config.
3201
				     dma_beacon_response_time));
3202 3203
		REG_WRITE(ah, AR_NEXT_SWBA,
			  TU_TO_USEC(next_beacon -
3204
				     ah->config.
3205
				     sw_beacon_response_time));
3206 3207 3208
		flags |=
			AR_TBTT_TIMER_EN | AR_DBA_TIMER_EN | AR_SWBA_TIMER_EN;
		break;
3209 3210 3211
	default:
		DPRINTF(ah->ah_sc, ATH_DBG_BEACON,
			"%s: unsupported opmode: %d\n",
3212
			__func__, ah->opmode);
3213 3214
		return;
		break;
3215 3216 3217 3218 3219 3220 3221 3222 3223 3224 3225 3226 3227 3228 3229 3230
	}

	REG_WRITE(ah, AR_BEACON_PERIOD, TU_TO_USEC(beacon_period));
	REG_WRITE(ah, AR_DMA_BEACON_PERIOD, TU_TO_USEC(beacon_period));
	REG_WRITE(ah, AR_SWBA_PERIOD, TU_TO_USEC(beacon_period));
	REG_WRITE(ah, AR_NDP_PERIOD, TU_TO_USEC(beacon_period));

	beacon_period &= ~ATH9K_BEACON_ENA;
	if (beacon_period & ATH9K_BEACON_RESET_TSF) {
		beacon_period &= ~ATH9K_BEACON_RESET_TSF;
		ath9k_hw_reset_tsf(ah);
	}

	REG_SET_BIT(ah, AR_TIMER_MODE, flags);
}

3231
void ath9k_hw_set_sta_beacon_timers(struct ath_hw *ah,
S
Sujith 已提交
3232
				    const struct ath9k_beacon_state *bs)
3233 3234
{
	u32 nextTbtt, beaconintval, dtimperiod, beacontimeout;
3235
	struct ath9k_hw_capabilities *pCap = &ah->caps;
3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260

	REG_WRITE(ah, AR_NEXT_TBTT_TIMER, TU_TO_USEC(bs->bs_nexttbtt));

	REG_WRITE(ah, AR_BEACON_PERIOD,
		  TU_TO_USEC(bs->bs_intval & ATH9K_BEACON_PERIOD));
	REG_WRITE(ah, AR_DMA_BEACON_PERIOD,
		  TU_TO_USEC(bs->bs_intval & ATH9K_BEACON_PERIOD));

	REG_RMW_FIELD(ah, AR_RSSI_THR,
		      AR_RSSI_THR_BM_THR, bs->bs_bmissthreshold);

	beaconintval = bs->bs_intval & ATH9K_BEACON_PERIOD;

	if (bs->bs_sleepduration > beaconintval)
		beaconintval = bs->bs_sleepduration;

	dtimperiod = bs->bs_dtimperiod;
	if (bs->bs_sleepduration > dtimperiod)
		dtimperiod = bs->bs_sleepduration;

	if (beaconintval == dtimperiod)
		nextTbtt = bs->bs_nextdtim;
	else
		nextTbtt = bs->bs_nexttbtt;

S
Sujith 已提交
3261 3262 3263 3264
	DPRINTF(ah->ah_sc, ATH_DBG_BEACON, "next DTIM %d\n", bs->bs_nextdtim);
	DPRINTF(ah->ah_sc, ATH_DBG_BEACON, "next beacon %d\n", nextTbtt);
	DPRINTF(ah->ah_sc, ATH_DBG_BEACON, "beacon period %d\n", beaconintval);
	DPRINTF(ah->ah_sc, ATH_DBG_BEACON, "DTIM period %d\n", dtimperiod);
3265

S
Sujith 已提交
3266 3267 3268
	REG_WRITE(ah, AR_NEXT_DTIM,
		  TU_TO_USEC(bs->bs_nextdtim - SLEEP_SLOP));
	REG_WRITE(ah, AR_NEXT_TIM, TU_TO_USEC(nextTbtt - SLEEP_SLOP));
3269

S
Sujith 已提交
3270 3271 3272
	REG_WRITE(ah, AR_SLEEP1,
		  SM((CAB_TIMEOUT_VAL << 3), AR_SLEEP1_CAB_TIMEOUT)
		  | AR_SLEEP1_ASSUME_DTIM);
3273

S
Sujith 已提交
3274 3275 3276 3277
	if (pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP)
		beacontimeout = (BEACON_TIMEOUT_VAL << 3);
	else
		beacontimeout = MIN_BEACON_TIMEOUT_VAL;
3278

S
Sujith 已提交
3279 3280
	REG_WRITE(ah, AR_SLEEP2,
		  SM(beacontimeout, AR_SLEEP2_BEACON_TIMEOUT));
3281

S
Sujith 已提交
3282 3283
	REG_WRITE(ah, AR_TIM_PERIOD, TU_TO_USEC(beaconintval));
	REG_WRITE(ah, AR_DTIM_PERIOD, TU_TO_USEC(dtimperiod));
3284

S
Sujith 已提交
3285 3286 3287
	REG_SET_BIT(ah, AR_TIMER_MODE,
		    AR_TBTT_TIMER_EN | AR_TIM_TIMER_EN |
		    AR_DTIM_TIMER_EN);
3288

3289 3290
	/* TSF Out of Range Threshold */
	REG_WRITE(ah, AR_TSFOOR_THRESHOLD, bs->bs_tsfoor_threshold);
3291 3292
}

S
Sujith 已提交
3293 3294 3295 3296
/*******************/
/* HW Capabilities */
/*******************/

3297
void ath9k_hw_fill_cap_info(struct ath_hw *ah)
3298
{
3299
	struct ath9k_hw_capabilities *pCap = &ah->caps;
S
Sujith 已提交
3300
	u16 capField = 0, eeval;
3301

S
Sujith 已提交
3302
	eeval = ah->eep_ops->get_eeprom(ah, EEP_REG_0);
3303
	ah->regulatory.current_rd = eeval;
3304

S
Sujith 已提交
3305
	eeval = ah->eep_ops->get_eeprom(ah, EEP_REG_1);
3306 3307
	if (AR_SREV_9285_10_OR_LATER(ah))
		eeval |= AR9285_RDEXT_DEFAULT;
3308
	ah->regulatory.current_rd_ext = eeval;
3309

S
Sujith 已提交
3310
	capField = ah->eep_ops->get_eeprom(ah, EEP_OP_CAP);
S
Sujith 已提交
3311

3312
	if (ah->opmode != NL80211_IFTYPE_AP &&
3313
	    ah->hw_version.subvendorid == AR_SUBVENDOR_ID_NEW_A) {
3314 3315 3316 3317 3318
		if (ah->regulatory.current_rd == 0x64 ||
		    ah->regulatory.current_rd == 0x65)
			ah->regulatory.current_rd += 5;
		else if (ah->regulatory.current_rd == 0x41)
			ah->regulatory.current_rd = 0x43;
S
Sujith 已提交
3319
		DPRINTF(ah->ah_sc, ATH_DBG_REGULATORY,
3320
			"regdomain mapped to 0x%x\n", ah->regulatory.current_rd);
S
Sujith 已提交
3321
	}
3322

S
Sujith 已提交
3323
	eeval = ah->eep_ops->get_eeprom(ah, EEP_OP_MODE);
S
Sujith 已提交
3324
	bitmap_zero(pCap->wireless_modes, ATH9K_MODE_MAX);
3325

S
Sujith 已提交
3326 3327
	if (eeval & AR5416_OPFLAGS_11A) {
		set_bit(ATH9K_MODE_11A, pCap->wireless_modes);
3328
		if (ah->config.ht_enable) {
S
Sujith 已提交
3329 3330 3331 3332 3333 3334 3335 3336 3337
			if (!(eeval & AR5416_OPFLAGS_N_5G_HT20))
				set_bit(ATH9K_MODE_11NA_HT20,
					pCap->wireless_modes);
			if (!(eeval & AR5416_OPFLAGS_N_5G_HT40)) {
				set_bit(ATH9K_MODE_11NA_HT40PLUS,
					pCap->wireless_modes);
				set_bit(ATH9K_MODE_11NA_HT40MINUS,
					pCap->wireless_modes);
			}
3338 3339 3340
		}
	}

S
Sujith 已提交
3341 3342
	if (eeval & AR5416_OPFLAGS_11G) {
		set_bit(ATH9K_MODE_11G, pCap->wireless_modes);
3343
		if (ah->config.ht_enable) {
S
Sujith 已提交
3344 3345 3346 3347 3348 3349 3350 3351 3352 3353
			if (!(eeval & AR5416_OPFLAGS_N_2G_HT20))
				set_bit(ATH9K_MODE_11NG_HT20,
					pCap->wireless_modes);
			if (!(eeval & AR5416_OPFLAGS_N_2G_HT40)) {
				set_bit(ATH9K_MODE_11NG_HT40PLUS,
					pCap->wireless_modes);
				set_bit(ATH9K_MODE_11NG_HT40MINUS,
					pCap->wireless_modes);
			}
		}
3354
	}
S
Sujith 已提交
3355

S
Sujith 已提交
3356
	pCap->tx_chainmask = ah->eep_ops->get_eeprom(ah, EEP_TX_MASK);
3357 3358 3359 3360 3361
	if ((ah->hw_version.devid == AR5416_DEVID_PCI) &&
	    !(eeval & AR5416_OPFLAGS_11A))
		pCap->rx_chainmask = ath9k_hw_gpio_get(ah, 0) ? 0x5 : 0x7;
	else
		pCap->rx_chainmask = ah->eep_ops->get_eeprom(ah, EEP_RX_MASK);
3362

3363
	if (!(AR_SREV_9280(ah) && (ah->hw_version.macRev == 0)))
3364
		ah->misc_mode |= AR_PCU_MIC_NEW_LOC_ENA;
3365

S
Sujith 已提交
3366 3367
	pCap->low_2ghz_chan = 2312;
	pCap->high_2ghz_chan = 2732;
3368

S
Sujith 已提交
3369 3370
	pCap->low_5ghz_chan = 4920;
	pCap->high_5ghz_chan = 6100;
3371

S
Sujith 已提交
3372 3373 3374
	pCap->hw_caps &= ~ATH9K_HW_CAP_CIPHER_CKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_CIPHER_TKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_CIPHER_AESCCM;
3375

S
Sujith 已提交
3376 3377 3378
	pCap->hw_caps &= ~ATH9K_HW_CAP_MIC_CKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_MIC_TKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_MIC_AESCCM;
3379

3380
	if (ah->config.ht_enable)
S
Sujith 已提交
3381 3382 3383
		pCap->hw_caps |= ATH9K_HW_CAP_HT;
	else
		pCap->hw_caps &= ~ATH9K_HW_CAP_HT;
3384

S
Sujith 已提交
3385 3386 3387 3388
	pCap->hw_caps |= ATH9K_HW_CAP_GTT;
	pCap->hw_caps |= ATH9K_HW_CAP_VEOL;
	pCap->hw_caps |= ATH9K_HW_CAP_BSSIDMASK;
	pCap->hw_caps &= ~ATH9K_HW_CAP_MCAST_KEYSEARCH;
3389

S
Sujith 已提交
3390 3391 3392 3393 3394
	if (capField & AR_EEPROM_EEPCAP_MAXQCU)
		pCap->total_queues =
			MS(capField, AR_EEPROM_EEPCAP_MAXQCU);
	else
		pCap->total_queues = ATH9K_NUM_TX_QUEUES;
3395

S
Sujith 已提交
3396 3397 3398 3399 3400
	if (capField & AR_EEPROM_EEPCAP_KC_ENTRIES)
		pCap->keycache_size =
			1 << MS(capField, AR_EEPROM_EEPCAP_KC_ENTRIES);
	else
		pCap->keycache_size = AR_KEYTABLE_SIZE;
3401

S
Sujith 已提交
3402 3403
	pCap->hw_caps |= ATH9K_HW_CAP_FASTCC;
	pCap->tx_triglevel_max = MAX_TX_FIFO_THRESHOLD;
3404

3405 3406 3407
	if (AR_SREV_9285_10_OR_LATER(ah))
		pCap->num_gpio_pins = AR9285_NUM_GPIO;
	else if (AR_SREV_9280_10_OR_LATER(ah))
S
Sujith 已提交
3408 3409 3410
		pCap->num_gpio_pins = AR928X_NUM_GPIO;
	else
		pCap->num_gpio_pins = AR_NUM_GPIO;
3411

S
Sujith 已提交
3412 3413 3414 3415 3416
	if (AR_SREV_9160_10_OR_LATER(ah) || AR_SREV_9100(ah)) {
		pCap->hw_caps |= ATH9K_HW_CAP_CST;
		pCap->rts_aggr_limit = ATH_AMPDU_LIMIT_MAX;
	} else {
		pCap->rts_aggr_limit = (8 * 1024);
3417 3418
	}

S
Sujith 已提交
3419 3420
	pCap->hw_caps |= ATH9K_HW_CAP_ENHANCEDPM;

3421
#if defined(CONFIG_RFKILL) || defined(CONFIG_RFKILL_MODULE)
3422 3423 3424 3425 3426 3427
	ah->rfsilent = ah->eep_ops->get_eeprom(ah, EEP_RF_SILENT);
	if (ah->rfsilent & EEP_RFSILENT_ENABLED) {
		ah->rfkill_gpio =
			MS(ah->rfsilent, EEP_RFSILENT_GPIO_SEL);
		ah->rfkill_polarity =
			MS(ah->rfsilent, EEP_RFSILENT_POLARITY);
S
Sujith 已提交
3428 3429

		pCap->hw_caps |= ATH9K_HW_CAP_RFSILENT;
3430
	}
S
Sujith 已提交
3431
#endif
3432

3433 3434 3435 3436
	if ((ah->hw_version.macVersion == AR_SREV_VERSION_5416_PCI) ||
	    (ah->hw_version.macVersion == AR_SREV_VERSION_5416_PCIE) ||
	    (ah->hw_version.macVersion == AR_SREV_VERSION_9160) ||
	    (ah->hw_version.macVersion == AR_SREV_VERSION_9100) ||
3437 3438
	    (ah->hw_version.macVersion == AR_SREV_VERSION_9280) ||
	    (ah->hw_version.macVersion == AR_SREV_VERSION_9285))
S
Sujith 已提交
3439
		pCap->hw_caps &= ~ATH9K_HW_CAP_AUTOSLEEP;
3440
	else
S
Sujith 已提交
3441
		pCap->hw_caps |= ATH9K_HW_CAP_AUTOSLEEP;
3442

3443
	if (AR_SREV_9280(ah) || AR_SREV_9285(ah))
S
Sujith 已提交
3444 3445 3446
		pCap->hw_caps &= ~ATH9K_HW_CAP_4KB_SPLITTRANS;
	else
		pCap->hw_caps |= ATH9K_HW_CAP_4KB_SPLITTRANS;
3447

3448
	if (ah->regulatory.current_rd_ext & (1 << REG_EXT_JAPAN_MIDBAND)) {
S
Sujith 已提交
3449 3450 3451 3452 3453
		pCap->reg_cap =
			AR_EEPROM_EEREGCAP_EN_KK_NEW_11A |
			AR_EEPROM_EEREGCAP_EN_KK_U1_EVEN |
			AR_EEPROM_EEREGCAP_EN_KK_U2 |
			AR_EEPROM_EEREGCAP_EN_KK_MIDBAND;
3454
	} else {
S
Sujith 已提交
3455 3456 3457
		pCap->reg_cap =
			AR_EEPROM_EEREGCAP_EN_KK_NEW_11A |
			AR_EEPROM_EEREGCAP_EN_KK_U1_EVEN;
3458 3459
	}

S
Sujith 已提交
3460 3461 3462
	pCap->reg_cap |= AR_EEPROM_EEREGCAP_EN_FCC_MIDBAND;

	pCap->num_antcfg_5ghz =
S
Sujith 已提交
3463
		ah->eep_ops->get_num_ant_config(ah, ATH9K_HAL_FREQ_BAND_5GHZ);
S
Sujith 已提交
3464
	pCap->num_antcfg_2ghz =
S
Sujith 已提交
3465
		ah->eep_ops->get_num_ant_config(ah, ATH9K_HAL_FREQ_BAND_2GHZ);
3466

3467
	if (AR_SREV_9280_10_OR_LATER(ah) && btcoex_enable) {
3468
		pCap->hw_caps |= ATH9K_HW_CAP_BT_COEX;
3469 3470
		ah->btactive_gpio = 6;
		ah->wlanactive_gpio = 5;
3471
	}
3472 3473
}

3474
bool ath9k_hw_getcapability(struct ath_hw *ah, enum ath9k_capability_type type,
S
Sujith 已提交
3475
			    u32 capability, u32 *result)
3476
{
S
Sujith 已提交
3477 3478 3479 3480 3481 3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494
	switch (type) {
	case ATH9K_CAP_CIPHER:
		switch (capability) {
		case ATH9K_CIPHER_AES_CCM:
		case ATH9K_CIPHER_AES_OCB:
		case ATH9K_CIPHER_TKIP:
		case ATH9K_CIPHER_WEP:
		case ATH9K_CIPHER_MIC:
		case ATH9K_CIPHER_CLR:
			return true;
		default:
			return false;
		}
	case ATH9K_CAP_TKIP_MIC:
		switch (capability) {
		case 0:
			return true;
		case 1:
3495
			return (ah->sta_id1_defaults &
S
Sujith 已提交
3496 3497 3498 3499
				AR_STA_ID1_CRPT_MIC_ENABLE) ? true :
			false;
		}
	case ATH9K_CAP_TKIP_SPLIT:
3500
		return (ah->misc_mode & AR_PCU_MIC_NEW_LOC_ENA) ?
S
Sujith 已提交
3501 3502 3503 3504 3505 3506 3507 3508 3509 3510 3511 3512 3513
			false : true;
	case ATH9K_CAP_DIVERSITY:
		return (REG_READ(ah, AR_PHY_CCK_DETECT) &
			AR_PHY_CCK_DETECT_BB_ENABLE_ANT_FAST_DIV) ?
			true : false;
	case ATH9K_CAP_MCAST_KEYSRCH:
		switch (capability) {
		case 0:
			return true;
		case 1:
			if (REG_READ(ah, AR_STA_ID1) & AR_STA_ID1_ADHOC) {
				return false;
			} else {
3514
				return (ah->sta_id1_defaults &
S
Sujith 已提交
3515 3516 3517 3518 3519 3520 3521 3522 3523 3524
					AR_STA_ID1_MCAST_KSRCH) ? true :
					false;
			}
		}
		return false;
	case ATH9K_CAP_TXPOW:
		switch (capability) {
		case 0:
			return 0;
		case 1:
3525
			*result = ah->regulatory.power_limit;
S
Sujith 已提交
3526 3527
			return 0;
		case 2:
3528
			*result = ah->regulatory.max_power_level;
S
Sujith 已提交
3529 3530
			return 0;
		case 3:
3531
			*result = ah->regulatory.tp_scale;
S
Sujith 已提交
3532 3533 3534
			return 0;
		}
		return false;
3535 3536 3537 3538
	case ATH9K_CAP_DS:
		return (AR_SREV_9280_20_OR_LATER(ah) &&
			(ah->eep_ops->get_eeprom(ah, EEP_RC_CHAIN_MASK) == 1))
			? false : true;
S
Sujith 已提交
3539 3540
	default:
		return false;
3541 3542 3543
	}
}

3544
bool ath9k_hw_setcapability(struct ath_hw *ah, enum ath9k_capability_type type,
S
Sujith 已提交
3545
			    u32 capability, u32 setting, int *status)
3546
{
S
Sujith 已提交
3547
	u32 v;
3548

S
Sujith 已提交
3549 3550 3551
	switch (type) {
	case ATH9K_CAP_TKIP_MIC:
		if (setting)
3552
			ah->sta_id1_defaults |=
S
Sujith 已提交
3553 3554
				AR_STA_ID1_CRPT_MIC_ENABLE;
		else
3555
			ah->sta_id1_defaults &=
S
Sujith 已提交
3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566 3567
				~AR_STA_ID1_CRPT_MIC_ENABLE;
		return true;
	case ATH9K_CAP_DIVERSITY:
		v = REG_READ(ah, AR_PHY_CCK_DETECT);
		if (setting)
			v |= AR_PHY_CCK_DETECT_BB_ENABLE_ANT_FAST_DIV;
		else
			v &= ~AR_PHY_CCK_DETECT_BB_ENABLE_ANT_FAST_DIV;
		REG_WRITE(ah, AR_PHY_CCK_DETECT, v);
		return true;
	case ATH9K_CAP_MCAST_KEYSRCH:
		if (setting)
3568
			ah->sta_id1_defaults |= AR_STA_ID1_MCAST_KSRCH;
S
Sujith 已提交
3569
		else
3570
			ah->sta_id1_defaults &= ~AR_STA_ID1_MCAST_KSRCH;
S
Sujith 已提交
3571 3572 3573
		return true;
	default:
		return false;
3574 3575 3576
	}
}

S
Sujith 已提交
3577 3578 3579
/****************************/
/* GPIO / RFKILL / Antennae */
/****************************/
3580

3581
static void ath9k_hw_gpio_cfg_output_mux(struct ath_hw *ah,
S
Sujith 已提交
3582 3583 3584 3585
					 u32 gpio, u32 type)
{
	int addr;
	u32 gpio_shift, tmp;
3586

S
Sujith 已提交
3587 3588 3589 3590 3591 3592
	if (gpio > 11)
		addr = AR_GPIO_OUTPUT_MUX3;
	else if (gpio > 5)
		addr = AR_GPIO_OUTPUT_MUX2;
	else
		addr = AR_GPIO_OUTPUT_MUX1;
3593

S
Sujith 已提交
3594
	gpio_shift = (gpio % 6) * 5;
3595

S
Sujith 已提交
3596 3597 3598 3599
	if (AR_SREV_9280_20_OR_LATER(ah)
	    || (addr != AR_GPIO_OUTPUT_MUX1)) {
		REG_RMW(ah, addr, (type << gpio_shift),
			(0x1f << gpio_shift));
3600
	} else {
S
Sujith 已提交
3601 3602 3603 3604 3605
		tmp = REG_READ(ah, addr);
		tmp = ((tmp & 0x1F0) << 1) | (tmp & ~0x1F0);
		tmp &= ~(0x1f << gpio_shift);
		tmp |= (type << gpio_shift);
		REG_WRITE(ah, addr, tmp);
3606 3607 3608
	}
}

3609
void ath9k_hw_cfg_gpio_input(struct ath_hw *ah, u32 gpio)
3610
{
S
Sujith 已提交
3611
	u32 gpio_shift;
3612

3613
	ASSERT(gpio < ah->caps.num_gpio_pins);
3614

S
Sujith 已提交
3615
	gpio_shift = gpio << 1;
3616

S
Sujith 已提交
3617 3618 3619 3620
	REG_RMW(ah,
		AR_GPIO_OE_OUT,
		(AR_GPIO_OE_OUT_DRV_NO << gpio_shift),
		(AR_GPIO_OE_OUT_DRV << gpio_shift));
3621 3622
}

3623
u32 ath9k_hw_gpio_get(struct ath_hw *ah, u32 gpio)
3624
{
3625 3626 3627
#define MS_REG_READ(x, y) \
	(MS(REG_READ(ah, AR_GPIO_IN_OUT), x##_GPIO_IN_VAL) & (AR_GPIO_BIT(y)))

3628
	if (gpio >= ah->caps.num_gpio_pins)
S
Sujith 已提交
3629
		return 0xffffffff;
3630

3631 3632 3633 3634 3635 3636
	if (AR_SREV_9285_10_OR_LATER(ah))
		return MS_REG_READ(AR9285, gpio) != 0;
	else if (AR_SREV_9280_10_OR_LATER(ah))
		return MS_REG_READ(AR928X, gpio) != 0;
	else
		return MS_REG_READ(AR, gpio) != 0;
3637 3638
}

3639
void ath9k_hw_cfg_output(struct ath_hw *ah, u32 gpio,
S
Sujith 已提交
3640
			 u32 ah_signal_type)
3641
{
S
Sujith 已提交
3642
	u32 gpio_shift;
3643

S
Sujith 已提交
3644
	ath9k_hw_gpio_cfg_output_mux(ah, gpio, ah_signal_type);
3645

S
Sujith 已提交
3646
	gpio_shift = 2 * gpio;
3647

S
Sujith 已提交
3648 3649 3650 3651
	REG_RMW(ah,
		AR_GPIO_OE_OUT,
		(AR_GPIO_OE_OUT_DRV_ALL << gpio_shift),
		(AR_GPIO_OE_OUT_DRV << gpio_shift));
3652 3653
}

3654
void ath9k_hw_set_gpio(struct ath_hw *ah, u32 gpio, u32 val)
3655
{
S
Sujith 已提交
3656 3657
	REG_RMW(ah, AR_GPIO_IN_OUT, ((val & 1) << gpio),
		AR_GPIO_BIT(gpio));
3658 3659
}

3660
u32 ath9k_hw_getdefantenna(struct ath_hw *ah)
3661
{
S
Sujith 已提交
3662
	return REG_READ(ah, AR_DEF_ANTENNA) & 0x7;
3663 3664
}

3665
void ath9k_hw_setantenna(struct ath_hw *ah, u32 antenna)
3666
{
S
Sujith 已提交
3667
	REG_WRITE(ah, AR_DEF_ANTENNA, (antenna & 0x7));
3668 3669
}

3670
bool ath9k_hw_setantennaswitch(struct ath_hw *ah,
S
Sujith 已提交
3671 3672 3673 3674 3675
			       enum ath9k_ant_setting settings,
			       struct ath9k_channel *chan,
			       u8 *tx_chainmask,
			       u8 *rx_chainmask,
			       u8 *antenna_cfgd)
3676
{
S
Sujith 已提交
3677
	static u8 tx_chainmask_cfg, rx_chainmask_cfg;
3678

S
Sujith 已提交
3679 3680
	if (AR_SREV_9280(ah)) {
		if (!tx_chainmask_cfg) {
3681

S
Sujith 已提交
3682 3683 3684
			tx_chainmask_cfg = *tx_chainmask;
			rx_chainmask_cfg = *rx_chainmask;
		}
3685

S
Sujith 已提交
3686 3687 3688 3689 3690 3691 3692
		switch (settings) {
		case ATH9K_ANT_FIXED_A:
			*tx_chainmask = ATH9K_ANTENNA0_CHAINMASK;
			*rx_chainmask = ATH9K_ANTENNA0_CHAINMASK;
			*antenna_cfgd = true;
			break;
		case ATH9K_ANT_FIXED_B:
3693
			if (ah->caps.tx_chainmask >
S
Sujith 已提交
3694 3695 3696 3697 3698 3699 3700 3701 3702 3703 3704 3705 3706 3707 3708
			    ATH9K_ANTENNA1_CHAINMASK) {
				*tx_chainmask = ATH9K_ANTENNA1_CHAINMASK;
			}
			*rx_chainmask = ATH9K_ANTENNA1_CHAINMASK;
			*antenna_cfgd = true;
			break;
		case ATH9K_ANT_VARIABLE:
			*tx_chainmask = tx_chainmask_cfg;
			*rx_chainmask = rx_chainmask_cfg;
			*antenna_cfgd = true;
			break;
		default:
			break;
		}
	} else {
3709
		ah->diversity_control = settings;
3710 3711
	}

S
Sujith 已提交
3712
	return true;
3713 3714
}

S
Sujith 已提交
3715 3716 3717 3718
/*********************/
/* General Operation */
/*********************/

3719
u32 ath9k_hw_getrxfilter(struct ath_hw *ah)
3720
{
S
Sujith 已提交
3721 3722
	u32 bits = REG_READ(ah, AR_RX_FILTER);
	u32 phybits = REG_READ(ah, AR_PHY_ERR);
3723

S
Sujith 已提交
3724 3725 3726 3727
	if (phybits & AR_PHY_ERR_RADAR)
		bits |= ATH9K_RX_FILTER_PHYRADAR;
	if (phybits & (AR_PHY_ERR_OFDM_TIMING | AR_PHY_ERR_CCK_TIMING))
		bits |= ATH9K_RX_FILTER_PHYERR;
S
Sujith 已提交
3728

S
Sujith 已提交
3729
	return bits;
3730 3731
}

3732
void ath9k_hw_setrxfilter(struct ath_hw *ah, u32 bits)
3733
{
S
Sujith 已提交
3734
	u32 phybits;
3735

S
Sujith 已提交
3736 3737 3738 3739 3740 3741 3742
	REG_WRITE(ah, AR_RX_FILTER, (bits & 0xffff) | AR_RX_COMPR_BAR);
	phybits = 0;
	if (bits & ATH9K_RX_FILTER_PHYRADAR)
		phybits |= AR_PHY_ERR_RADAR;
	if (bits & ATH9K_RX_FILTER_PHYERR)
		phybits |= AR_PHY_ERR_OFDM_TIMING | AR_PHY_ERR_CCK_TIMING;
	REG_WRITE(ah, AR_PHY_ERR, phybits);
3743

S
Sujith 已提交
3744 3745 3746 3747 3748 3749 3750
	if (phybits)
		REG_WRITE(ah, AR_RXCFG,
			  REG_READ(ah, AR_RXCFG) | AR_RXCFG_ZLFDMA);
	else
		REG_WRITE(ah, AR_RXCFG,
			  REG_READ(ah, AR_RXCFG) & ~AR_RXCFG_ZLFDMA);
}
3751

3752
bool ath9k_hw_phy_disable(struct ath_hw *ah)
S
Sujith 已提交
3753 3754 3755
{
	return ath9k_hw_set_reset_reg(ah, ATH9K_RESET_WARM);
}
3756

3757
bool ath9k_hw_disable(struct ath_hw *ah)
S
Sujith 已提交
3758 3759 3760
{
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE))
		return false;
3761

S
Sujith 已提交
3762
	return ath9k_hw_set_reset_reg(ah, ATH9K_RESET_COLD);
3763 3764
}

3765
void ath9k_hw_set_txpowerlimit(struct ath_hw *ah, u32 limit)
3766
{
3767
	struct ath9k_channel *chan = ah->curchan;
3768
	struct ieee80211_channel *channel = chan->chan;
3769

3770
	ah->regulatory.power_limit = min(limit, (u32) MAX_RATE_POWER);
3771

3772 3773 3774 3775 3776 3777
	ah->eep_ops->set_txpower(ah, chan,
				 ath9k_regd_get_ctl(&ah->regulatory, chan),
				 channel->max_antenna_gain * 2,
				 channel->max_power * 2,
				 min((u32) MAX_RATE_POWER,
				 (u32) ah->regulatory.power_limit));
3778 3779
}

3780
void ath9k_hw_setmac(struct ath_hw *ah, const u8 *mac)
3781
{
S
Sujith 已提交
3782
	memcpy(ah->macaddr, mac, ETH_ALEN);
3783 3784
}

3785
void ath9k_hw_setopmode(struct ath_hw *ah)
3786
{
3787
	ath9k_hw_set_operating_mode(ah, ah->opmode);
3788 3789
}

3790
void ath9k_hw_setmcastfilter(struct ath_hw *ah, u32 filter0, u32 filter1)
3791
{
S
Sujith 已提交
3792 3793
	REG_WRITE(ah, AR_MCAST_FIL0, filter0);
	REG_WRITE(ah, AR_MCAST_FIL1, filter1);
3794 3795
}

S
Sujith 已提交
3796
void ath9k_hw_setbssidmask(struct ath_softc *sc)
3797
{
S
Sujith 已提交
3798 3799
	REG_WRITE(sc->sc_ah, AR_BSSMSKL, get_unaligned_le32(sc->bssidmask));
	REG_WRITE(sc->sc_ah, AR_BSSMSKU, get_unaligned_le16(sc->bssidmask + 4));
3800 3801
}

S
Sujith 已提交
3802
void ath9k_hw_write_associd(struct ath_softc *sc)
3803
{
S
Sujith 已提交
3804 3805 3806
	REG_WRITE(sc->sc_ah, AR_BSS_ID0, get_unaligned_le32(sc->curbssid));
	REG_WRITE(sc->sc_ah, AR_BSS_ID1, get_unaligned_le16(sc->curbssid + 4) |
		  ((sc->curaid & 0x3fff) << AR_BSS_ID1_AID_S));
3807 3808
}

3809
u64 ath9k_hw_gettsf64(struct ath_hw *ah)
3810
{
S
Sujith 已提交
3811
	u64 tsf;
3812

S
Sujith 已提交
3813 3814
	tsf = REG_READ(ah, AR_TSF_U32);
	tsf = (tsf << 32) | REG_READ(ah, AR_TSF_L32);
3815

S
Sujith 已提交
3816 3817
	return tsf;
}
3818

3819
void ath9k_hw_settsf64(struct ath_hw *ah, u64 tsf64)
3820 3821
{
	REG_WRITE(ah, AR_TSF_L32, tsf64 & 0xffffffff);
A
Alina Friedrichsen 已提交
3822
	REG_WRITE(ah, AR_TSF_U32, (tsf64 >> 32) & 0xffffffff);
3823 3824
}

3825
void ath9k_hw_reset_tsf(struct ath_hw *ah)
S
Sujith 已提交
3826 3827
{
	int count;
3828

S
Sujith 已提交
3829 3830 3831 3832 3833
	count = 0;
	while (REG_READ(ah, AR_SLP32_MODE) & AR_SLP32_TSF_WRITE_STATUS) {
		count++;
		if (count > 10) {
			DPRINTF(ah->ah_sc, ATH_DBG_RESET,
S
Sujith 已提交
3834
				"AR_SLP32_TSF_WRITE_STATUS limit exceeded\n");
S
Sujith 已提交
3835
			break;
3836
		}
S
Sujith 已提交
3837 3838 3839 3840
		udelay(10);
	}
	REG_WRITE(ah, AR_RESET_TSF, AR_RESET_TSF_ONCE);
}
3841

3842
bool ath9k_hw_set_tsfadjust(struct ath_hw *ah, u32 setting)
S
Sujith 已提交
3843 3844
{
	if (setting)
3845
		ah->misc_mode |= AR_PCU_TX_ADD_TSF;
S
Sujith 已提交
3846
	else
3847
		ah->misc_mode &= ~AR_PCU_TX_ADD_TSF;
3848

S
Sujith 已提交
3849 3850
	return true;
}
3851

3852
bool ath9k_hw_setslottime(struct ath_hw *ah, u32 us)
S
Sujith 已提交
3853 3854
{
	if (us < ATH9K_SLOT_TIME_9 || us > ath9k_hw_mac_to_usec(ah, 0xffff)) {
S
Sujith 已提交
3855
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "bad slot time %u\n", us);
3856
		ah->slottime = (u32) -1;
S
Sujith 已提交
3857 3858 3859
		return false;
	} else {
		REG_WRITE(ah, AR_D_GBL_IFS_SLOT, ath9k_hw_mac_to_clks(ah, us));
3860
		ah->slottime = us;
S
Sujith 已提交
3861
		return true;
3862
	}
S
Sujith 已提交
3863 3864
}

3865
void ath9k_hw_set11nmac2040(struct ath_hw *ah, enum ath9k_ht_macmode mode)
S
Sujith 已提交
3866 3867 3868 3869
{
	u32 macmode;

	if (mode == ATH9K_HT_MACMODE_2040 &&
3870
	    !ah->config.cwm_ignore_extcca)
S
Sujith 已提交
3871 3872 3873
		macmode = AR_2040_JOINED_RX_CLEAR;
	else
		macmode = 0;
3874

S
Sujith 已提交
3875
	REG_WRITE(ah, AR_2040_MODE, macmode);
3876
}
3877 3878 3879 3880 3881

/***************************/
/*  Bluetooth Coexistence  */
/***************************/

3882
void ath9k_hw_btcoex_enable(struct ath_hw *ah)
3883 3884 3885 3886 3887 3888 3889 3890 3891 3892 3893 3894
{
	/* connect bt_active to baseband */
	REG_CLR_BIT(ah, AR_GPIO_INPUT_EN_VAL,
			(AR_GPIO_INPUT_EN_VAL_BT_PRIORITY_DEF |
			 AR_GPIO_INPUT_EN_VAL_BT_FREQUENCY_DEF));

	REG_SET_BIT(ah, AR_GPIO_INPUT_EN_VAL,
			AR_GPIO_INPUT_EN_VAL_BT_ACTIVE_BB);

	/* Set input mux for bt_active to gpio pin */
	REG_RMW_FIELD(ah, AR_GPIO_INPUT_MUX1,
			AR_GPIO_INPUT_MUX1_BT_ACTIVE,
3895
			ah->btactive_gpio);
3896 3897

	/* Configure the desired gpio port for input */
3898
	ath9k_hw_cfg_gpio_input(ah, ah->btactive_gpio);
3899 3900

	/* Configure the desired GPIO port for TX_FRAME output */
3901
	ath9k_hw_cfg_output(ah, ah->wlanactive_gpio,
3902 3903
			    AR_GPIO_OUTPUT_MUX_AS_TX_FRAME);
}