hw.c 105.6 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 385
	case AR5416_DEVID_AR9287_PCI:
	case AR5416_DEVID_AR9287_PCIE:
		return "Atheros 9287";
386 387
	}

S
Sujith 已提交
388 389
	return NULL;
}
390

391
static void ath9k_hw_set_defaults(struct ath_hw *ah)
S
Sujith 已提交
392 393
{
	int i;
394

395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411
	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;
412

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

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

	/*
	 * 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)
437
		ah->config.serialize_regmode = SER_REG_MODE_AUTO;
438 439
}

440 441
static void ath9k_hw_newstate(u16 devid,
			      struct ath_hw *ah)
442
{
443
	ah->hw_version.magic = AR5416_MAGIC;
444
	ah->regulatory.country_code = CTRY_DEFAULT;
445 446
	ah->hw_version.devid = devid;
	ah->hw_version.subvendorid = 0;
447 448 449

	ah->ah_flags = 0;
	if ((devid == AR5416_AR9100_DEVID))
450
		ah->hw_version.macVersion = AR_SREV_VERSION_9100;
451 452 453
	if (!AR_SREV_9100(ah))
		ah->ah_flags = AH_USE_EEPROM;

454 455
	ah->regulatory.power_limit = MAX_RATE_POWER;
	ah->regulatory.tp_scale = ATH9K_TP_SCALE_MAX;
456 457 458 459 460 461 462 463 464 465 466 467 468
	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;
469

470
	ah->power_mode = ATH9K_PM_UNDEFINED;
471 472
}

473
static int ath9k_hw_rfattach(struct ath_hw *ah)
474
{
S
Sujith 已提交
475 476
	bool rfStatus = false;
	int ecode = 0;
477

S
Sujith 已提交
478 479
	rfStatus = ath9k_hw_init_rf(ah, &ecode);
	if (!rfStatus) {
S
Sujith 已提交
480 481
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"RF setup failed, status: %u\n", ecode);
S
Sujith 已提交
482 483
		return ecode;
	}
484

S
Sujith 已提交
485
	return 0;
486 487
}

488
static int ath9k_hw_rf_claim(struct ath_hw *ah)
489
{
S
Sujith 已提交
490 491 492 493 494 495 496 497 498 499 500 501 502 503
	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;
504
	default:
S
Sujith 已提交
505 506 507
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"Radio Chip Rev 0x%02X not supported\n",
			val & AR_RADIO_SREV_MAJOR);
S
Sujith 已提交
508
		return -EOPNOTSUPP;
509 510
	}

511
	ah->hw_version.analog5GhzRev = val;
512

S
Sujith 已提交
513
	return 0;
514 515
}

516
static int ath9k_hw_init_macaddr(struct ath_hw *ah)
517 518 519 520 521 522 523
{
	u32 sum;
	int i;
	u16 eeval;

	sum = 0;
	for (i = 0; i < 3; i++) {
S
Sujith 已提交
524
		eeval = ah->eep_ops->get_eeprom(ah, AR_EEPROM_MAC(i));
525
		sum += eeval;
S
Sujith 已提交
526 527
		ah->macaddr[2 * i] = eeval >> 8;
		ah->macaddr[2 * i + 1] = eeval & 0xff;
528
	}
S
Sujith 已提交
529
	if (sum == 0 || sum == 0xffff * 3)
530 531 532 533 534
		return -EADDRNOTAVAIL;

	return 0;
}

535
static void ath9k_hw_init_rxgain_ini(struct ath_hw *ah)
536 537 538
{
	u32 rxgain_type;

S
Sujith 已提交
539 540
	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);
541 542

		if (rxgain_type == AR5416_EEP_RXGAIN_13DB_BACKOFF)
543
			INIT_INI_ARRAY(&ah->iniModesRxGain,
544 545 546
			ar9280Modes_backoff_13db_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_backoff_13db_rxgain_9280_2), 6);
		else if (rxgain_type == AR5416_EEP_RXGAIN_23DB_BACKOFF)
547
			INIT_INI_ARRAY(&ah->iniModesRxGain,
548 549 550
			ar9280Modes_backoff_23db_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_backoff_23db_rxgain_9280_2), 6);
		else
551
			INIT_INI_ARRAY(&ah->iniModesRxGain,
552 553
			ar9280Modes_original_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_original_rxgain_9280_2), 6);
554
	} else {
555
		INIT_INI_ARRAY(&ah->iniModesRxGain,
556 557
			ar9280Modes_original_rxgain_9280_2,
			ARRAY_SIZE(ar9280Modes_original_rxgain_9280_2), 6);
558
	}
559 560
}

561
static void ath9k_hw_init_txgain_ini(struct ath_hw *ah)
562 563 564
{
	u32 txgain_type;

S
Sujith 已提交
565 566
	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);
567 568

		if (txgain_type == AR5416_EEP_TXGAIN_HIGH_POWER)
569
			INIT_INI_ARRAY(&ah->iniModesTxGain,
570 571 572
			ar9280Modes_high_power_tx_gain_9280_2,
			ARRAY_SIZE(ar9280Modes_high_power_tx_gain_9280_2), 6);
		else
573
			INIT_INI_ARRAY(&ah->iniModesTxGain,
574 575
			ar9280Modes_original_tx_gain_9280_2,
			ARRAY_SIZE(ar9280Modes_original_tx_gain_9280_2), 6);
576
	} else {
577
		INIT_INI_ARRAY(&ah->iniModesTxGain,
578 579
		ar9280Modes_original_tx_gain_9280_2,
		ARRAY_SIZE(ar9280Modes_original_tx_gain_9280_2), 6);
580
	}
581 582
}

583
static int ath9k_hw_post_attach(struct ath_hw *ah)
584
{
S
Sujith 已提交
585
	int ecode;
586

S
Sujith 已提交
587
	if (!ath9k_hw_chip_test(ah))
S
Sujith 已提交
588
		return -ENODEV;
589

S
Sujith 已提交
590 591
	ecode = ath9k_hw_rf_claim(ah);
	if (ecode != 0)
592 593
		return ecode;

S
Sujith 已提交
594 595 596
	ecode = ath9k_hw_eeprom_attach(ah);
	if (ecode != 0)
		return ecode;
597 598 599 600

	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 已提交
601 602 603
	ecode = ath9k_hw_rfattach(ah);
	if (ecode != 0)
		return ecode;
604

S
Sujith 已提交
605 606 607
	if (!AR_SREV_9100(ah)) {
		ath9k_hw_ani_setup(ah);
		ath9k_hw_ani_attach(ah);
608 609 610 611 612
	}

	return 0;
}

613 614 615
static int ath9k_hw_do_attach(struct ath_hw *ah,
			      u16 devid,
			      struct ath_softc *sc)
616
{
617
	int r;
618
	u32 i, j;
619

620
	ath9k_hw_newstate(devid, ah);
S
Sujith 已提交
621
	ath9k_hw_set_defaults(ah);
622

S
Sujith 已提交
623
	if (!ath9k_hw_set_reset_reg(ah, ATH9K_RESET_POWER_ON)) {
S
Sujith 已提交
624
		DPRINTF(sc, ATH_DBG_FATAL, "Couldn't reset chip\n");
625
		r = -EIO;
S
Sujith 已提交
626 627
		goto bad;
	}
628

S
Sujith 已提交
629
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE)) {
S
Sujith 已提交
630
		DPRINTF(sc, ATH_DBG_FATAL, "Couldn't wakeup chip\n");
631
		r = -EIO;
S
Sujith 已提交
632 633
		goto bad;
	}
634

635
	if (ah->config.serialize_regmode == SER_REG_MODE_AUTO) {
636 637
		if (ah->hw_version.macVersion == AR_SREV_VERSION_5416_PCI ||
		    (AR_SREV_9280(ah) && !ah->is_pciexpress)) {
638
			ah->config.serialize_regmode =
S
Sujith 已提交
639
				SER_REG_MODE_ON;
640
		} else {
641
			ah->config.serialize_regmode =
S
Sujith 已提交
642
				SER_REG_MODE_OFF;
643 644 645
		}
	}

646
	DPRINTF(sc, ATH_DBG_RESET, "serialize_regmode is %d\n",
647
		ah->config.serialize_regmode);
648

649 650 651 652 653 654 655 656 657 658
	switch (ah->hw_version.macVersion) {
	case AR_SREV_VERSION_5416_PCI:
	case AR_SREV_VERSION_5416_PCIE:
	case AR_SREV_VERSION_9160:
	case AR_SREV_VERSION_9100:
	case AR_SREV_VERSION_9280:
	case AR_SREV_VERSION_9285:
	case AR_SREV_VERSION_9287:
		break;
	default:
S
Sujith 已提交
659
		DPRINTF(sc, ATH_DBG_FATAL,
S
Sujith 已提交
660
			"Mac Chip Rev 0x%02x.%x is not supported by "
661 662
			"this driver\n", ah->hw_version.macVersion,
			ah->hw_version.macRev);
663
		r = -EOPNOTSUPP;
S
Sujith 已提交
664 665
		goto bad;
	}
666

S
Sujith 已提交
667
	if (AR_SREV_9100(ah)) {
668 669 670
		ah->iq_caldata.calData = &iq_cal_multi_sample;
		ah->supp_cals = IQ_MISMATCH_CAL;
		ah->is_pciexpress = false;
S
Sujith 已提交
671
	}
672
	ah->hw_version.phyRev = REG_READ(ah, AR_PHY_CHIP_ID);
673

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

S
Sujith 已提交
695 696 697
	ah->ani_function = ATH9K_ANI_ALL;
	if (AR_SREV_9280_10_OR_LATER(ah))
		ah->ani_function &= ~ATH9K_ANI_NOISE_IMMUNITY_LEVEL;
698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727
	if (AR_SREV_9287_11_OR_LATER(ah)) {
		INIT_INI_ARRAY(&ah->iniModes, ar9287Modes_9287_1_1,
				ARRAY_SIZE(ar9287Modes_9287_1_1), 6);
		INIT_INI_ARRAY(&ah->iniCommon, ar9287Common_9287_1_1,
				ARRAY_SIZE(ar9287Common_9287_1_1), 2);
		if (ah->config.pcie_clock_req)
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
			ar9287PciePhy_clkreq_off_L1_9287_1_1,
			ARRAY_SIZE(ar9287PciePhy_clkreq_off_L1_9287_1_1), 2);
		else
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
			ar9287PciePhy_clkreq_always_on_L1_9287_1_1,
			ARRAY_SIZE(ar9287PciePhy_clkreq_always_on_L1_9287_1_1),
					2);
	} else if (AR_SREV_9287_10_OR_LATER(ah)) {
		INIT_INI_ARRAY(&ah->iniModes, ar9287Modes_9287_1_0,
				ARRAY_SIZE(ar9287Modes_9287_1_0), 6);
		INIT_INI_ARRAY(&ah->iniCommon, ar9287Common_9287_1_0,
				ARRAY_SIZE(ar9287Common_9287_1_0), 2);

		if (ah->config.pcie_clock_req)
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
			ar9287PciePhy_clkreq_off_L1_9287_1_0,
			ARRAY_SIZE(ar9287PciePhy_clkreq_off_L1_9287_1_0), 2);
		else
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
			ar9287PciePhy_clkreq_always_on_L1_9287_1_0,
			ARRAY_SIZE(ar9287PciePhy_clkreq_always_on_L1_9287_1_0),
				  2);
	} else if (AR_SREV_9285_12_OR_LATER(ah)) {
728

729

730
		INIT_INI_ARRAY(&ah->iniModes, ar9285Modes_9285_1_2,
731
			       ARRAY_SIZE(ar9285Modes_9285_1_2), 6);
732
		INIT_INI_ARRAY(&ah->iniCommon, ar9285Common_9285_1_2,
733 734
			       ARRAY_SIZE(ar9285Common_9285_1_2), 2);

735 736
		if (ah->config.pcie_clock_req) {
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
737 738 739
			ar9285PciePhy_clkreq_off_L1_9285_1_2,
			ARRAY_SIZE(ar9285PciePhy_clkreq_off_L1_9285_1_2), 2);
		} else {
740
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
741 742 743 744 745
			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)) {
746
		INIT_INI_ARRAY(&ah->iniModes, ar9285Modes_9285,
747
			       ARRAY_SIZE(ar9285Modes_9285), 6);
748
		INIT_INI_ARRAY(&ah->iniCommon, ar9285Common_9285,
749 750
			       ARRAY_SIZE(ar9285Common_9285), 2);

751 752
		if (ah->config.pcie_clock_req) {
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
753 754 755
			ar9285PciePhy_clkreq_off_L1_9285,
			ARRAY_SIZE(ar9285PciePhy_clkreq_off_L1_9285), 2);
		} else {
756
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
757 758 759 760
			ar9285PciePhy_clkreq_always_on_L1_9285,
			ARRAY_SIZE(ar9285PciePhy_clkreq_always_on_L1_9285), 2);
		}
	} else if (AR_SREV_9280_20_OR_LATER(ah)) {
761
		INIT_INI_ARRAY(&ah->iniModes, ar9280Modes_9280_2,
S
Sujith 已提交
762
			       ARRAY_SIZE(ar9280Modes_9280_2), 6);
763
		INIT_INI_ARRAY(&ah->iniCommon, ar9280Common_9280_2,
S
Sujith 已提交
764
			       ARRAY_SIZE(ar9280Common_9280_2), 2);
765

766 767
		if (ah->config.pcie_clock_req) {
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
S
Sujith 已提交
768 769 770
			       ar9280PciePhy_clkreq_off_L1_9280,
			       ARRAY_SIZE(ar9280PciePhy_clkreq_off_L1_9280),2);
		} else {
771
			INIT_INI_ARRAY(&ah->iniPcieSerdes,
S
Sujith 已提交
772 773 774
			       ar9280PciePhy_clkreq_always_on_L1_9280,
			       ARRAY_SIZE(ar9280PciePhy_clkreq_always_on_L1_9280), 2);
		}
775
		INIT_INI_ARRAY(&ah->iniModesAdditional,
S
Sujith 已提交
776 777 778
			       ar9280Modes_fast_clock_9280_2,
			       ARRAY_SIZE(ar9280Modes_fast_clock_9280_2), 3);
	} else if (AR_SREV_9280_10_OR_LATER(ah)) {
779
		INIT_INI_ARRAY(&ah->iniModes, ar9280Modes_9280,
S
Sujith 已提交
780
			       ARRAY_SIZE(ar9280Modes_9280), 6);
781
		INIT_INI_ARRAY(&ah->iniCommon, ar9280Common_9280,
S
Sujith 已提交
782 783
			       ARRAY_SIZE(ar9280Common_9280), 2);
	} else if (AR_SREV_9160_10_OR_LATER(ah)) {
784
		INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9160,
S
Sujith 已提交
785
			       ARRAY_SIZE(ar5416Modes_9160), 6);
786
		INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9160,
S
Sujith 已提交
787
			       ARRAY_SIZE(ar5416Common_9160), 2);
788
		INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0_9160,
S
Sujith 已提交
789
			       ARRAY_SIZE(ar5416Bank0_9160), 2);
790
		INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain_9160,
S
Sujith 已提交
791
			       ARRAY_SIZE(ar5416BB_RfGain_9160), 3);
792
		INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1_9160,
S
Sujith 已提交
793
			       ARRAY_SIZE(ar5416Bank1_9160), 2);
794
		INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2_9160,
S
Sujith 已提交
795
			       ARRAY_SIZE(ar5416Bank2_9160), 2);
796
		INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3_9160,
S
Sujith 已提交
797
			       ARRAY_SIZE(ar5416Bank3_9160), 3);
798
		INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6_9160,
S
Sujith 已提交
799
			       ARRAY_SIZE(ar5416Bank6_9160), 3);
800
		INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC_9160,
S
Sujith 已提交
801
			       ARRAY_SIZE(ar5416Bank6TPC_9160), 3);
802
		INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7_9160,
S
Sujith 已提交
803 804
			       ARRAY_SIZE(ar5416Bank7_9160), 2);
		if (AR_SREV_9160_11(ah)) {
805
			INIT_INI_ARRAY(&ah->iniAddac,
S
Sujith 已提交
806 807 808
				       ar5416Addac_91601_1,
				       ARRAY_SIZE(ar5416Addac_91601_1), 2);
		} else {
809
			INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9160,
S
Sujith 已提交
810 811 812
				       ARRAY_SIZE(ar5416Addac_9160), 2);
		}
	} else if (AR_SREV_9100_OR_LATER(ah)) {
813
		INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9100,
S
Sujith 已提交
814
			       ARRAY_SIZE(ar5416Modes_9100), 6);
815
		INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9100,
S
Sujith 已提交
816
			       ARRAY_SIZE(ar5416Common_9100), 2);
817
		INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0_9100,
S
Sujith 已提交
818
			       ARRAY_SIZE(ar5416Bank0_9100), 2);
819
		INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain_9100,
S
Sujith 已提交
820
			       ARRAY_SIZE(ar5416BB_RfGain_9100), 3);
821
		INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1_9100,
S
Sujith 已提交
822
			       ARRAY_SIZE(ar5416Bank1_9100), 2);
823
		INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2_9100,
S
Sujith 已提交
824
			       ARRAY_SIZE(ar5416Bank2_9100), 2);
825
		INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3_9100,
S
Sujith 已提交
826
			       ARRAY_SIZE(ar5416Bank3_9100), 3);
827
		INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6_9100,
S
Sujith 已提交
828
			       ARRAY_SIZE(ar5416Bank6_9100), 3);
829
		INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC_9100,
S
Sujith 已提交
830
			       ARRAY_SIZE(ar5416Bank6TPC_9100), 3);
831
		INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7_9100,
S
Sujith 已提交
832
			       ARRAY_SIZE(ar5416Bank7_9100), 2);
833
		INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9100,
S
Sujith 已提交
834 835
			       ARRAY_SIZE(ar5416Addac_9100), 2);
	} else {
836
		INIT_INI_ARRAY(&ah->iniModes, ar5416Modes,
S
Sujith 已提交
837
			       ARRAY_SIZE(ar5416Modes), 6);
838
		INIT_INI_ARRAY(&ah->iniCommon, ar5416Common,
S
Sujith 已提交
839
			       ARRAY_SIZE(ar5416Common), 2);
840
		INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0,
S
Sujith 已提交
841
			       ARRAY_SIZE(ar5416Bank0), 2);
842
		INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain,
S
Sujith 已提交
843
			       ARRAY_SIZE(ar5416BB_RfGain), 3);
844
		INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1,
S
Sujith 已提交
845
			       ARRAY_SIZE(ar5416Bank1), 2);
846
		INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2,
S
Sujith 已提交
847
			       ARRAY_SIZE(ar5416Bank2), 2);
848
		INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3,
S
Sujith 已提交
849
			       ARRAY_SIZE(ar5416Bank3), 3);
850
		INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6,
S
Sujith 已提交
851
			       ARRAY_SIZE(ar5416Bank6), 3);
852
		INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC,
S
Sujith 已提交
853
			       ARRAY_SIZE(ar5416Bank6TPC), 3);
854
		INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7,
S
Sujith 已提交
855
			       ARRAY_SIZE(ar5416Bank7), 2);
856
		INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac,
S
Sujith 已提交
857
			       ARRAY_SIZE(ar5416Addac), 2);
858 859
	}

860
	if (ah->is_pciexpress)
S
Sujith 已提交
861 862 863
		ath9k_hw_configpcipowersave(ah, 0);
	else
		ath9k_hw_disablepcie(ah);
864

865 866
	r = ath9k_hw_post_attach(ah);
	if (r)
S
Sujith 已提交
867
		goto bad;
868

869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890
	if (AR_SREV_9287_11(ah))
		INIT_INI_ARRAY(&ah->iniModesRxGain,
		ar9287Modes_rx_gain_9287_1_1,
		ARRAY_SIZE(ar9287Modes_rx_gain_9287_1_1), 6);
	else if (AR_SREV_9287_10(ah))
		INIT_INI_ARRAY(&ah->iniModesRxGain,
		ar9287Modes_rx_gain_9287_1_0,
		ARRAY_SIZE(ar9287Modes_rx_gain_9287_1_0), 6);
	else if (AR_SREV_9280_20(ah))
		ath9k_hw_init_rxgain_ini(ah);

	if (AR_SREV_9287_11(ah)) {
		INIT_INI_ARRAY(&ah->iniModesTxGain,
		ar9287Modes_tx_gain_9287_1_1,
		ARRAY_SIZE(ar9287Modes_tx_gain_9287_1_1), 6);
	} else if (AR_SREV_9287_10(ah)) {
		INIT_INI_ARRAY(&ah->iniModesTxGain,
		ar9287Modes_tx_gain_9287_1_0,
		ARRAY_SIZE(ar9287Modes_tx_gain_9287_1_0), 6);
	} else if (AR_SREV_9280_20(ah)) {
		ath9k_hw_init_txgain_ini(ah);
	} else if (AR_SREV_9285_12_OR_LATER(ah)) {
891 892 893 894 895 896 897 898 899 900 901 902 903 904 905
		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);
		}

	}

906
	ath9k_hw_fill_cap_info(ah);
S
Sujith 已提交
907 908 909 910 911

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

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

915 916
			for (j = 1; j < ah->iniModes.ia_columns; j++) {
				u32 val = INI_RA(&ah->iniModes, i, j);
917

918
				INI_RA(&ah->iniModes, i, j) =
919
					ath9k_hw_ini_fixup(ah,
920
							   &ah->eeprom.def,
S
Sujith 已提交
921 922
							   reg, val);
			}
923
		}
S
Sujith 已提交
924
	}
925

926 927
	r = ath9k_hw_init_macaddr(ah);
	if (r) {
S
Sujith 已提交
928 929
		DPRINTF(sc, ATH_DBG_FATAL,
			"Failed to initialize MAC address\n");
S
Sujith 已提交
930
		goto bad;
931 932
	}

S
Sujith 已提交
933
	if (AR_SREV_9285(ah))
934
		ah->tx_trig_level = (AR_FTRIG_256B >> AR_FTRIG_S);
S
Sujith 已提交
935
	else
936
		ah->tx_trig_level = (AR_FTRIG_512B >> AR_FTRIG_S);
937

S
Sujith 已提交
938
	ath9k_init_nfcal_hist_buffer(ah);
939

940
	return 0;
S
Sujith 已提交
941
bad:
942 943
	ath9k_hw_detach(ah);
	return r;
944 945
}

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

S
Sujith 已提交
951
	synthDelay = REG_READ(ah, AR_PHY_RX_DELAY) & AR_PHY_RX_DELAY_DELAY;
952
	if (IS_CHAN_B(chan))
S
Sujith 已提交
953 954 955
		synthDelay = (4 * synthDelay) / 22;
	else
		synthDelay /= 10;
956

S
Sujith 已提交
957
	REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
958

S
Sujith 已提交
959
	udelay(synthDelay + BASE_ACTIVATE_DELAY);
960 961
}

962
static void ath9k_hw_init_qos(struct ath_hw *ah)
963
{
S
Sujith 已提交
964 965
	REG_WRITE(ah, AR_MIC_QOS_CONTROL, 0x100aa);
	REG_WRITE(ah, AR_MIC_QOS_SELECT, 0x3210);
966

S
Sujith 已提交
967 968 969 970 971 972 973 974 975 976
	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);
977 978
}

979
static void ath9k_hw_init_pll(struct ath_hw *ah,
S
Sujith 已提交
980
			      struct ath9k_channel *chan)
981
{
S
Sujith 已提交
982
	u32 pll;
983

S
Sujith 已提交
984 985 986
	if (AR_SREV_9100(ah)) {
		if (chan && IS_CHAN_5GHZ(chan))
			pll = 0x1450;
987
		else
S
Sujith 已提交
988 989 990 991
			pll = 0x1458;
	} else {
		if (AR_SREV_9280_10_OR_LATER(ah)) {
			pll = SM(0x5, AR_RTC_9160_PLL_REFDIV);
992

S
Sujith 已提交
993 994 995 996
			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);
997

S
Sujith 已提交
998 999
			if (chan && IS_CHAN_5GHZ(chan)) {
				pll |= SM(0x28, AR_RTC_9160_PLL_DIV);
1000 1001


S
Sujith 已提交
1002 1003 1004 1005 1006 1007 1008 1009 1010 1011
				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);
			}
1012

S
Sujith 已提交
1013
		} else if (AR_SREV_9160_10_OR_LATER(ah)) {
1014

S
Sujith 已提交
1015
			pll = SM(0x5, AR_RTC_9160_PLL_REFDIV);
1016

S
Sujith 已提交
1017 1018 1019 1020
			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);
1021

S
Sujith 已提交
1022 1023 1024 1025 1026 1027
			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;
1028

S
Sujith 已提交
1029 1030 1031 1032
			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);
1033

S
Sujith 已提交
1034 1035 1036 1037 1038 1039
			if (chan && IS_CHAN_5GHZ(chan))
				pll |= SM(0xa, AR_RTC_PLL_DIV);
			else
				pll |= SM(0xb, AR_RTC_PLL_DIV);
		}
	}
1040
	REG_WRITE(ah, AR_RTC_PLL_CONTROL, pll);
1041

S
Sujith 已提交
1042 1043 1044
	udelay(RTC_PLL_SETTLE_DELAY);

	REG_WRITE(ah, AR_RTC_SLEEP_CLK, AR_RTC_FORCE_DERIVED_CLK);
1045 1046
}

1047
static void ath9k_hw_init_chain_masks(struct ath_hw *ah)
1048 1049 1050
{
	int rx_chainmask, tx_chainmask;

1051 1052
	rx_chainmask = ah->rxchainmask;
	tx_chainmask = ah->txchainmask;
1053 1054 1055 1056 1057 1058

	switch (rx_chainmask) {
	case 0x5:
		REG_SET_BIT(ah, AR_PHY_ANALOG_SWAP,
			    AR_PHY_SWAP_ALT_CHAIN);
	case 0x3:
1059
		if (((ah)->hw_version.macVersion <= AR_SREV_VERSION_9160)) {
1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083
			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);
}

1084
static void ath9k_hw_init_interrupt_masks(struct ath_hw *ah,
1085
					  enum nl80211_iftype opmode)
1086
{
1087
	ah->mask_reg = AR_IMR_TXERR |
S
Sujith 已提交
1088 1089 1090 1091
		AR_IMR_TXURN |
		AR_IMR_RXERR |
		AR_IMR_RXORN |
		AR_IMR_BCNMISC;
1092

1093
	if (ah->config.intr_mitigation)
1094
		ah->mask_reg |= AR_IMR_RXINTM | AR_IMR_RXMINTR;
1095
	else
1096
		ah->mask_reg |= AR_IMR_RXOK;
1097

1098
	ah->mask_reg |= AR_IMR_TXOK;
1099

1100
	if (opmode == NL80211_IFTYPE_AP)
1101
		ah->mask_reg |= AR_IMR_MIB;
1102

1103
	REG_WRITE(ah, AR_IMR, ah->mask_reg);
S
Sujith 已提交
1104
	REG_WRITE(ah, AR_IMR_S2, REG_READ(ah, AR_IMR_S2) | AR_IMR_S2_GTT);
1105

S
Sujith 已提交
1106 1107 1108 1109 1110
	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);
	}
1111 1112
}

1113
static bool ath9k_hw_set_ack_timeout(struct ath_hw *ah, u32 us)
1114 1115
{
	if (us > ath9k_hw_mac_to_usec(ah, MS(0xffffffff, AR_TIME_OUT_ACK))) {
S
Sujith 已提交
1116
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "bad ack timeout %u\n", us);
1117
		ah->acktimeout = (u32) -1;
1118 1119 1120 1121
		return false;
	} else {
		REG_RMW_FIELD(ah, AR_TIME_OUT,
			      AR_TIME_OUT_ACK, ath9k_hw_mac_to_clks(ah, us));
1122
		ah->acktimeout = us;
1123 1124 1125 1126
		return true;
	}
}

1127
static bool ath9k_hw_set_cts_timeout(struct ath_hw *ah, u32 us)
1128 1129
{
	if (us > ath9k_hw_mac_to_usec(ah, MS(0xffffffff, AR_TIME_OUT_CTS))) {
S
Sujith 已提交
1130
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "bad cts timeout %u\n", us);
1131
		ah->ctstimeout = (u32) -1;
1132 1133 1134 1135
		return false;
	} else {
		REG_RMW_FIELD(ah, AR_TIME_OUT,
			      AR_TIME_OUT_CTS, ath9k_hw_mac_to_clks(ah, us));
1136
		ah->ctstimeout = us;
1137 1138 1139
		return true;
	}
}
S
Sujith 已提交
1140

1141
static bool ath9k_hw_set_global_txtimeout(struct ath_hw *ah, u32 tu)
1142 1143 1144
{
	if (tu > 0xFFFF) {
		DPRINTF(ah->ah_sc, ATH_DBG_XMIT,
S
Sujith 已提交
1145
			"bad global tx timeout %u\n", tu);
1146
		ah->globaltxtimeout = (u32) -1;
1147 1148 1149
		return false;
	} else {
		REG_RMW_FIELD(ah, AR_GTXTO, AR_GTXTO_TIMEOUT_LIMIT, tu);
1150
		ah->globaltxtimeout = tu;
1151 1152 1153 1154
		return true;
	}
}

1155
static void ath9k_hw_init_user_settings(struct ath_hw *ah)
1156
{
1157 1158
	DPRINTF(ah->ah_sc, ATH_DBG_RESET, "ah->misc_mode 0x%x\n",
		ah->misc_mode);
1159

1160
	if (ah->misc_mode != 0)
S
Sujith 已提交
1161
		REG_WRITE(ah, AR_PCU_MISC,
1162 1163 1164 1165 1166 1167 1168 1169 1170
			  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 已提交
1171 1172 1173 1174 1175 1176 1177 1178
}

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

1179
void ath9k_hw_detach(struct ath_hw *ah)
S
Sujith 已提交
1180 1181 1182 1183 1184 1185 1186 1187 1188
{
	if (!AR_SREV_9100(ah))
		ath9k_hw_ani_detach(ah);

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

1189
int ath9k_hw_attach(struct ath_hw *ah, u16 devid, struct ath_softc *sc)
S
Sujith 已提交
1190 1191 1192 1193
{
	switch (devid) {
	case AR5416_DEVID_PCI:
	case AR5416_DEVID_PCIE:
G
Gabor Juhos 已提交
1194
	case AR5416_AR9100_DEVID:
S
Sujith 已提交
1195 1196 1197
	case AR9160_DEVID_PCI:
	case AR9280_DEVID_PCI:
	case AR9280_DEVID_PCIE:
1198
	case AR9285_DEVID_PCIE:
1199 1200
	case AR5416_DEVID_AR9287_PCI:
	case AR5416_DEVID_AR9287_PCIE:
1201
		return ath9k_hw_do_attach(ah, devid, sc);
S
Sujith 已提交
1202 1203
	default:
		break;
1204
	}
1205
	return -EOPNOTSUPP;
S
Sujith 已提交
1206 1207 1208 1209 1210 1211
}

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

1212
static void ath9k_hw_override_ini(struct ath_hw *ah,
S
Sujith 已提交
1213 1214
				  struct ath9k_channel *chan)
{
1215 1216 1217 1218 1219 1220 1221 1222
	/*
	 * 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));


1223
	if (!AR_SREV_5416_20_OR_LATER(ah) ||
S
Sujith 已提交
1224 1225 1226 1227
	    AR_SREV_9280_10_OR_LATER(ah))
		return;

	REG_WRITE(ah, 0x9800 + (651 << 2), 0x11);
1228 1229
}

1230
static u32 ath9k_hw_def_ini_fixup(struct ath_hw *ah,
1231
			      struct ar5416_eeprom_def *pEepData,
S
Sujith 已提交
1232
			      u32 reg, u32 value)
1233
{
S
Sujith 已提交
1234
	struct base_eep_header *pBase = &(pEepData->baseEepHeader);
1235

1236
	switch (ah->hw_version.devid) {
S
Sujith 已提交
1237 1238
	case AR9280_DEVID_PCI:
		if (reg == 0x7894) {
S
Sujith 已提交
1239
			DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1240 1241 1242 1243
				"ini VAL: %x  EEPROM: %x\n", value,
				(pBase->version & 0xff));

			if ((pBase->version & 0xff) > 0x0a) {
S
Sujith 已提交
1244
				DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1245 1246 1247 1248 1249 1250
					"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 已提交
1251
				DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1252 1253 1254
					"PWDCLKIND Earlier Rev\n");
			}

S
Sujith 已提交
1255
			DPRINTF(ah->ah_sc, ATH_DBG_EEPROM,
S
Sujith 已提交
1256 1257 1258 1259 1260 1261
				"final ini VAL: %x\n", value);
		}
		break;
	}

	return value;
1262 1263
}

1264
static u32 ath9k_hw_ini_fixup(struct ath_hw *ah,
1265 1266 1267
			      struct ar5416_eeprom_def *pEepData,
			      u32 reg, u32 value)
{
1268
	if (ah->eep_map == EEP_MAP_4KBITS)
1269 1270 1271 1272 1273
		return value;
	else
		return ath9k_hw_def_ini_fixup(ah, pEepData, reg, value);
}

1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284
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;
}

1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299
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;
}

1300
static int ath9k_hw_process_ini(struct ath_hw *ah,
S
Sujith 已提交
1301 1302
				struct ath9k_channel *chan,
				enum ath9k_ht_macmode macmode)
1303 1304
{
	int i, regWrites = 0;
1305
	struct ieee80211_channel *channel = chan->chan;
1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336
	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 已提交
1337
	ah->eep_ops->set_addac(ah, chan);
1338

1339
	if (AR_SREV_5416_22_OR_LATER(ah)) {
1340
		REG_WRITE_ARRAY(&ah->iniAddac, 1, regWrites);
1341 1342 1343
	} else {
		struct ar5416IniArray temp;
		u32 addacSize =
1344 1345
			sizeof(u32) * ah->iniAddac.ia_rows *
			ah->iniAddac.ia_columns;
1346

1347 1348
		memcpy(ah->addac5416_21,
		       ah->iniAddac.ia_array, addacSize);
1349

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

1352 1353 1354
		temp.ia_array = ah->addac5416_21;
		temp.ia_columns = ah->iniAddac.ia_columns;
		temp.ia_rows = ah->iniAddac.ia_rows;
1355 1356
		REG_WRITE_ARRAY(&temp, 1, regWrites);
	}
S
Sujith 已提交
1357

1358 1359
	REG_WRITE(ah, AR_PHY_ADC_SERIAL_CTL, AR_PHY_SEL_INTERNAL_ADDAC);

1360 1361 1362
	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);
1363 1364 1365 1366

		REG_WRITE(ah, reg, val);

		if (reg >= 0x7800 && reg < 0x78a0
1367
		    && ah->config.analog_shiftreg) {
1368 1369 1370 1371 1372 1373
			udelay(100);
		}

		DO_DELAY(regWrites);
	}

1374
	if (AR_SREV_9280(ah) || AR_SREV_9287_10_OR_LATER(ah))
1375
		REG_WRITE_ARRAY(&ah->iniModesRxGain, modesIndex, regWrites);
1376

1377 1378
	if (AR_SREV_9280(ah) || AR_SREV_9285_12_OR_LATER(ah) ||
	    AR_SREV_9287_10_OR_LATER(ah))
1379
		REG_WRITE_ARRAY(&ah->iniModesTxGain, modesIndex, regWrites);
1380

1381 1382 1383
	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);
1384 1385 1386 1387

		REG_WRITE(ah, reg, val);

		if (reg >= 0x7800 && reg < 0x78a0
1388
		    && ah->config.analog_shiftreg) {
1389 1390 1391 1392 1393 1394 1395 1396 1397
			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)) {
1398
		REG_WRITE_ARRAY(&ah->iniModesAdditional, modesIndex,
1399 1400 1401 1402 1403 1404 1405
				regWrites);
	}

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

1406 1407 1408
	if (OLC_FOR_AR9280_20_LATER)
		ath9k_olc_init(ah);

1409 1410 1411 1412 1413 1414
	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));
1415 1416

	if (!ath9k_hw_set_rf_regs(ah, chan, freqIndex)) {
S
Sujith 已提交
1417
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
1418
			"ar5416SetRfRegs failed\n");
1419 1420 1421 1422 1423 1424
		return -EIO;
	}

	return 0;
}

S
Sujith 已提交
1425 1426 1427 1428
/****************************************/
/* Reset and Channel Switching Routines */
/****************************************/

1429
static void ath9k_hw_set_rfmode(struct ath_hw *ah, struct ath9k_channel *chan)
1430
{
S
Sujith 已提交
1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448
	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);
}

1449
static void ath9k_hw_mark_phy_inactive(struct ath_hw *ah)
S
Sujith 已提交
1450 1451 1452 1453
{
	REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_DIS);
}

1454
static inline void ath9k_hw_set_dma(struct ath_hw *ah)
S
Sujith 已提交
1455 1456 1457 1458 1459 1460 1461 1462 1463
{
	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);

1464
	REG_RMW_FIELD(ah, AR_TXCFG, AR_FTRIG, ah->tx_trig_level);
S
Sujith 已提交
1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479

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

1480
static void ath9k_hw_set_operating_mode(struct ath_hw *ah, int opmode)
S
Sujith 已提交
1481 1482 1483 1484 1485 1486
{
	u32 val;

	val = REG_READ(ah, AR_STA_ID1);
	val &= ~(AR_STA_ID1_STA_AP | AR_STA_ID1_ADHOC);
	switch (opmode) {
1487
	case NL80211_IFTYPE_AP:
S
Sujith 已提交
1488 1489 1490
		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);
1491
		break;
1492
	case NL80211_IFTYPE_ADHOC:
1493
	case NL80211_IFTYPE_MESH_POINT:
S
Sujith 已提交
1494 1495 1496
		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);
1497
		break;
1498 1499
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_MONITOR:
S
Sujith 已提交
1500
		REG_WRITE(ah, AR_STA_ID1, val | AR_STA_ID1_KSRCH_MODE);
1501
		break;
S
Sujith 已提交
1502 1503 1504
	}
}

1505
static inline void ath9k_hw_get_delta_slope_vals(struct ath_hw *ah,
S
Sujith 已提交
1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523
						 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;
}

1524
static void ath9k_hw_set_delta_slope(struct ath_hw *ah,
S
Sujith 已提交
1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557
				     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);
}

1558
static bool ath9k_hw_set_reset(struct ath_hw *ah, int type)
S
Sujith 已提交
1559 1560 1561 1562
{
	u32 rst_flags;
	u32 tmpReg;

1563 1564 1565 1566 1567 1568 1569 1570
	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 已提交
1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592
	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;
	}

1593
	REG_WRITE(ah, AR_RTC_RC, rst_flags);
S
Sujith 已提交
1594 1595
	udelay(50);

1596
	REG_WRITE(ah, AR_RTC_RC, 0);
S
Sujith 已提交
1597
	if (!ath9k_hw_wait(ah, AR_RTC_RC, AR_RTC_RC_M, 0, AH_WAIT_TIMEOUT)) {
S
Sujith 已提交
1598
		DPRINTF(ah->ah_sc, ATH_DBG_RESET,
S
Sujith 已提交
1599
			"RTC stuck in MAC reset\n");
S
Sujith 已提交
1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613
		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;
}

1614
static bool ath9k_hw_set_reset_power_on(struct ath_hw *ah)
S
Sujith 已提交
1615 1616 1617 1618
{
	REG_WRITE(ah, AR_RTC_FORCE_WAKE, AR_RTC_FORCE_WAKE_EN |
		  AR_RTC_FORCE_WAKE_ON_INT);

1619
	REG_WRITE(ah, AR_RTC_RESET, 0);
1620
	udelay(2);
1621
	REG_WRITE(ah, AR_RTC_RESET, 1);
S
Sujith 已提交
1622 1623 1624 1625

	if (!ath9k_hw_wait(ah,
			   AR_RTC_STATUS,
			   AR_RTC_STATUS_M,
S
Sujith 已提交
1626 1627
			   AR_RTC_STATUS_ON,
			   AH_WAIT_TIMEOUT)) {
S
Sujith 已提交
1628
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "RTC not waking up\n");
S
Sujith 已提交
1629
		return false;
1630 1631
	}

S
Sujith 已提交
1632 1633 1634 1635 1636
	ath9k_hw_read_revisions(ah);

	return ath9k_hw_set_reset(ah, ATH9K_RESET_WARM);
}

1637
static bool ath9k_hw_set_reset_reg(struct ath_hw *ah, u32 type)
S
Sujith 已提交
1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650
{
	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;
	}
1651 1652
}

1653
static void ath9k_hw_set_regs(struct ath_hw *ah, struct ath9k_channel *chan,
S
Sujith 已提交
1654
			      enum ath9k_ht_macmode macmode)
1655
{
S
Sujith 已提交
1656
	u32 phymode;
1657
	u32 enableDacFifo = 0;
1658

1659 1660 1661 1662
	if (AR_SREV_9285_10_OR_LATER(ah))
		enableDacFifo = (REG_READ(ah, AR_PHY_TURBO) &
					 AR_PHY_FC_ENABLE_DAC_FIFO);

S
Sujith 已提交
1663
	phymode = AR_PHY_FC_HT_EN | AR_PHY_FC_SHORT_GI_40
1664
		| AR_PHY_FC_SINGLE_HT_LTF1 | AR_PHY_FC_WALSH | enableDacFifo;
S
Sujith 已提交
1665 1666 1667

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

S
Sujith 已提交
1669 1670 1671
		if ((chan->chanmode == CHANNEL_A_HT40PLUS) ||
		    (chan->chanmode == CHANNEL_G_HT40PLUS))
			phymode |= AR_PHY_FC_DYN2040_PRI_CH;
1672

1673
		if (ah->extprotspacing == ATH9K_HT_EXTPROTSPACING_25)
S
Sujith 已提交
1674
			phymode |= AR_PHY_FC_DYN2040_EXT_CH;
1675
	}
S
Sujith 已提交
1676 1677 1678
	REG_WRITE(ah, AR_PHY_TURBO, phymode);

	ath9k_hw_set11nmac2040(ah, macmode);
1679

S
Sujith 已提交
1680 1681
	REG_WRITE(ah, AR_GTXTO, 25 << AR_GTXTO_TIMEOUT_LIMIT_S);
	REG_WRITE(ah, AR_CST, 0xF << AR_CST_TIMEOUT_LIMIT_S);
1682 1683
}

1684
static bool ath9k_hw_chip_reset(struct ath_hw *ah,
S
Sujith 已提交
1685
				struct ath9k_channel *chan)
1686
{
1687 1688 1689 1690
	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 已提交
1691
		return false;
1692

S
Sujith 已提交
1693 1694
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE))
		return false;
1695

1696
	ah->chip_fullsleep = false;
S
Sujith 已提交
1697 1698
	ath9k_hw_init_pll(ah, chan);
	ath9k_hw_set_rfmode(ah, chan);
1699

S
Sujith 已提交
1700
	return true;
1701 1702
}

1703
static bool ath9k_hw_channel_change(struct ath_hw *ah,
S
Sujith 已提交
1704 1705
				    struct ath9k_channel *chan,
				    enum ath9k_ht_macmode macmode)
1706
{
1707
	struct ieee80211_channel *channel = chan->chan;
1708 1709 1710 1711 1712
	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 已提交
1713
				"Transmit frames pending on queue %d\n", qnum);
1714 1715 1716 1717 1718 1719
			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 已提交
1720
			   AR_PHY_RFBUS_GRANT_EN, AH_WAIT_TIMEOUT)) {
S
Sujith 已提交
1721
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
1722
			"Could not kill baseband RX\n");
1723 1724 1725 1726 1727 1728
		return false;
	}

	ath9k_hw_set_regs(ah, chan, macmode);

	if (AR_SREV_9280_10_OR_LATER(ah)) {
1729
		ath9k_hw_ar9280_set_channel(ah, chan);
1730 1731
	} else {
		if (!(ath9k_hw_set_channel(ah, chan))) {
S
Sujith 已提交
1732 1733
			DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
				"Failed to set channel\n");
1734 1735 1736 1737
			return false;
		}
	}

1738
	ah->eep_ops->set_txpower(ah, chan,
1739
			     ath9k_regd_get_ctl(&ah->regulatory, chan),
S
Sujith 已提交
1740 1741 1742
			     channel->max_antenna_gain * 2,
			     channel->max_power * 2,
			     min((u32) MAX_RATE_POWER,
1743
			     (u32) ah->regulatory.power_limit));
1744 1745

	synthDelay = REG_READ(ah, AR_PHY_RX_DELAY) & AR_PHY_RX_DELAY_DELAY;
1746
	if (IS_CHAN_B(chan))
1747 1748 1749 1750 1751 1752 1753 1754
		synthDelay = (4 * synthDelay) / 22;
	else
		synthDelay /= 10;

	udelay(synthDelay + BASE_ACTIVATE_DELAY);

	REG_WRITE(ah, AR_PHY_RFBUS_REQ, 0);

S
Sujith 已提交
1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768
	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;
}

1769
static void ath9k_hw_9280_spur_mitigate(struct ath_hw *ah, struct ath9k_channel *chan)
S
Sujith 已提交
1770 1771 1772 1773 1774 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
{
	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;

1803
	ah->config.spurmode = SPUR_ENABLE_EEPROM;
S
Sujith 已提交
1804
	for (i = 0; i < AR_EEPROM_MODAL_SPURS; i++) {
S
Sujith 已提交
1805
		cur_bb_spur = ah->eep_ops->get_spur_channel(ah, i, is2GHz);
S
Sujith 已提交
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 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915

		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 已提交
1916
			volatile int tmp_v = abs(cur_vit_mask - bin);
S
Sujith 已提交
1917

L
Luis R. Rodriguez 已提交
1918
			if (tmp_v < 75)
S
Sujith 已提交
1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983
				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);
1984

S
Sujith 已提交
1985 1986 1987 1988 1989 1990 1991 1992 1993 1994
	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);
1995

S
Sujith 已提交
1996 1997 1998 1999 2000 2001 2002 2003 2004 2005
	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);
2006

S
Sujith 已提交
2007 2008 2009 2010 2011 2012 2013 2014 2015 2016
	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);
2017 2018
}

2019
static void ath9k_hw_spur_mitigate(struct ath_hw *ah, struct ath9k_channel *chan)
2020
{
S
Sujith 已提交
2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035
	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 };
2036

S
Sujith 已提交
2037 2038 2039 2040 2041 2042
	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);
2043

S
Sujith 已提交
2044 2045
	memset(&mask_m, 0, sizeof(int8_t) * 123);
	memset(&mask_p, 0, sizeof(int8_t) * 123);
2046

S
Sujith 已提交
2047
	for (i = 0; i < AR_EEPROM_MODAL_SPURS; i++) {
S
Sujith 已提交
2048
		cur_bb_spur = ah->eep_ops->get_spur_channel(ah, i, is2GHz);
S
Sujith 已提交
2049 2050 2051 2052 2053 2054 2055 2056
		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;
		}
	}
2057

S
Sujith 已提交
2058 2059
	if (AR_NO_SPUR == bb_spur)
		return;
2060

S
Sujith 已提交
2061
	bin = bb_spur * 32;
2062

S
Sujith 已提交
2063 2064 2065 2066 2067
	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);
2068

S
Sujith 已提交
2069
	REG_WRITE(ah, AR_PHY_TIMING_CTRL4(0), new);
2070

S
Sujith 已提交
2071 2072 2073 2074 2075 2076
	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);
2077

S
Sujith 已提交
2078 2079
	spur_delta_phase = ((bb_spur * 524288) / 100) &
		AR_PHY_TIMING11_SPUR_DELTA_PHASE;
2080

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

S
Sujith 已提交
2084 2085 2086 2087
	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);
2088

S
Sujith 已提交
2089 2090 2091
	cur_bin = -6000;
	upper = bin + 100;
	lower = bin - 100;
2092

S
Sujith 已提交
2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106
	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);
2107 2108
	}

S
Sujith 已提交
2109 2110 2111
	cur_vit_mask = 6100;
	upper = bin + 120;
	lower = bin - 120;
2112

S
Sujith 已提交
2113 2114
	for (i = 0; i < 123; i++) {
		if ((cur_vit_mask > lower) && (cur_vit_mask < upper)) {
2115

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

L
Luis R. Rodriguez 已提交
2119
			if (tmp_v < 75)
S
Sujith 已提交
2120 2121 2122 2123 2124 2125 2126 2127 2128
				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;
2129 2130
	}

S
Sujith 已提交
2131 2132 2133 2134 2135 2136 2137 2138 2139 2140
	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);
2141

S
Sujith 已提交
2142 2143 2144 2145 2146 2147 2148 2149 2150 2151
	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);
2152

S
Sujith 已提交
2153 2154 2155 2156 2157 2158 2159 2160 2161 2162
	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);
2163

S
Sujith 已提交
2164 2165 2166 2167 2168 2169 2170 2171 2172 2173
	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);
2174

S
Sujith 已提交
2175 2176 2177 2178 2179 2180 2181 2182 2183 2184
	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);
2185

S
Sujith 已提交
2186 2187 2188 2189 2190 2191 2192 2193 2194 2195
	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);
2196

S
Sujith 已提交
2197 2198 2199 2200 2201 2202 2203 2204 2205 2206
	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);
2207

S
Sujith 已提交
2208 2209 2210 2211 2212 2213 2214 2215 2216 2217
	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);
2218 2219
}

J
Johannes Berg 已提交
2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231
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);
}

2232
int ath9k_hw_reset(struct ath_hw *ah, struct ath9k_channel *chan,
2233
		    bool bChannelChange)
2234 2235
{
	u32 saveLedState;
2236
	struct ath_softc *sc = ah->ah_sc;
2237
	struct ath9k_channel *curchan = ah->curchan;
2238 2239
	u32 saveDefAntenna;
	u32 macStaId1;
2240
	int i, rx_chainmask, r;
2241

2242 2243 2244
	ah->extprotspacing = sc->ht_extprotspacing;
	ah->txchainmask = sc->tx_chainmask;
	ah->rxchainmask = sc->rx_chainmask;
2245

2246 2247
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE))
		return -EIO;
2248 2249 2250 2251 2252

	if (curchan)
		ath9k_hw_getnf(ah, curchan);

	if (bChannelChange &&
2253 2254 2255
	    (ah->chip_fullsleep != true) &&
	    (ah->curchan != NULL) &&
	    (chan->channel != ah->curchan->channel) &&
2256
	    ((chan->channelFlags & CHANNEL_ALL) ==
2257
	     (ah->curchan->channelFlags & CHANNEL_ALL)) &&
2258
	    (!AR_SREV_9280(ah) || (!IS_CHAN_A_5MHZ_SPACED(chan) &&
2259
				   !IS_CHAN_A_5MHZ_SPACED(ah->curchan)))) {
2260

2261
		if (ath9k_hw_channel_change(ah, chan, sc->tx_chan_width)) {
2262
			ath9k_hw_loadnf(ah, ah->curchan);
2263
			ath9k_hw_start_nfcal(ah);
2264
			return 0;
2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280
		}
	}

	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 已提交
2281
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL, "Chip reset failed\n");
2282
		return -EINVAL;
2283 2284
	}

2285 2286
	if (AR_SREV_9280_10_OR_LATER(ah))
		REG_SET_BIT(ah, AR_GPIO_INPUT_EN_VAL, AR_GPIO_JTAG_DISABLE);
2287

2288 2289 2290 2291 2292 2293 2294 2295 2296 2297
	if (AR_SREV_9287_10_OR_LATER(ah)) {
		/* Enable ASYNC FIFO */
		REG_SET_BIT(ah, AR_MAC_PCU_ASYNC_FIFO_REG3,
				AR_MAC_PCU_ASYNC_FIFO_REG3_DATAPATH_SEL);
		REG_SET_BIT(ah, AR_PHY_MODE, AR_PHY_MODE_ASYNCFIFO);
		REG_CLR_BIT(ah, AR_MAC_PCU_ASYNC_FIFO_REG3,
				AR_MAC_PCU_ASYNC_FIFO_REG3_SOFT_RESET);
		REG_SET_BIT(ah, AR_MAC_PCU_ASYNC_FIFO_REG3,
				AR_MAC_PCU_ASYNC_FIFO_REG3_SOFT_RESET);
	}
2298 2299 2300
	r = ath9k_hw_process_ini(ah, chan, sc->tx_chan_width);
	if (r)
		return r;
2301

2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318
	/* 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;

2319 2320 2321 2322 2323 2324 2325 2326
	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);

2327
	ah->eep_ops->set_board_values(ah, chan);
2328 2329 2330

	ath9k_hw_decrease_chain_power(ah, chan);

S
Sujith 已提交
2331 2332
	REG_WRITE(ah, AR_STA_ID0, get_unaligned_le32(ah->macaddr));
	REG_WRITE(ah, AR_STA_ID1, get_unaligned_le16(ah->macaddr + 4)
2333 2334
		  | macStaId1
		  | AR_STA_ID1_RTS_USE_DEF
2335
		  | (ah->config.
2336
		     ack_6mb ? AR_STA_ID1_ACKCTS_6MB : 0)
2337 2338
		  | ah->sta_id1_defaults);
	ath9k_hw_set_operating_mode(ah, ah->opmode);
2339

S
Sujith 已提交
2340 2341
	REG_WRITE(ah, AR_BSSMSKL, get_unaligned_le32(sc->bssidmask));
	REG_WRITE(ah, AR_BSSMSKU, get_unaligned_le16(sc->bssidmask + 4));
2342 2343 2344

	REG_WRITE(ah, AR_DEF_ANTENNA, saveDefAntenna);

S
Sujith 已提交
2345 2346 2347
	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));
2348 2349 2350 2351 2352

	REG_WRITE(ah, AR_ISR, ~0);

	REG_WRITE(ah, AR_RSSI_THR, INIT_RSSI_THR);

2353 2354 2355
	if (AR_SREV_9280_10_OR_LATER(ah))
		ath9k_hw_ar9280_set_channel(ah, chan);
	else
2356 2357
		if (!(ath9k_hw_set_channel(ah, chan)))
			return -EIO;
2358 2359 2360 2361

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

2362 2363
	ah->intr_txqs = 0;
	for (i = 0; i < ah->caps.total_queues; i++)
2364 2365
		ath9k_hw_resettxqueue(ah, i);

2366
	ath9k_hw_init_interrupt_masks(ah, ah->opmode);
2367 2368
	ath9k_hw_init_qos(ah);

2369
	if (ah->caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
2370
		ath9k_enable_rfkill(ah);
J
Johannes Berg 已提交
2371

2372 2373
	ath9k_hw_init_user_settings(ah);

2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394
	if (AR_SREV_9287_10_OR_LATER(ah)) {
		REG_WRITE(ah, AR_D_GBL_IFS_SIFS,
			  AR_D_GBL_IFS_SIFS_ASYNC_FIFO_DUR);
		REG_WRITE(ah, AR_D_GBL_IFS_SLOT,
			  AR_D_GBL_IFS_SLOT_ASYNC_FIFO_DUR);
		REG_WRITE(ah, AR_D_GBL_IFS_EIFS,
			  AR_D_GBL_IFS_EIFS_ASYNC_FIFO_DUR);

		REG_WRITE(ah, AR_TIME_OUT, AR_TIME_OUT_ACK_CTS_ASYNC_FIFO_DUR);
		REG_WRITE(ah, AR_USEC, AR_USEC_ASYNC_FIFO_DUR);

		REG_SET_BIT(ah, AR_MAC_PCU_LOGIC_ANALYZER,
			    AR_MAC_PCU_LOGIC_ANALYZER_DISBUG20768);
		REG_RMW_FIELD(ah, AR_AHB_MODE, AR_AHB_CUSTOM_BURST_EN,
			      AR_AHB_CUSTOM_BURST_ASYNC_FIFO_VAL);
	}
	if (AR_SREV_9287_10_OR_LATER(ah)) {
		REG_SET_BIT(ah, AR_PCU_MISC_MODE2,
				AR_PCU_MISC_MODE2_ENABLE_AGGWEP);
	}

2395 2396 2397 2398 2399 2400 2401
	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);

2402
	if (ah->config.intr_mitigation) {
2403 2404 2405 2406 2407 2408
		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);

2409
	if (!ath9k_hw_init_cal(ah, chan))
2410
		return -EIO;
2411

2412
	rx_chainmask = ah->rxchainmask;
2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424
	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 已提交
2425
				"CFG Byte Swap Set 0x%x\n", mask);
2426 2427 2428 2429 2430
		} 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 已提交
2431
				"Setting CFG 0x%x\n", REG_READ(ah, AR_CFG));
2432 2433 2434 2435 2436 2437 2438
		}
	} else {
#ifdef __BIG_ENDIAN
		REG_WRITE(ah, AR_CFG, AR_CFG_SWTD | AR_CFG_SWRD);
#endif
	}

2439
	return 0;
2440 2441
}

S
Sujith 已提交
2442 2443 2444
/************************/
/* Key Cache Management */
/************************/
2445

2446
bool ath9k_hw_keyreset(struct ath_hw *ah, u16 entry)
2447
{
S
Sujith 已提交
2448
	u32 keyType;
2449

2450
	if (entry >= ah->caps.keycache_size) {
S
Sujith 已提交
2451 2452
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"keychache entry %u out of range\n", entry);
2453 2454 2455
		return false;
	}

S
Sujith 已提交
2456
	keyType = REG_READ(ah, AR_KEYTABLE_TYPE(entry));
2457

S
Sujith 已提交
2458 2459 2460 2461 2462 2463 2464 2465
	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);
2466

S
Sujith 已提交
2467 2468
	if (keyType == AR_KEYTABLE_TYPE_TKIP && ATH9K_IS_MIC_ENABLED(ah)) {
		u16 micentry = entry + 64;
2469

S
Sujith 已提交
2470 2471 2472 2473
		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);
2474 2475 2476

	}

2477
	if (ah->curchan == NULL)
S
Sujith 已提交
2478
		return true;
2479 2480 2481 2482

	return true;
}

2483
bool ath9k_hw_keysetmac(struct ath_hw *ah, u16 entry, const u8 *mac)
2484
{
S
Sujith 已提交
2485
	u32 macHi, macLo;
2486

2487
	if (entry >= ah->caps.keycache_size) {
S
Sujith 已提交
2488 2489
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"keychache entry %u out of range\n", entry);
S
Sujith 已提交
2490
		return false;
2491 2492
	}

S
Sujith 已提交
2493 2494 2495 2496 2497 2498 2499 2500 2501
	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;
2502
	} else {
S
Sujith 已提交
2503
		macLo = macHi = 0;
2504
	}
S
Sujith 已提交
2505 2506
	REG_WRITE(ah, AR_KEYTABLE_MAC0(entry), macLo);
	REG_WRITE(ah, AR_KEYTABLE_MAC1(entry), macHi | AR_KEYTABLE_VALID);
2507

S
Sujith 已提交
2508
	return true;
2509 2510
}

2511
bool ath9k_hw_set_keycache_entry(struct ath_hw *ah, u16 entry,
S
Sujith 已提交
2512
				 const struct ath9k_keyval *k,
J
Jouni Malinen 已提交
2513
				 const u8 *mac)
2514
{
2515
	const struct ath9k_hw_capabilities *pCap = &ah->caps;
S
Sujith 已提交
2516 2517
	u32 key0, key1, key2, key3, key4;
	u32 keyType;
2518

S
Sujith 已提交
2519
	if (entry >= pCap->keycache_size) {
S
Sujith 已提交
2520 2521
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
			"keycache entry %u out of range\n", entry);
S
Sujith 已提交
2522
		return false;
2523 2524
	}

S
Sujith 已提交
2525 2526 2527 2528 2529 2530
	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 已提交
2531
			DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
2532
				"AES-CCM not supported by mac rev 0x%x\n",
2533
				ah->hw_version.macRev);
S
Sujith 已提交
2534 2535 2536 2537 2538 2539 2540 2541
			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 已提交
2542
			DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
2543
				"entry %u inappropriate for TKIP\n", entry);
S
Sujith 已提交
2544 2545 2546 2547
			return false;
		}
		break;
	case ATH9K_CIPHER_WEP:
2548
		if (k->kv_len < WLAN_KEY_LEN_WEP40) {
S
Sujith 已提交
2549
			DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
2550
				"WEP key length %u too small\n", k->kv_len);
S
Sujith 已提交
2551 2552
			return false;
		}
2553
		if (k->kv_len <= WLAN_KEY_LEN_WEP40)
S
Sujith 已提交
2554
			keyType = AR_KEYTABLE_TYPE_40;
2555
		else if (k->kv_len <= WLAN_KEY_LEN_WEP104)
S
Sujith 已提交
2556 2557 2558 2559 2560 2561 2562 2563
			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 已提交
2564
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
2565
			"cipher %u not supported\n", k->kv_type);
S
Sujith 已提交
2566
		return false;
2567 2568
	}

J
Jouni Malinen 已提交
2569 2570 2571 2572 2573
	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);
2574
	if (k->kv_len <= WLAN_KEY_LEN_WEP104)
S
Sujith 已提交
2575
		key4 &= 0xff;
2576

2577 2578 2579 2580 2581 2582 2583
	/*
	 * 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 已提交
2584 2585
	if (keyType == AR_KEYTABLE_TYPE_TKIP && ATH9K_IS_MIC_ENABLED(ah)) {
		u16 micentry = entry + 64;
2586

2587 2588 2589 2590 2591 2592
		/*
		 * 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 已提交
2593 2594
		REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), ~key0);
		REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), ~key1);
2595 2596

		/* Write key[95:48] */
S
Sujith 已提交
2597 2598
		REG_WRITE(ah, AR_KEYTABLE_KEY2(entry), key2);
		REG_WRITE(ah, AR_KEYTABLE_KEY3(entry), key3);
2599 2600

		/* Write key[127:96] and key type */
S
Sujith 已提交
2601 2602
		REG_WRITE(ah, AR_KEYTABLE_KEY4(entry), key4);
		REG_WRITE(ah, AR_KEYTABLE_TYPE(entry), keyType);
2603 2604

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

2607
		if (ah->misc_mode & AR_PCU_MIC_NEW_LOC_ENA) {
2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619
			/*
			 * 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 已提交
2620
			u32 mic0, mic1, mic2, mic3, mic4;
2621

S
Sujith 已提交
2622 2623 2624 2625 2626
			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);
2627 2628

			/* Write RX[31:0] and TX[31:16] */
S
Sujith 已提交
2629 2630
			REG_WRITE(ah, AR_KEYTABLE_KEY0(micentry), mic0);
			REG_WRITE(ah, AR_KEYTABLE_KEY1(micentry), mic1);
2631 2632

			/* Write RX[63:32] and TX[15:0] */
S
Sujith 已提交
2633 2634
			REG_WRITE(ah, AR_KEYTABLE_KEY2(micentry), mic2);
			REG_WRITE(ah, AR_KEYTABLE_KEY3(micentry), mic3);
2635 2636

			/* Write TX[63:32] and keyType(reserved) */
S
Sujith 已提交
2637 2638 2639
			REG_WRITE(ah, AR_KEYTABLE_KEY4(micentry), mic4);
			REG_WRITE(ah, AR_KEYTABLE_TYPE(micentry),
				  AR_KEYTABLE_TYPE_CLR);
2640

S
Sujith 已提交
2641
		} else {
2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657
			/*
			 * 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 已提交
2658
			u32 mic0, mic2;
2659

S
Sujith 已提交
2660 2661
			mic0 = get_unaligned_le32(k->kv_mic + 0);
			mic2 = get_unaligned_le32(k->kv_mic + 4);
2662 2663

			/* Write MIC key[31:0] */
S
Sujith 已提交
2664 2665
			REG_WRITE(ah, AR_KEYTABLE_KEY0(micentry), mic0);
			REG_WRITE(ah, AR_KEYTABLE_KEY1(micentry), 0);
2666 2667

			/* Write MIC key[63:32] */
S
Sujith 已提交
2668 2669
			REG_WRITE(ah, AR_KEYTABLE_KEY2(micentry), mic2);
			REG_WRITE(ah, AR_KEYTABLE_KEY3(micentry), 0);
2670 2671

			/* Write TX[63:32] and keyType(reserved) */
S
Sujith 已提交
2672 2673 2674 2675
			REG_WRITE(ah, AR_KEYTABLE_KEY4(micentry), 0);
			REG_WRITE(ah, AR_KEYTABLE_TYPE(micentry),
				  AR_KEYTABLE_TYPE_CLR);
		}
2676 2677

		/* MAC address registers are reserved for the MIC entry */
S
Sujith 已提交
2678 2679
		REG_WRITE(ah, AR_KEYTABLE_MAC0(micentry), 0);
		REG_WRITE(ah, AR_KEYTABLE_MAC1(micentry), 0);
2680 2681 2682 2683 2684 2685

		/*
		 * Write the correct (un-inverted) key[47:0] last to enable
		 * TKIP now that all other registers are set with correct
		 * values.
		 */
S
Sujith 已提交
2686 2687 2688
		REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), key0);
		REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), key1);
	} else {
2689
		/* Write key[47:0] */
S
Sujith 已提交
2690 2691
		REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), key0);
		REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), key1);
2692 2693

		/* Write key[95:48] */
S
Sujith 已提交
2694 2695
		REG_WRITE(ah, AR_KEYTABLE_KEY2(entry), key2);
		REG_WRITE(ah, AR_KEYTABLE_KEY3(entry), key3);
2696 2697

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

2701
		/* Write MAC address for the entry */
S
Sujith 已提交
2702 2703
		(void) ath9k_hw_keysetmac(ah, entry, mac);
	}
2704 2705 2706 2707

	return true;
}

2708
bool ath9k_hw_keyisvalid(struct ath_hw *ah, u16 entry)
2709
{
2710
	if (entry < ah->caps.keycache_size) {
S
Sujith 已提交
2711 2712 2713 2714 2715
		u32 val = REG_READ(ah, AR_KEYTABLE_MAC1(entry));
		if (val & AR_KEYTABLE_VALID)
			return true;
	}
	return false;
2716 2717
}

S
Sujith 已提交
2718 2719 2720 2721
/******************************/
/* Power Management (Chipset) */
/******************************/

2722
static void ath9k_set_power_sleep(struct ath_hw *ah, int setChip)
2723
{
S
Sujith 已提交
2724 2725 2726 2727 2728 2729
	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);
2730

2731
		REG_CLR_BIT(ah, (AR_RTC_RESET),
S
Sujith 已提交
2732 2733
			    AR_RTC_RESET_EN);
	}
2734 2735
}

2736
static void ath9k_set_power_network_sleep(struct ath_hw *ah, int setChip)
2737
{
S
Sujith 已提交
2738 2739
	REG_SET_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SAV);
	if (setChip) {
2740
		struct ath9k_hw_capabilities *pCap = &ah->caps;
2741

S
Sujith 已提交
2742 2743 2744 2745 2746 2747
		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);
2748 2749 2750 2751
		}
	}
}

2752
static bool ath9k_hw_set_power_awake(struct ath_hw *ah, int setChip)
2753
{
S
Sujith 已提交
2754 2755
	u32 val;
	int i;
2756

S
Sujith 已提交
2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767
	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);
2768

S
Sujith 已提交
2769 2770 2771
		REG_SET_BIT(ah, AR_RTC_FORCE_WAKE,
			    AR_RTC_FORCE_WAKE_EN);
		udelay(50);
2772

S
Sujith 已提交
2773 2774 2775 2776 2777 2778 2779
		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);
2780
		}
S
Sujith 已提交
2781
		if (i == 0) {
S
Sujith 已提交
2782
			DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
2783
				"Failed to wakeup in %uus\n", POWER_UP_TIME / 20);
S
Sujith 已提交
2784
			return false;
2785 2786 2787
		}
	}

S
Sujith 已提交
2788
	REG_CLR_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SAV);
2789

S
Sujith 已提交
2790
	return true;
2791 2792
}

2793 2794
static bool ath9k_hw_setpower_nolock(struct ath_hw *ah,
				     enum ath9k_power_mode mode)
2795
{
2796
	int status = true, setChip = true;
S
Sujith 已提交
2797 2798 2799 2800 2801 2802 2803
	static const char *modes[] = {
		"AWAKE",
		"FULL-SLEEP",
		"NETWORK SLEEP",
		"UNDEFINED"
	};

2804 2805 2806
	if (ah->power_mode == mode)
		return status;

S
Sujith 已提交
2807 2808
	DPRINTF(ah->ah_sc, ATH_DBG_RESET, "%s -> %s\n",
		modes[ah->power_mode], modes[mode]);
S
Sujith 已提交
2809 2810 2811 2812 2813 2814 2815

	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);
2816
		ah->chip_fullsleep = true;
S
Sujith 已提交
2817 2818 2819 2820
		break;
	case ATH9K_PM_NETWORK_SLEEP:
		ath9k_set_power_network_sleep(ah, setChip);
		break;
2821
	default:
S
Sujith 已提交
2822
		DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
S
Sujith 已提交
2823
			"Unknown power mode %u\n", mode);
2824 2825
		return false;
	}
2826
	ah->power_mode = mode;
S
Sujith 已提交
2827 2828

	return status;
2829 2830
}

2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842
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;
}

2843 2844
void ath9k_ps_wakeup(struct ath_softc *sc)
{
2845 2846 2847 2848 2849 2850
	unsigned long flags;

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

2851
	ath9k_hw_setpower_nolock(sc->sc_ah, ATH9K_PM_AWAKE);
2852 2853 2854

 unlock:
	spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
2855 2856 2857 2858
}

void ath9k_ps_restore(struct ath_softc *sc)
{
2859 2860 2861 2862 2863 2864
	unsigned long flags;

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

2865 2866 2867 2868 2869 2870
	if (sc->ps_enabled &&
	    !(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_nolock(sc->sc_ah, ATH9K_PM_NETWORK_SLEEP);
2871 2872 2873

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

2876 2877 2878 2879 2880 2881 2882 2883 2884
/*
 * 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.
 */
2885
void ath9k_hw_configpcipowersave(struct ath_hw *ah, int restore)
2886
{
S
Sujith 已提交
2887
	u8 i;
2888

2889
	if (ah->is_pciexpress != true)
S
Sujith 已提交
2890
		return;
2891

2892
	/* Do not touch SerDes registers */
2893
	if (ah->config.pcie_powersave_enable == 2)
S
Sujith 已提交
2894 2895
		return;

2896
	/* Nothing to do on restore for 11N */
S
Sujith 已提交
2897 2898 2899 2900
	if (restore)
		return;

	if (AR_SREV_9280_20_OR_LATER(ah)) {
2901 2902 2903 2904 2905
		/*
		 * AR9280 2.0 or later chips use SerDes values from the
		 * initvals.h initialized depending on chipset during
		 * ath9k_hw_do_attach()
		 */
2906 2907 2908
		for (i = 0; i < ah->iniPcieSerdes.ia_rows; i++) {
			REG_WRITE(ah, INI_RA(&ah->iniPcieSerdes, i, 0),
				  INI_RA(&ah->iniPcieSerdes, i, 1));
2909
		}
S
Sujith 已提交
2910
	} else if (AR_SREV_9280(ah) &&
2911
		   (ah->hw_version.macRev == AR_SREV_REVISION_9280_10)) {
S
Sujith 已提交
2912 2913 2914
		REG_WRITE(ah, AR_PCIE_SERDES, 0x9248fd00);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x24924924);

2915
		/* RX shut off when elecidle is asserted */
S
Sujith 已提交
2916 2917 2918 2919
		REG_WRITE(ah, AR_PCIE_SERDES, 0xa8000019);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x13160820);
		REG_WRITE(ah, AR_PCIE_SERDES, 0xe5980560);

2920
		/* Shut off CLKREQ active in L1 */
2921
		if (ah->config.pcie_clock_req)
S
Sujith 已提交
2922 2923 2924 2925 2926 2927 2928 2929
			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);

2930
		/* Load the new settings */
S
Sujith 已提交
2931 2932 2933 2934 2935
		REG_WRITE(ah, AR_PCIE_SERDES2, 0x00000000);

	} else {
		REG_WRITE(ah, AR_PCIE_SERDES, 0x9248fc00);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x24924924);
2936 2937

		/* RX shut off when elecidle is asserted */
S
Sujith 已提交
2938 2939 2940
		REG_WRITE(ah, AR_PCIE_SERDES, 0x28000039);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x53160824);
		REG_WRITE(ah, AR_PCIE_SERDES, 0xe5980579);
2941 2942 2943 2944 2945

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

S
Sujith 已提交
2948 2949 2950
		REG_WRITE(ah, AR_PCIE_SERDES, 0x1aaabe40);
		REG_WRITE(ah, AR_PCIE_SERDES, 0xbe105554);
		REG_WRITE(ah, AR_PCIE_SERDES, 0x000e3007);
2951 2952

		/* Load the new settings */
S
Sujith 已提交
2953
		REG_WRITE(ah, AR_PCIE_SERDES2, 0x00000000);
2954 2955
	}

2956 2957
	udelay(1000);

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

2961
	/* Several PCIe massages to ensure proper behaviour */
2962 2963
	if (ah->config.pcie_waen) {
		REG_WRITE(ah, AR_WA, ah->config.pcie_waen);
S
Sujith 已提交
2964
	} else {
2965 2966
		if (AR_SREV_9285(ah))
			REG_WRITE(ah, AR_WA, AR9285_WA_DEFAULT);
2967 2968 2969 2970
		/*
		 * On AR9280 chips bit 22 of 0x4004 needs to be set to
		 * otherwise card may disappear.
		 */
2971 2972
		else if (AR_SREV_9280(ah))
			REG_WRITE(ah, AR_WA, AR9280_WA_DEFAULT);
S
Sujith 已提交
2973
		else
2974
			REG_WRITE(ah, AR_WA, AR_WA_DEFAULT);
S
Sujith 已提交
2975
	}
2976 2977
}

S
Sujith 已提交
2978 2979 2980 2981
/**********************/
/* Interrupt Handling */
/**********************/

2982
bool ath9k_hw_intrpend(struct ath_hw *ah)
2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000
{
	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;
}

3001
bool ath9k_hw_getisr(struct ath_hw *ah, enum ath9k_int *masked)
3002 3003 3004
{
	u32 isr = 0;
	u32 mask2 = 0;
3005
	struct ath9k_hw_capabilities *pCap = &ah->caps;
3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016
	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 已提交
3017 3018
		sync_cause = REG_READ(ah, AR_INTR_SYNC_CAUSE) &
			AR_INTR_SYNC_DEFAULT;
3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044

		*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;
3045 3046
			if (isr2 & AR_ISR_S2_TSFOOR)
				mask2 |= ATH9K_INT_TSFOOR;
3047 3048 3049 3050 3051 3052 3053 3054 3055 3056
		}

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

		*masked = isr & ATH9K_INT_COMMON;

3057
		if (ah->config.intr_mitigation) {
3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071
			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);
3072 3073
			ah->intr_txqs |= MS(s0_s, AR_ISR_S0_QCU_TXOK);
			ah->intr_txqs |= MS(s0_s, AR_ISR_S0_QCU_TXDESC);
3074 3075

			s1_s = REG_READ(ah, AR_ISR_S1_S);
3076 3077
			ah->intr_txqs |= MS(s1_s, AR_ISR_S1_QCU_TXERR);
			ah->intr_txqs |= MS(s1_s, AR_ISR_S1_QCU_TXEOL);
3078 3079 3080 3081
		}

		if (isr & AR_ISR_RXORN) {
			DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT,
S
Sujith 已提交
3082
				"receive FIFO overrun interrupt\n");
3083 3084 3085
		}

		if (!AR_SREV_9100(ah)) {
3086
			if (!(pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
3087 3088 3089 3090 3091 3092 3093 3094
				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 已提交
3095

3096 3097
	if (AR_SREV_9100(ah))
		return true;
S
Sujith 已提交
3098

3099 3100 3101 3102 3103 3104 3105 3106 3107
	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 已提交
3108
					"received PCI FATAL interrupt\n");
3109 3110 3111
			}
			if (sync_cause & AR_INTR_SYNC_HOST1_PERR) {
				DPRINTF(ah->ah_sc, ATH_DBG_ANY,
S
Sujith 已提交
3112
					"received PCI PERR interrupt\n");
3113
			}
3114
			*masked |= ATH9K_INT_FATAL;
3115 3116 3117
		}
		if (sync_cause & AR_INTR_SYNC_RADM_CPL_TIMEOUT) {
			DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT,
S
Sujith 已提交
3118
				"AR_INTR_SYNC_RADM_CPL_TIMEOUT\n");
3119 3120 3121 3122 3123 3124
			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 已提交
3125
				"AR_INTR_SYNC_LOCAL_TIMEOUT\n");
3126 3127 3128 3129 3130
		}

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

3132 3133 3134
	return true;
}

3135
enum ath9k_int ath9k_hw_set_interrupts(struct ath_hw *ah, enum ath9k_int ints)
3136
{
3137
	u32 omask = ah->mask_reg;
3138
	u32 mask, mask2;
3139
	struct ath9k_hw_capabilities *pCap = &ah->caps;
3140

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

	if (omask & ATH9K_INT_GLOBAL) {
S
Sujith 已提交
3144
		DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "disable IER\n");
3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159
		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) {
3160
		if (ah->txok_interrupt_mask)
3161
			mask |= AR_IMR_TXOK;
3162
		if (ah->txdesc_interrupt_mask)
3163
			mask |= AR_IMR_TXDESC;
3164
		if (ah->txerr_interrupt_mask)
3165
			mask |= AR_IMR_TXERR;
3166
		if (ah->txeol_interrupt_mask)
3167 3168 3169 3170
			mask |= AR_IMR_TXEOL;
	}
	if (ints & ATH9K_INT_RX) {
		mask |= AR_IMR_RXERR;
3171
		if (ah->config.intr_mitigation)
3172 3173 3174
			mask |= AR_IMR_RXMINTR | AR_IMR_RXINTM;
		else
			mask |= AR_IMR_RXOK | AR_IMR_RXDESC;
3175
		if (!(pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187
			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)
3188 3189 3190
			mask2 |= AR_IMR_S2_CABEND;
		if (ints & ATH9K_INT_TSFOOR)
			mask2 |= AR_IMR_S2_TSFOOR;
3191 3192 3193 3194 3195 3196 3197 3198 3199 3200
	}

	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 已提交
3201
	DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "new IMR 0x%x\n", mask);
3202 3203 3204 3205 3206 3207 3208 3209 3210
	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);
3211
	ah->mask_reg = ints;
3212

3213
	if (!(pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
3214 3215 3216 3217 3218 3219 3220
		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 已提交
3221
		DPRINTF(ah->ah_sc, ATH_DBG_INTERRUPT, "enable IER\n");
3222 3223 3224 3225 3226 3227 3228 3229 3230 3231 3232 3233 3234 3235 3236 3237 3238 3239 3240
		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 已提交
3241 3242 3243 3244
/*******************/
/* Beacon Handling */
/*******************/

3245
void ath9k_hw_beaconinit(struct ath_hw *ah, u32 next_beacon, u32 beacon_period)
3246 3247 3248
{
	int flags = 0;

3249
	ah->beacon_interval = beacon_period;
3250

3251
	switch (ah->opmode) {
3252 3253
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_MONITOR:
3254 3255 3256 3257 3258
		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;
3259
	case NL80211_IFTYPE_ADHOC:
3260
	case NL80211_IFTYPE_MESH_POINT:
3261 3262 3263 3264
		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 +
3265 3266
				     (ah->atim_window ? ah->
				      atim_window : 1)));
3267
		flags |= AR_NDP_TIMER_EN;
3268
	case NL80211_IFTYPE_AP:
3269 3270 3271
		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 -
3272
				     ah->config.
3273
				     dma_beacon_response_time));
3274 3275
		REG_WRITE(ah, AR_NEXT_SWBA,
			  TU_TO_USEC(next_beacon -
3276
				     ah->config.
3277
				     sw_beacon_response_time));
3278 3279 3280
		flags |=
			AR_TBTT_TIMER_EN | AR_DBA_TIMER_EN | AR_SWBA_TIMER_EN;
		break;
3281 3282 3283
	default:
		DPRINTF(ah->ah_sc, ATH_DBG_BEACON,
			"%s: unsupported opmode: %d\n",
3284
			__func__, ah->opmode);
3285 3286
		return;
		break;
3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302
	}

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

3303
void ath9k_hw_set_sta_beacon_timers(struct ath_hw *ah,
S
Sujith 已提交
3304
				    const struct ath9k_beacon_state *bs)
3305 3306
{
	u32 nextTbtt, beaconintval, dtimperiod, beacontimeout;
3307
	struct ath9k_hw_capabilities *pCap = &ah->caps;
3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329 3330 3331 3332

	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 已提交
3333 3334 3335 3336
	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);
3337

S
Sujith 已提交
3338 3339 3340
	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));
3341

S
Sujith 已提交
3342 3343 3344
	REG_WRITE(ah, AR_SLEEP1,
		  SM((CAB_TIMEOUT_VAL << 3), AR_SLEEP1_CAB_TIMEOUT)
		  | AR_SLEEP1_ASSUME_DTIM);
3345

S
Sujith 已提交
3346 3347 3348 3349
	if (pCap->hw_caps & ATH9K_HW_CAP_AUTOSLEEP)
		beacontimeout = (BEACON_TIMEOUT_VAL << 3);
	else
		beacontimeout = MIN_BEACON_TIMEOUT_VAL;
3350

S
Sujith 已提交
3351 3352
	REG_WRITE(ah, AR_SLEEP2,
		  SM(beacontimeout, AR_SLEEP2_BEACON_TIMEOUT));
3353

S
Sujith 已提交
3354 3355
	REG_WRITE(ah, AR_TIM_PERIOD, TU_TO_USEC(beaconintval));
	REG_WRITE(ah, AR_DTIM_PERIOD, TU_TO_USEC(dtimperiod));
3356

S
Sujith 已提交
3357 3358 3359
	REG_SET_BIT(ah, AR_TIMER_MODE,
		    AR_TBTT_TIMER_EN | AR_TIM_TIMER_EN |
		    AR_DTIM_TIMER_EN);
3360

3361 3362
	/* TSF Out of Range Threshold */
	REG_WRITE(ah, AR_TSFOOR_THRESHOLD, bs->bs_tsfoor_threshold);
3363 3364
}

S
Sujith 已提交
3365 3366 3367 3368
/*******************/
/* HW Capabilities */
/*******************/

3369
void ath9k_hw_fill_cap_info(struct ath_hw *ah)
3370
{
3371
	struct ath9k_hw_capabilities *pCap = &ah->caps;
S
Sujith 已提交
3372
	u16 capField = 0, eeval;
3373

S
Sujith 已提交
3374
	eeval = ah->eep_ops->get_eeprom(ah, EEP_REG_0);
3375
	ah->regulatory.current_rd = eeval;
3376

S
Sujith 已提交
3377
	eeval = ah->eep_ops->get_eeprom(ah, EEP_REG_1);
3378 3379
	if (AR_SREV_9285_10_OR_LATER(ah))
		eeval |= AR9285_RDEXT_DEFAULT;
3380
	ah->regulatory.current_rd_ext = eeval;
3381

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

3384
	if (ah->opmode != NL80211_IFTYPE_AP &&
3385
	    ah->hw_version.subvendorid == AR_SUBVENDOR_ID_NEW_A) {
3386 3387 3388 3389 3390
		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 已提交
3391
		DPRINTF(ah->ah_sc, ATH_DBG_REGULATORY,
3392
			"regdomain mapped to 0x%x\n", ah->regulatory.current_rd);
S
Sujith 已提交
3393
	}
3394

S
Sujith 已提交
3395
	eeval = ah->eep_ops->get_eeprom(ah, EEP_OP_MODE);
S
Sujith 已提交
3396
	bitmap_zero(pCap->wireless_modes, ATH9K_MODE_MAX);
3397

S
Sujith 已提交
3398 3399
	if (eeval & AR5416_OPFLAGS_11A) {
		set_bit(ATH9K_MODE_11A, pCap->wireless_modes);
3400
		if (ah->config.ht_enable) {
S
Sujith 已提交
3401 3402 3403 3404 3405 3406 3407 3408 3409
			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);
			}
3410 3411 3412
		}
	}

S
Sujith 已提交
3413 3414
	if (eeval & AR5416_OPFLAGS_11G) {
		set_bit(ATH9K_MODE_11G, pCap->wireless_modes);
3415
		if (ah->config.ht_enable) {
S
Sujith 已提交
3416 3417 3418 3419 3420 3421 3422 3423 3424 3425
			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);
			}
		}
3426
	}
S
Sujith 已提交
3427

S
Sujith 已提交
3428
	pCap->tx_chainmask = ah->eep_ops->get_eeprom(ah, EEP_TX_MASK);
3429 3430 3431 3432 3433
	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);
3434

3435
	if (!(AR_SREV_9280(ah) && (ah->hw_version.macRev == 0)))
3436
		ah->misc_mode |= AR_PCU_MIC_NEW_LOC_ENA;
3437

S
Sujith 已提交
3438 3439
	pCap->low_2ghz_chan = 2312;
	pCap->high_2ghz_chan = 2732;
3440

S
Sujith 已提交
3441 3442
	pCap->low_5ghz_chan = 4920;
	pCap->high_5ghz_chan = 6100;
3443

S
Sujith 已提交
3444 3445 3446
	pCap->hw_caps &= ~ATH9K_HW_CAP_CIPHER_CKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_CIPHER_TKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_CIPHER_AESCCM;
3447

S
Sujith 已提交
3448 3449 3450
	pCap->hw_caps &= ~ATH9K_HW_CAP_MIC_CKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_MIC_TKIP;
	pCap->hw_caps |= ATH9K_HW_CAP_MIC_AESCCM;
3451

3452
	if (ah->config.ht_enable)
S
Sujith 已提交
3453 3454 3455
		pCap->hw_caps |= ATH9K_HW_CAP_HT;
	else
		pCap->hw_caps &= ~ATH9K_HW_CAP_HT;
3456

S
Sujith 已提交
3457 3458 3459 3460
	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;
3461

S
Sujith 已提交
3462 3463 3464 3465 3466
	if (capField & AR_EEPROM_EEPCAP_MAXQCU)
		pCap->total_queues =
			MS(capField, AR_EEPROM_EEPCAP_MAXQCU);
	else
		pCap->total_queues = ATH9K_NUM_TX_QUEUES;
3467

S
Sujith 已提交
3468 3469 3470 3471 3472
	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;
3473

S
Sujith 已提交
3474 3475
	pCap->hw_caps |= ATH9K_HW_CAP_FASTCC;
	pCap->tx_triglevel_max = MAX_TX_FIFO_THRESHOLD;
3476

3477 3478 3479
	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 已提交
3480 3481 3482
		pCap->num_gpio_pins = AR928X_NUM_GPIO;
	else
		pCap->num_gpio_pins = AR_NUM_GPIO;
3483

S
Sujith 已提交
3484 3485 3486 3487 3488
	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);
3489 3490
	}

S
Sujith 已提交
3491 3492
	pCap->hw_caps |= ATH9K_HW_CAP_ENHANCEDPM;

3493
#if defined(CONFIG_RFKILL) || defined(CONFIG_RFKILL_MODULE)
3494 3495 3496 3497 3498 3499
	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 已提交
3500 3501

		pCap->hw_caps |= ATH9K_HW_CAP_RFSILENT;
3502
	}
S
Sujith 已提交
3503
#endif
3504

3505 3506 3507 3508
	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) ||
3509 3510
	    (ah->hw_version.macVersion == AR_SREV_VERSION_9280) ||
	    (ah->hw_version.macVersion == AR_SREV_VERSION_9285))
S
Sujith 已提交
3511
		pCap->hw_caps &= ~ATH9K_HW_CAP_AUTOSLEEP;
3512
	else
S
Sujith 已提交
3513
		pCap->hw_caps |= ATH9K_HW_CAP_AUTOSLEEP;
3514

3515
	if (AR_SREV_9280(ah) || AR_SREV_9285(ah))
S
Sujith 已提交
3516 3517 3518
		pCap->hw_caps &= ~ATH9K_HW_CAP_4KB_SPLITTRANS;
	else
		pCap->hw_caps |= ATH9K_HW_CAP_4KB_SPLITTRANS;
3519

3520
	if (ah->regulatory.current_rd_ext & (1 << REG_EXT_JAPAN_MIDBAND)) {
S
Sujith 已提交
3521 3522 3523 3524 3525
		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;
3526
	} else {
S
Sujith 已提交
3527 3528 3529
		pCap->reg_cap =
			AR_EEPROM_EEREGCAP_EN_KK_NEW_11A |
			AR_EEPROM_EEREGCAP_EN_KK_U1_EVEN;
3530 3531
	}

S
Sujith 已提交
3532 3533 3534
	pCap->reg_cap |= AR_EEPROM_EEREGCAP_EN_FCC_MIDBAND;

	pCap->num_antcfg_5ghz =
S
Sujith 已提交
3535
		ah->eep_ops->get_num_ant_config(ah, ATH9K_HAL_FREQ_BAND_5GHZ);
S
Sujith 已提交
3536
	pCap->num_antcfg_2ghz =
S
Sujith 已提交
3537
		ah->eep_ops->get_num_ant_config(ah, ATH9K_HAL_FREQ_BAND_2GHZ);
3538

3539
	if (AR_SREV_9280_10_OR_LATER(ah) && btcoex_enable) {
3540
		pCap->hw_caps |= ATH9K_HW_CAP_BT_COEX;
3541 3542
		ah->btactive_gpio = 6;
		ah->wlanactive_gpio = 5;
3543
	}
3544 3545
}

3546
bool ath9k_hw_getcapability(struct ath_hw *ah, enum ath9k_capability_type type,
S
Sujith 已提交
3547
			    u32 capability, u32 *result)
3548
{
S
Sujith 已提交
3549 3550 3551 3552 3553 3554 3555 3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566
	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:
3567
			return (ah->sta_id1_defaults &
S
Sujith 已提交
3568 3569 3570 3571
				AR_STA_ID1_CRPT_MIC_ENABLE) ? true :
			false;
		}
	case ATH9K_CAP_TKIP_SPLIT:
3572
		return (ah->misc_mode & AR_PCU_MIC_NEW_LOC_ENA) ?
S
Sujith 已提交
3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585
			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 {
3586
				return (ah->sta_id1_defaults &
S
Sujith 已提交
3587 3588 3589 3590 3591 3592 3593 3594 3595 3596
					AR_STA_ID1_MCAST_KSRCH) ? true :
					false;
			}
		}
		return false;
	case ATH9K_CAP_TXPOW:
		switch (capability) {
		case 0:
			return 0;
		case 1:
3597
			*result = ah->regulatory.power_limit;
S
Sujith 已提交
3598 3599
			return 0;
		case 2:
3600
			*result = ah->regulatory.max_power_level;
S
Sujith 已提交
3601 3602
			return 0;
		case 3:
3603
			*result = ah->regulatory.tp_scale;
S
Sujith 已提交
3604 3605 3606
			return 0;
		}
		return false;
3607 3608 3609 3610
	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 已提交
3611 3612
	default:
		return false;
3613 3614 3615
	}
}

3616
bool ath9k_hw_setcapability(struct ath_hw *ah, enum ath9k_capability_type type,
S
Sujith 已提交
3617
			    u32 capability, u32 setting, int *status)
3618
{
S
Sujith 已提交
3619
	u32 v;
3620

S
Sujith 已提交
3621 3622 3623
	switch (type) {
	case ATH9K_CAP_TKIP_MIC:
		if (setting)
3624
			ah->sta_id1_defaults |=
S
Sujith 已提交
3625 3626
				AR_STA_ID1_CRPT_MIC_ENABLE;
		else
3627
			ah->sta_id1_defaults &=
S
Sujith 已提交
3628 3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639
				~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)
3640
			ah->sta_id1_defaults |= AR_STA_ID1_MCAST_KSRCH;
S
Sujith 已提交
3641
		else
3642
			ah->sta_id1_defaults &= ~AR_STA_ID1_MCAST_KSRCH;
S
Sujith 已提交
3643 3644 3645
		return true;
	default:
		return false;
3646 3647 3648
	}
}

S
Sujith 已提交
3649 3650 3651
/****************************/
/* GPIO / RFKILL / Antennae */
/****************************/
3652

3653
static void ath9k_hw_gpio_cfg_output_mux(struct ath_hw *ah,
S
Sujith 已提交
3654 3655 3656 3657
					 u32 gpio, u32 type)
{
	int addr;
	u32 gpio_shift, tmp;
3658

S
Sujith 已提交
3659 3660 3661 3662 3663 3664
	if (gpio > 11)
		addr = AR_GPIO_OUTPUT_MUX3;
	else if (gpio > 5)
		addr = AR_GPIO_OUTPUT_MUX2;
	else
		addr = AR_GPIO_OUTPUT_MUX1;
3665

S
Sujith 已提交
3666
	gpio_shift = (gpio % 6) * 5;
3667

S
Sujith 已提交
3668 3669 3670 3671
	if (AR_SREV_9280_20_OR_LATER(ah)
	    || (addr != AR_GPIO_OUTPUT_MUX1)) {
		REG_RMW(ah, addr, (type << gpio_shift),
			(0x1f << gpio_shift));
3672
	} else {
S
Sujith 已提交
3673 3674 3675 3676 3677
		tmp = REG_READ(ah, addr);
		tmp = ((tmp & 0x1F0) << 1) | (tmp & ~0x1F0);
		tmp &= ~(0x1f << gpio_shift);
		tmp |= (type << gpio_shift);
		REG_WRITE(ah, addr, tmp);
3678 3679 3680
	}
}

3681
void ath9k_hw_cfg_gpio_input(struct ath_hw *ah, u32 gpio)
3682
{
S
Sujith 已提交
3683
	u32 gpio_shift;
3684

3685
	ASSERT(gpio < ah->caps.num_gpio_pins);
3686

S
Sujith 已提交
3687
	gpio_shift = gpio << 1;
3688

S
Sujith 已提交
3689 3690 3691 3692
	REG_RMW(ah,
		AR_GPIO_OE_OUT,
		(AR_GPIO_OE_OUT_DRV_NO << gpio_shift),
		(AR_GPIO_OE_OUT_DRV << gpio_shift));
3693 3694
}

3695
u32 ath9k_hw_gpio_get(struct ath_hw *ah, u32 gpio)
3696
{
3697 3698 3699
#define MS_REG_READ(x, y) \
	(MS(REG_READ(ah, AR_GPIO_IN_OUT), x##_GPIO_IN_VAL) & (AR_GPIO_BIT(y)))

3700
	if (gpio >= ah->caps.num_gpio_pins)
S
Sujith 已提交
3701
		return 0xffffffff;
3702

3703 3704 3705
	if (AR_SREV_9287_10_OR_LATER(ah))
		return MS_REG_READ(AR9287, gpio) != 0;
	else if (AR_SREV_9285_10_OR_LATER(ah))
3706 3707 3708 3709 3710
		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;
3711 3712
}

3713
void ath9k_hw_cfg_output(struct ath_hw *ah, u32 gpio,
S
Sujith 已提交
3714
			 u32 ah_signal_type)
3715
{
S
Sujith 已提交
3716
	u32 gpio_shift;
3717

S
Sujith 已提交
3718
	ath9k_hw_gpio_cfg_output_mux(ah, gpio, ah_signal_type);
3719

S
Sujith 已提交
3720
	gpio_shift = 2 * gpio;
3721

S
Sujith 已提交
3722 3723 3724 3725
	REG_RMW(ah,
		AR_GPIO_OE_OUT,
		(AR_GPIO_OE_OUT_DRV_ALL << gpio_shift),
		(AR_GPIO_OE_OUT_DRV << gpio_shift));
3726 3727
}

3728
void ath9k_hw_set_gpio(struct ath_hw *ah, u32 gpio, u32 val)
3729
{
S
Sujith 已提交
3730 3731
	REG_RMW(ah, AR_GPIO_IN_OUT, ((val & 1) << gpio),
		AR_GPIO_BIT(gpio));
3732 3733
}

3734
u32 ath9k_hw_getdefantenna(struct ath_hw *ah)
3735
{
S
Sujith 已提交
3736
	return REG_READ(ah, AR_DEF_ANTENNA) & 0x7;
3737 3738
}

3739
void ath9k_hw_setantenna(struct ath_hw *ah, u32 antenna)
3740
{
S
Sujith 已提交
3741
	REG_WRITE(ah, AR_DEF_ANTENNA, (antenna & 0x7));
3742 3743
}

3744
bool ath9k_hw_setantennaswitch(struct ath_hw *ah,
S
Sujith 已提交
3745 3746 3747 3748 3749
			       enum ath9k_ant_setting settings,
			       struct ath9k_channel *chan,
			       u8 *tx_chainmask,
			       u8 *rx_chainmask,
			       u8 *antenna_cfgd)
3750
{
S
Sujith 已提交
3751
	static u8 tx_chainmask_cfg, rx_chainmask_cfg;
3752

S
Sujith 已提交
3753 3754
	if (AR_SREV_9280(ah)) {
		if (!tx_chainmask_cfg) {
3755

S
Sujith 已提交
3756 3757 3758
			tx_chainmask_cfg = *tx_chainmask;
			rx_chainmask_cfg = *rx_chainmask;
		}
3759

S
Sujith 已提交
3760 3761 3762 3763 3764 3765 3766
		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:
3767
			if (ah->caps.tx_chainmask >
S
Sujith 已提交
3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778 3779 3780 3781 3782
			    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 {
3783
		ah->diversity_control = settings;
3784 3785
	}

S
Sujith 已提交
3786
	return true;
3787 3788
}

S
Sujith 已提交
3789 3790 3791 3792
/*********************/
/* General Operation */
/*********************/

3793
u32 ath9k_hw_getrxfilter(struct ath_hw *ah)
3794
{
S
Sujith 已提交
3795 3796
	u32 bits = REG_READ(ah, AR_RX_FILTER);
	u32 phybits = REG_READ(ah, AR_PHY_ERR);
3797

S
Sujith 已提交
3798 3799 3800 3801
	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 已提交
3802

S
Sujith 已提交
3803
	return bits;
3804 3805
}

3806
void ath9k_hw_setrxfilter(struct ath_hw *ah, u32 bits)
3807
{
S
Sujith 已提交
3808
	u32 phybits;
3809

S
Sujith 已提交
3810 3811 3812 3813 3814 3815 3816
	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);
3817

S
Sujith 已提交
3818 3819 3820 3821 3822 3823 3824
	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);
}
3825

3826
bool ath9k_hw_phy_disable(struct ath_hw *ah)
S
Sujith 已提交
3827 3828 3829
{
	return ath9k_hw_set_reset_reg(ah, ATH9K_RESET_WARM);
}
3830

3831
bool ath9k_hw_disable(struct ath_hw *ah)
S
Sujith 已提交
3832 3833 3834
{
	if (!ath9k_hw_setpower(ah, ATH9K_PM_AWAKE))
		return false;
3835

S
Sujith 已提交
3836
	return ath9k_hw_set_reset_reg(ah, ATH9K_RESET_COLD);
3837 3838
}

3839
void ath9k_hw_set_txpowerlimit(struct ath_hw *ah, u32 limit)
3840
{
3841
	struct ath9k_channel *chan = ah->curchan;
3842
	struct ieee80211_channel *channel = chan->chan;
3843

3844
	ah->regulatory.power_limit = min(limit, (u32) MAX_RATE_POWER);
3845

3846 3847 3848 3849 3850 3851
	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));
3852 3853
}

3854
void ath9k_hw_setmac(struct ath_hw *ah, const u8 *mac)
3855
{
S
Sujith 已提交
3856
	memcpy(ah->macaddr, mac, ETH_ALEN);
3857 3858
}

3859
void ath9k_hw_setopmode(struct ath_hw *ah)
3860
{
3861
	ath9k_hw_set_operating_mode(ah, ah->opmode);
3862 3863
}

3864
void ath9k_hw_setmcastfilter(struct ath_hw *ah, u32 filter0, u32 filter1)
3865
{
S
Sujith 已提交
3866 3867
	REG_WRITE(ah, AR_MCAST_FIL0, filter0);
	REG_WRITE(ah, AR_MCAST_FIL1, filter1);
3868 3869
}

S
Sujith 已提交
3870
void ath9k_hw_setbssidmask(struct ath_softc *sc)
3871
{
S
Sujith 已提交
3872 3873
	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));
3874 3875
}

S
Sujith 已提交
3876
void ath9k_hw_write_associd(struct ath_softc *sc)
3877
{
S
Sujith 已提交
3878 3879 3880
	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));
3881 3882
}

3883
u64 ath9k_hw_gettsf64(struct ath_hw *ah)
3884
{
S
Sujith 已提交
3885
	u64 tsf;
3886

S
Sujith 已提交
3887 3888
	tsf = REG_READ(ah, AR_TSF_U32);
	tsf = (tsf << 32) | REG_READ(ah, AR_TSF_L32);
3889

S
Sujith 已提交
3890 3891
	return tsf;
}
3892

3893
void ath9k_hw_settsf64(struct ath_hw *ah, u64 tsf64)
3894 3895
{
	REG_WRITE(ah, AR_TSF_L32, tsf64 & 0xffffffff);
A
Alina Friedrichsen 已提交
3896
	REG_WRITE(ah, AR_TSF_U32, (tsf64 >> 32) & 0xffffffff);
3897 3898
}

3899
void ath9k_hw_reset_tsf(struct ath_hw *ah)
S
Sujith 已提交
3900
{
3901
	ath9k_ps_wakeup(ah->ah_sc);
3902 3903 3904 3905 3906
	if (!ath9k_hw_wait(ah, AR_SLP32_MODE, AR_SLP32_TSF_WRITE_STATUS, 0,
			   AH_TSF_WRITE_TIMEOUT))
		DPRINTF(ah->ah_sc, ATH_DBG_RESET,
			"AR_SLP32_TSF_WRITE_STATUS limit exceeded\n");

S
Sujith 已提交
3907
	REG_WRITE(ah, AR_RESET_TSF, AR_RESET_TSF_ONCE);
3908
	ath9k_ps_restore(ah->ah_sc);
S
Sujith 已提交
3909
}
3910

3911
bool ath9k_hw_set_tsfadjust(struct ath_hw *ah, u32 setting)
S
Sujith 已提交
3912 3913
{
	if (setting)
3914
		ah->misc_mode |= AR_PCU_TX_ADD_TSF;
S
Sujith 已提交
3915
	else
3916
		ah->misc_mode &= ~AR_PCU_TX_ADD_TSF;
3917

S
Sujith 已提交
3918 3919
	return true;
}
3920

3921
bool ath9k_hw_setslottime(struct ath_hw *ah, u32 us)
S
Sujith 已提交
3922 3923
{
	if (us < ATH9K_SLOT_TIME_9 || us > ath9k_hw_mac_to_usec(ah, 0xffff)) {
S
Sujith 已提交
3924
		DPRINTF(ah->ah_sc, ATH_DBG_RESET, "bad slot time %u\n", us);
3925
		ah->slottime = (u32) -1;
S
Sujith 已提交
3926 3927 3928
		return false;
	} else {
		REG_WRITE(ah, AR_D_GBL_IFS_SLOT, ath9k_hw_mac_to_clks(ah, us));
3929
		ah->slottime = us;
S
Sujith 已提交
3930
		return true;
3931
	}
S
Sujith 已提交
3932 3933
}

3934
void ath9k_hw_set11nmac2040(struct ath_hw *ah, enum ath9k_ht_macmode mode)
S
Sujith 已提交
3935 3936 3937 3938
{
	u32 macmode;

	if (mode == ATH9K_HT_MACMODE_2040 &&
3939
	    !ah->config.cwm_ignore_extcca)
S
Sujith 已提交
3940 3941 3942
		macmode = AR_2040_JOINED_RX_CLEAR;
	else
		macmode = 0;
3943

S
Sujith 已提交
3944
	REG_WRITE(ah, AR_2040_MODE, macmode);
3945
}
3946 3947 3948 3949 3950

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

3951
void ath9k_hw_btcoex_enable(struct ath_hw *ah)
3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963
{
	/* 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,
3964
			ah->btactive_gpio);
3965 3966

	/* Configure the desired gpio port for input */
3967
	ath9k_hw_cfg_gpio_input(ah, ah->btactive_gpio);
3968 3969

	/* Configure the desired GPIO port for TX_FRAME output */
3970
	ath9k_hw_cfg_output(ah, ah->wlanactive_gpio,
3971 3972
			    AR_GPIO_OUTPUT_MUX_AS_TX_FRAME);
}