calib.c 32.8 KB
Newer Older
S
Sujith 已提交
1
/*
2
 * Copyright (c) 2008-2009 Atheros Communications Inc.
S
Sujith 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16
 *
 * 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.
 */

S
Sujith 已提交
17
#include "ath9k.h"
S
Sujith 已提交
18 19 20 21 22 23 24 25

/* We can tune this as we go by monitoring really low values */
#define ATH9K_NF_TOO_LOW	-60

/* AR5416 may return very high value (like -31 dBm), in those cases the nf
 * is incorrect and we should use the static NF value. Later we can try to
 * find out why they are reporting these values */

26
static bool ath9k_hw_nf_in_range(struct ath_hw *ah, s16 nf)
S
Sujith 已提交
27 28
{
	if (nf > ATH9K_NF_TOO_LOW) {
29
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
30
			"noise floor value detected (%d) is "
S
Sujith 已提交
31 32
			"lower than what we think is a "
			"reasonable value (%d)\n",
S
Sujith 已提交
33
			nf, ATH9K_NF_TOO_LOW);
S
Sujith 已提交
34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
		return false;
	}
	return true;
}

static int16_t ath9k_hw_get_nf_hist_mid(int16_t *nfCalBuffer)
{
	int16_t nfval;
	int16_t sort[ATH9K_NF_CAL_HIST_MAX];
	int i, j;

	for (i = 0; i < ATH9K_NF_CAL_HIST_MAX; i++)
		sort[i] = nfCalBuffer[i];

	for (i = 0; i < ATH9K_NF_CAL_HIST_MAX - 1; i++) {
		for (j = 1; j < ATH9K_NF_CAL_HIST_MAX - i; j++) {
			if (sort[j] > sort[j - 1]) {
				nfval = sort[j];
				sort[j] = sort[j - 1];
				sort[j - 1] = nfval;
			}
		}
	}
	nfval = sort[(ATH9K_NF_CAL_HIST_MAX - 1) >> 1];

	return nfval;
}

static void ath9k_hw_update_nfcal_hist_buffer(struct ath9k_nfcal_hist *h,
					      int16_t *nfarray)
{
	int i;

	for (i = 0; i < NUM_NF_READINGS; i++) {
		h[i].nfCalBuffer[h[i].currIndex] = nfarray[i];

		if (++h[i].currIndex >= ATH9K_NF_CAL_HIST_MAX)
			h[i].currIndex = 0;

		if (h[i].invalidNFcount > 0) {
			if (nfarray[i] < AR_PHY_CCA_MIN_BAD_VALUE ||
			    nfarray[i] > AR_PHY_CCA_MAX_HIGH_VALUE) {
				h[i].invalidNFcount = ATH9K_NF_CAL_HIST_MAX;
			} else {
				h[i].invalidNFcount--;
				h[i].privNF = nfarray[i];
			}
		} else {
			h[i].privNF =
				ath9k_hw_get_nf_hist_mid(h[i].nfCalBuffer);
		}
	}
	return;
}

89
static void ath9k_hw_do_getnf(struct ath_hw *ah,
S
Sujith 已提交
90 91 92 93 94 95 96 97 98 99 100
			      int16_t nfarray[NUM_NF_READINGS])
{
	int16_t nf;

	if (AR_SREV_9280_10_OR_LATER(ah))
		nf = MS(REG_READ(ah, AR_PHY_CCA), AR9280_PHY_MINCCA_PWR);
	else
		nf = MS(REG_READ(ah, AR_PHY_CCA), AR_PHY_MINCCA_PWR);

	if (nf & 0x100)
		nf = 0 - ((nf ^ 0x1ff) + 1);
101
	DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
102 103 104
		"NF calibrated [ctl] [chain 0] is %d\n", nf);
	nfarray[0] = nf;

105 106 107 108 109 110 111
	if (!AR_SREV_9285(ah)) {
		if (AR_SREV_9280_10_OR_LATER(ah))
			nf = MS(REG_READ(ah, AR_PHY_CH1_CCA),
					AR9280_PHY_CH1_MINCCA_PWR);
		else
			nf = MS(REG_READ(ah, AR_PHY_CH1_CCA),
					AR_PHY_CH1_MINCCA_PWR);
S
Sujith 已提交
112 113 114

		if (nf & 0x100)
			nf = 0 - ((nf ^ 0x1ff) + 1);
115
		DPRINTF(ah, ATH_DBG_CALIBRATE,
116 117 118
				"NF calibrated [ctl] [chain 1] is %d\n", nf);
		nfarray[1] = nf;

119
		if (!AR_SREV_9280(ah) && !AR_SREV_9287(ah)) {
120 121 122 123
			nf = MS(REG_READ(ah, AR_PHY_CH2_CCA),
					AR_PHY_CH2_MINCCA_PWR);
			if (nf & 0x100)
				nf = 0 - ((nf ^ 0x1ff) + 1);
124
			DPRINTF(ah, ATH_DBG_CALIBRATE,
125 126 127
				"NF calibrated [ctl] [chain 2] is %d\n", nf);
			nfarray[2] = nf;
		}
S
Sujith 已提交
128 129 130 131 132 133 134 135 136 137 138
	}

	if (AR_SREV_9280_10_OR_LATER(ah))
		nf = MS(REG_READ(ah, AR_PHY_EXT_CCA),
			AR9280_PHY_EXT_MINCCA_PWR);
	else
		nf = MS(REG_READ(ah, AR_PHY_EXT_CCA),
			AR_PHY_EXT_MINCCA_PWR);

	if (nf & 0x100)
		nf = 0 - ((nf ^ 0x1ff) + 1);
139
	DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
140 141 142
		"NF calibrated [ext] [chain 0] is %d\n", nf);
	nfarray[3] = nf;

143 144 145 146 147 148 149
	if (!AR_SREV_9285(ah)) {
		if (AR_SREV_9280_10_OR_LATER(ah))
			nf = MS(REG_READ(ah, AR_PHY_CH1_EXT_CCA),
					AR9280_PHY_CH1_EXT_MINCCA_PWR);
		else
			nf = MS(REG_READ(ah, AR_PHY_CH1_EXT_CCA),
					AR_PHY_CH1_EXT_MINCCA_PWR);
S
Sujith 已提交
150 151 152

		if (nf & 0x100)
			nf = 0 - ((nf ^ 0x1ff) + 1);
153
		DPRINTF(ah, ATH_DBG_CALIBRATE,
154 155 156
				"NF calibrated [ext] [chain 1] is %d\n", nf);
		nfarray[4] = nf;

157
		if (!AR_SREV_9280(ah) && !AR_SREV_9287(ah)) {
158 159 160 161
			nf = MS(REG_READ(ah, AR_PHY_CH2_EXT_CCA),
					AR_PHY_CH2_EXT_MINCCA_PWR);
			if (nf & 0x100)
				nf = 0 - ((nf ^ 0x1ff) + 1);
162
			DPRINTF(ah, ATH_DBG_CALIBRATE,
163 164 165
				"NF calibrated [ext] [chain 2] is %d\n", nf);
			nfarray[5] = nf;
		}
S
Sujith 已提交
166 167 168
	}
}

169
static bool getNoiseFloorThresh(struct ath_hw *ah,
170
				enum ieee80211_band band,
S
Sujith 已提交
171 172
				int16_t *nft)
{
173 174
	switch (band) {
	case IEEE80211_BAND_5GHZ:
S
Sujith 已提交
175
		*nft = (int8_t)ah->eep_ops->get_eeprom(ah, EEP_NFTHRESH_5);
S
Sujith 已提交
176
		break;
177
	case IEEE80211_BAND_2GHZ:
S
Sujith 已提交
178
		*nft = (int8_t)ah->eep_ops->get_eeprom(ah, EEP_NFTHRESH_2);
S
Sujith 已提交
179 180
		break;
	default:
181
		BUG_ON(1);
S
Sujith 已提交
182 183 184 185 186 187
		return false;
	}

	return true;
}

188
static void ath9k_hw_setup_calibration(struct ath_hw *ah,
189
				       struct ath9k_cal_list *currCal)
S
Sujith 已提交
190 191 192 193 194 195 196 197
{
	REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4(0),
		      AR_PHY_TIMING_CTRL4_IQCAL_LOG_COUNT_MAX,
		      currCal->calData->calCountMax);

	switch (currCal->calData->calType) {
	case IQ_MISMATCH_CAL:
		REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_IQ);
198
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
199
			"starting IQ Mismatch Calibration\n");
S
Sujith 已提交
200 201 202
		break;
	case ADC_GAIN_CAL:
		REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_GAIN);
203
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
204
			"starting ADC Gain Calibration\n");
S
Sujith 已提交
205 206 207
		break;
	case ADC_DC_CAL:
		REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_DC_PER);
208
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
209
			"starting ADC DC Calibration\n");
S
Sujith 已提交
210 211 212
		break;
	case ADC_DC_INIT_CAL:
		REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_DC_INIT);
213
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
214
			"starting Init ADC DC Calibration\n");
S
Sujith 已提交
215 216 217 218 219 220 221
		break;
	}

	REG_SET_BIT(ah, AR_PHY_TIMING_CTRL4(0),
		    AR_PHY_TIMING_CTRL4_DO_CAL);
}

222
static void ath9k_hw_reset_calibration(struct ath_hw *ah,
223
				       struct ath9k_cal_list *currCal)
S
Sujith 已提交
224 225 226 227 228 229 230 231
{
	int i;

	ath9k_hw_setup_calibration(ah, currCal);

	currCal->calState = CAL_RUNNING;

	for (i = 0; i < AR5416_MAX_CHAINS; i++) {
232 233 234 235
		ah->meas0.sign[i] = 0;
		ah->meas1.sign[i] = 0;
		ah->meas2.sign[i] = 0;
		ah->meas3.sign[i] = 0;
S
Sujith 已提交
236 237
	}

238
	ah->cal_samples = 0;
S
Sujith 已提交
239 240
}

S
Sujith 已提交
241
static bool ath9k_hw_per_calibration(struct ath_hw *ah,
S
Sujith 已提交
242 243
				     struct ath9k_channel *ichan,
				     u8 rxchainmask,
244
				     struct ath9k_cal_list *currCal)
S
Sujith 已提交
245
{
S
Sujith 已提交
246
	bool iscaldone = false;
S
Sujith 已提交
247 248 249 250 251 252

	if (currCal->calState == CAL_RUNNING) {
		if (!(REG_READ(ah, AR_PHY_TIMING_CTRL4(0)) &
		      AR_PHY_TIMING_CTRL4_DO_CAL)) {

			currCal->calData->calCollect(ah);
253
			ah->cal_samples++;
S
Sujith 已提交
254

255
			if (ah->cal_samples >= currCal->calData->calNumSamples) {
S
Sujith 已提交
256 257 258 259 260 261 262 263 264
				int i, numChains = 0;
				for (i = 0; i < AR5416_MAX_CHAINS; i++) {
					if (rxchainmask & (1 << i))
						numChains++;
				}

				currCal->calData->calPostProc(ah, numChains);
				ichan->CalValid |= currCal->calData->calType;
				currCal->calState = CAL_DONE;
S
Sujith 已提交
265
				iscaldone = true;
S
Sujith 已提交
266 267 268 269 270 271 272
			} else {
				ath9k_hw_setup_calibration(ah, currCal);
			}
		}
	} else if (!(ichan->CalValid & currCal->calData->calType)) {
		ath9k_hw_reset_calibration(ah, currCal);
	}
S
Sujith 已提交
273 274

	return iscaldone;
S
Sujith 已提交
275 276
}

277
/* Assumes you are talking about the currently configured channel */
278
static bool ath9k_hw_iscal_supported(struct ath_hw *ah,
279
				     enum ath9k_cal_types calType)
S
Sujith 已提交
280
{
281
	struct ieee80211_conf *conf = &ah->ah_sc->hw->conf;
S
Sujith 已提交
282

283
	switch (calType & ah->supp_cals) {
284 285
	case IQ_MISMATCH_CAL: /* Both 2 GHz and 5 GHz support OFDM */
		return true;
S
Sujith 已提交
286 287
	case ADC_GAIN_CAL:
	case ADC_DC_CAL:
288 289
		if (!(conf->channel->band == IEEE80211_BAND_2GHZ &&
		      conf_is_ht20(conf)))
290
			return true;
S
Sujith 已提交
291 292
		break;
	}
293
	return false;
S
Sujith 已提交
294 295
}

296
static void ath9k_hw_iqcal_collect(struct ath_hw *ah)
S
Sujith 已提交
297 298 299 300
{
	int i;

	for (i = 0; i < AR5416_MAX_CHAINS; i++) {
301
		ah->totalPowerMeasI[i] +=
S
Sujith 已提交
302
			REG_READ(ah, AR_PHY_CAL_MEAS_0(i));
303
		ah->totalPowerMeasQ[i] +=
S
Sujith 已提交
304
			REG_READ(ah, AR_PHY_CAL_MEAS_1(i));
305
		ah->totalIqCorrMeas[i] +=
S
Sujith 已提交
306
			(int32_t) REG_READ(ah, AR_PHY_CAL_MEAS_2(i));
307
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
308
			"%d: Chn %d pmi=0x%08x;pmq=0x%08x;iqcm=0x%08x;\n",
309 310 311
			ah->cal_samples, i, ah->totalPowerMeasI[i],
			ah->totalPowerMeasQ[i],
			ah->totalIqCorrMeas[i]);
S
Sujith 已提交
312 313 314
	}
}

315
static void ath9k_hw_adc_gaincal_collect(struct ath_hw *ah)
S
Sujith 已提交
316 317 318 319
{
	int i;

	for (i = 0; i < AR5416_MAX_CHAINS; i++) {
320
		ah->totalAdcIOddPhase[i] +=
S
Sujith 已提交
321
			REG_READ(ah, AR_PHY_CAL_MEAS_0(i));
322
		ah->totalAdcIEvenPhase[i] +=
S
Sujith 已提交
323
			REG_READ(ah, AR_PHY_CAL_MEAS_1(i));
324
		ah->totalAdcQOddPhase[i] +=
S
Sujith 已提交
325
			REG_READ(ah, AR_PHY_CAL_MEAS_2(i));
326
		ah->totalAdcQEvenPhase[i] +=
S
Sujith 已提交
327 328
			REG_READ(ah, AR_PHY_CAL_MEAS_3(i));

329
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
330 331
			"%d: Chn %d oddi=0x%08x; eveni=0x%08x; "
			"oddq=0x%08x; evenq=0x%08x;\n",
332 333 334 335 336
			ah->cal_samples, i,
			ah->totalAdcIOddPhase[i],
			ah->totalAdcIEvenPhase[i],
			ah->totalAdcQOddPhase[i],
			ah->totalAdcQEvenPhase[i]);
S
Sujith 已提交
337 338 339
	}
}

340
static void ath9k_hw_adc_dccal_collect(struct ath_hw *ah)
S
Sujith 已提交
341 342 343 344
{
	int i;

	for (i = 0; i < AR5416_MAX_CHAINS; i++) {
345
		ah->totalAdcDcOffsetIOddPhase[i] +=
S
Sujith 已提交
346
			(int32_t) REG_READ(ah, AR_PHY_CAL_MEAS_0(i));
347
		ah->totalAdcDcOffsetIEvenPhase[i] +=
S
Sujith 已提交
348
			(int32_t) REG_READ(ah, AR_PHY_CAL_MEAS_1(i));
349
		ah->totalAdcDcOffsetQOddPhase[i] +=
S
Sujith 已提交
350
			(int32_t) REG_READ(ah, AR_PHY_CAL_MEAS_2(i));
351
		ah->totalAdcDcOffsetQEvenPhase[i] +=
S
Sujith 已提交
352 353
			(int32_t) REG_READ(ah, AR_PHY_CAL_MEAS_3(i));

354
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
355 356
			"%d: Chn %d oddi=0x%08x; eveni=0x%08x; "
			"oddq=0x%08x; evenq=0x%08x;\n",
357 358 359 360 361
			ah->cal_samples, i,
			ah->totalAdcDcOffsetIOddPhase[i],
			ah->totalAdcDcOffsetIEvenPhase[i],
			ah->totalAdcDcOffsetQOddPhase[i],
			ah->totalAdcDcOffsetQEvenPhase[i]);
S
Sujith 已提交
362 363 364
	}
}

365
static void ath9k_hw_iqcalibrate(struct ath_hw *ah, u8 numChains)
S
Sujith 已提交
366 367 368 369 370 371 372
{
	u32 powerMeasQ, powerMeasI, iqCorrMeas;
	u32 qCoffDenom, iCoffDenom;
	int32_t qCoff, iCoff;
	int iqCorrNeg, i;

	for (i = 0; i < numChains; i++) {
373 374 375
		powerMeasI = ah->totalPowerMeasI[i];
		powerMeasQ = ah->totalPowerMeasQ[i];
		iqCorrMeas = ah->totalIqCorrMeas[i];
S
Sujith 已提交
376

377
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
378 379 380
			"Starting IQ Cal and Correction for Chain %d\n",
			i);

381
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
382
			"Orignal: Chn %diq_corr_meas = 0x%08x\n",
383
			i, ah->totalIqCorrMeas[i]);
S
Sujith 已提交
384 385 386 387 388 389 390 391

		iqCorrNeg = 0;

		if (iqCorrMeas > 0x80000000) {
			iqCorrMeas = (0xffffffff - iqCorrMeas) + 1;
			iqCorrNeg = 1;
		}

392
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
393
			"Chn %d pwr_meas_i = 0x%08x\n", i, powerMeasI);
394
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
395
			"Chn %d pwr_meas_q = 0x%08x\n", i, powerMeasQ);
396
		DPRINTF(ah, ATH_DBG_CALIBRATE, "iqCorrNeg is 0x%08x\n",
S
Sujith 已提交
397 398 399 400 401 402 403 404
			iqCorrNeg);

		iCoffDenom = (powerMeasI / 2 + powerMeasQ / 2) / 128;
		qCoffDenom = powerMeasQ / 64;

		if (powerMeasQ != 0) {
			iCoff = iqCorrMeas / iCoffDenom;
			qCoff = powerMeasI / qCoffDenom - 64;
405
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
406
				"Chn %d iCoff = 0x%08x\n", i, iCoff);
407
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
408 409 410
				"Chn %d qCoff = 0x%08x\n", i, qCoff);

			iCoff = iCoff & 0x3f;
411
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
412 413 414 415 416 417 418 419 420
				"New: Chn %d iCoff = 0x%08x\n", i, iCoff);
			if (iqCorrNeg == 0x0)
				iCoff = 0x40 - iCoff;

			if (qCoff > 15)
				qCoff = 15;
			else if (qCoff <= -16)
				qCoff = 16;

421
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
422 423 424 425 426 427 428 429 430
				"Chn %d : iCoff = 0x%x  qCoff = 0x%x\n",
				i, iCoff, qCoff);

			REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4(i),
				      AR_PHY_TIMING_CTRL4_IQCORR_Q_I_COFF,
				      iCoff);
			REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4(i),
				      AR_PHY_TIMING_CTRL4_IQCORR_Q_Q_COFF,
				      qCoff);
431
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
432 433 434 435 436 437 438 439 440
				"IQ Cal and Correction done for Chain %d\n",
				i);
		}
	}

	REG_SET_BIT(ah, AR_PHY_TIMING_CTRL4(0),
		    AR_PHY_TIMING_CTRL4_IQCORR_ENABLE);
}

441
static void ath9k_hw_adc_gaincal_calibrate(struct ath_hw *ah, u8 numChains)
S
Sujith 已提交
442 443 444 445 446
{
	u32 iOddMeasOffset, iEvenMeasOffset, qOddMeasOffset, qEvenMeasOffset;
	u32 qGainMismatch, iGainMismatch, val, i;

	for (i = 0; i < numChains; i++) {
447 448 449 450
		iOddMeasOffset = ah->totalAdcIOddPhase[i];
		iEvenMeasOffset = ah->totalAdcIEvenPhase[i];
		qOddMeasOffset = ah->totalAdcQOddPhase[i];
		qEvenMeasOffset = ah->totalAdcQEvenPhase[i];
S
Sujith 已提交
451

452
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
453 454
			"Starting ADC Gain Cal for Chain %d\n", i);

455
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
456 457
			"Chn %d pwr_meas_odd_i = 0x%08x\n", i,
			iOddMeasOffset);
458
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
459 460
			"Chn %d pwr_meas_even_i = 0x%08x\n", i,
			iEvenMeasOffset);
461
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
462 463
			"Chn %d pwr_meas_odd_q = 0x%08x\n", i,
			qOddMeasOffset);
464
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
465 466 467 468 469 470 471 472 473 474 475
			"Chn %d pwr_meas_even_q = 0x%08x\n", i,
			qEvenMeasOffset);

		if (iOddMeasOffset != 0 && qEvenMeasOffset != 0) {
			iGainMismatch =
				((iEvenMeasOffset * 32) /
				 iOddMeasOffset) & 0x3f;
			qGainMismatch =
				((qOddMeasOffset * 32) /
				 qEvenMeasOffset) & 0x3f;

476
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
477 478
				"Chn %d gain_mismatch_i = 0x%08x\n", i,
				iGainMismatch);
479
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
480 481 482 483 484 485 486 487
				"Chn %d gain_mismatch_q = 0x%08x\n", i,
				qGainMismatch);

			val = REG_READ(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(i));
			val &= 0xfffff000;
			val |= (qGainMismatch) | (iGainMismatch << 6);
			REG_WRITE(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(i), val);

488
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
489 490 491 492 493 494 495 496 497
				"ADC Gain Cal done for Chain %d\n", i);
		}
	}

	REG_WRITE(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(0),
		  REG_READ(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(0)) |
		  AR_PHY_NEW_ADC_GAIN_CORR_ENABLE);
}

498
static void ath9k_hw_adc_dccal_calibrate(struct ath_hw *ah, u8 numChains)
S
Sujith 已提交
499 500 501
{
	u32 iOddMeasOffset, iEvenMeasOffset, val, i;
	int32_t qOddMeasOffset, qEvenMeasOffset, qDcMismatch, iDcMismatch;
502
	const struct ath9k_percal_data *calData =
503
		ah->cal_list_curr->calData;
S
Sujith 已提交
504 505 506 507
	u32 numSamples =
		(1 << (calData->calCountMax + 5)) * calData->calNumSamples;

	for (i = 0; i < numChains; i++) {
508 509 510 511
		iOddMeasOffset = ah->totalAdcDcOffsetIOddPhase[i];
		iEvenMeasOffset = ah->totalAdcDcOffsetIEvenPhase[i];
		qOddMeasOffset = ah->totalAdcDcOffsetQOddPhase[i];
		qEvenMeasOffset = ah->totalAdcDcOffsetQEvenPhase[i];
S
Sujith 已提交
512

513
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
514 515
			"Starting ADC DC Offset Cal for Chain %d\n", i);

516
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
517 518
			"Chn %d pwr_meas_odd_i = %d\n", i,
			iOddMeasOffset);
519
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
520 521
			"Chn %d pwr_meas_even_i = %d\n", i,
			iEvenMeasOffset);
522
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
523 524
			"Chn %d pwr_meas_odd_q = %d\n", i,
			qOddMeasOffset);
525
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
526 527 528 529 530 531 532 533
			"Chn %d pwr_meas_even_q = %d\n", i,
			qEvenMeasOffset);

		iDcMismatch = (((iEvenMeasOffset - iOddMeasOffset) * 2) /
			       numSamples) & 0x1ff;
		qDcMismatch = (((qOddMeasOffset - qEvenMeasOffset) * 2) /
			       numSamples) & 0x1ff;

534
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
535 536
			"Chn %d dc_offset_mismatch_i = 0x%08x\n", i,
			iDcMismatch);
537
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
538 539 540 541 542 543 544 545
			"Chn %d dc_offset_mismatch_q = 0x%08x\n", i,
			qDcMismatch);

		val = REG_READ(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(i));
		val &= 0xc0000fff;
		val |= (qDcMismatch << 12) | (iDcMismatch << 21);
		REG_WRITE(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(i), val);

546
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
547 548 549 550 551 552 553 554
			"ADC DC Offset Cal done for Chain %d\n", i);
	}

	REG_WRITE(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(0),
		  REG_READ(ah, AR_PHY_NEW_ADC_DC_GAIN_CORR(0)) |
		  AR_PHY_NEW_ADC_DC_OFFSET_CORR_ENABLE);
}

555
/* This is done for the currently configured channel */
556
bool ath9k_hw_reset_calvalid(struct ath_hw *ah)
S
Sujith 已提交
557
{
558
	struct ieee80211_conf *conf = &ah->ah_sc->hw->conf;
559
	struct ath9k_cal_list *currCal = ah->cal_list_curr;
S
Sujith 已提交
560

561
	if (!ah->curchan)
562
		return true;
S
Sujith 已提交
563 564

	if (!AR_SREV_9100(ah) && !AR_SREV_9160_10_OR_LATER(ah))
565
		return true;
S
Sujith 已提交
566 567

	if (currCal == NULL)
568
		return true;
S
Sujith 已提交
569 570

	if (currCal->calState != CAL_DONE) {
571
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
572 573
			"Calibration state incorrect, %d\n",
			currCal->calState);
574
		return true;
S
Sujith 已提交
575 576
	}

577 578
	if (!ath9k_hw_iscal_supported(ah, currCal->calData->calType))
		return true;
S
Sujith 已提交
579

580
	DPRINTF(ah, ATH_DBG_CALIBRATE,
581 582
		"Resetting Cal %d state for channel %u\n",
		currCal->calData->calType, conf->channel->center_freq);
S
Sujith 已提交
583

584
	ah->curchan->CalValid &= ~currCal->calData->calType;
S
Sujith 已提交
585 586
	currCal->calState = CAL_WAITING;

587
	return false;
S
Sujith 已提交
588 589
}

590
void ath9k_hw_start_nfcal(struct ath_hw *ah)
S
Sujith 已提交
591 592 593 594 595 596 597 598
{
	REG_SET_BIT(ah, AR_PHY_AGC_CONTROL,
		    AR_PHY_AGC_CONTROL_ENABLE_NF);
	REG_SET_BIT(ah, AR_PHY_AGC_CONTROL,
		    AR_PHY_AGC_CONTROL_NO_UPDATE_NF);
	REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF);
}

599
void ath9k_hw_loadnf(struct ath_hw *ah, struct ath9k_channel *chan)
S
Sujith 已提交
600 601 602 603 604 605 606 607 608 609 610 611
{
	struct ath9k_nfcal_hist *h;
	int i, j;
	int32_t val;
	const u32 ar5416_cca_regs[6] = {
		AR_PHY_CCA,
		AR_PHY_CH1_CCA,
		AR_PHY_CH2_CCA,
		AR_PHY_EXT_CCA,
		AR_PHY_CH1_EXT_CCA,
		AR_PHY_CH2_EXT_CCA
	};
612
	u8 chainmask, rx_chain_status;
S
Sujith 已提交
613

614
	rx_chain_status = REG_READ(ah, AR_PHY_RX_CHAINMASK);
S
Sujith 已提交
615 616
	if (AR_SREV_9285(ah))
		chainmask = 0x9;
617 618 619 620 621 622 623 624 625 626 627 628 629
	else if (AR_SREV_9280(ah) || AR_SREV_9287(ah)) {
		if ((rx_chain_status & 0x2) || (rx_chain_status & 0x4))
			chainmask = 0x1B;
		else
			chainmask = 0x09;
	} else {
		if (rx_chain_status & 0x4)
			chainmask = 0x3F;
		else if (rx_chain_status & 0x2)
			chainmask = 0x1B;
		else
			chainmask = 0x09;
	}
S
Sujith 已提交
630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664

	h = ah->nfCalHist;

	for (i = 0; i < NUM_NF_READINGS; i++) {
		if (chainmask & (1 << i)) {
			val = REG_READ(ah, ar5416_cca_regs[i]);
			val &= 0xFFFFFE00;
			val |= (((u32) (h[i].privNF) << 1) & 0x1ff);
			REG_WRITE(ah, ar5416_cca_regs[i], val);
		}
	}

	REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL,
		    AR_PHY_AGC_CONTROL_ENABLE_NF);
	REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL,
		    AR_PHY_AGC_CONTROL_NO_UPDATE_NF);
	REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF);

	for (j = 0; j < 1000; j++) {
		if ((REG_READ(ah, AR_PHY_AGC_CONTROL) &
		     AR_PHY_AGC_CONTROL_NF) == 0)
			break;
		udelay(10);
	}

	for (i = 0; i < NUM_NF_READINGS; i++) {
		if (chainmask & (1 << i)) {
			val = REG_READ(ah, ar5416_cca_regs[i]);
			val &= 0xFFFFFE00;
			val |= (((u32) (-50) << 1) & 0x1ff);
			REG_WRITE(ah, ar5416_cca_regs[i], val);
		}
	}
}

665
int16_t ath9k_hw_getnf(struct ath_hw *ah,
S
Sujith 已提交
666 667 668 669 670
		       struct ath9k_channel *chan)
{
	int16_t nf, nfThresh;
	int16_t nfarray[NUM_NF_READINGS] = { 0 };
	struct ath9k_nfcal_hist *h;
671
	struct ieee80211_channel *c = chan->chan;
S
Sujith 已提交
672 673 674

	chan->channelFlags &= (~CHANNEL_CW_INT);
	if (REG_READ(ah, AR_PHY_AGC_CONTROL) & AR_PHY_AGC_CONTROL_NF) {
675
		DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
676
			"NF did not complete in calibration window\n");
S
Sujith 已提交
677 678 679 680 681 682
		nf = 0;
		chan->rawNoiseFloor = nf;
		return chan->rawNoiseFloor;
	} else {
		ath9k_hw_do_getnf(ah, nfarray);
		nf = nfarray[0];
683
		if (getNoiseFloorThresh(ah, c->band, &nfThresh)
S
Sujith 已提交
684
		    && nf > nfThresh) {
685
			DPRINTF(ah, ATH_DBG_CALIBRATE,
S
Sujith 已提交
686 687
				"noise floor failed detected; "
				"detected %d, threshold %d\n",
S
Sujith 已提交
688 689 690 691 692 693 694 695 696 697 698 699 700
				nf, nfThresh);
			chan->channelFlags |= CHANNEL_CW_INT;
		}
	}

	h = ah->nfCalHist;

	ath9k_hw_update_nfcal_hist_buffer(h, nfarray);
	chan->rawNoiseFloor = h[0].privNF;

	return chan->rawNoiseFloor;
}

701
void ath9k_init_nfcal_hist_buffer(struct ath_hw *ah)
S
Sujith 已提交
702 703
{
	int i, j;
704 705 706 707 708 709
	s16 noise_floor;

	if (AR_SREV_9280(ah))
		noise_floor = AR_PHY_CCA_MAX_AR9280_GOOD_VALUE;
	else if (AR_SREV_9285(ah))
		noise_floor = AR_PHY_CCA_MAX_AR9285_GOOD_VALUE;
710 711
	else if (AR_SREV_9287(ah))
		noise_floor = AR_PHY_CCA_MAX_AR9287_GOOD_VALUE;
712 713
	else
		noise_floor = AR_PHY_CCA_MAX_AR5416_GOOD_VALUE;
S
Sujith 已提交
714 715 716

	for (i = 0; i < NUM_NF_READINGS; i++) {
		ah->nfCalHist[i].currIndex = 0;
717
		ah->nfCalHist[i].privNF = noise_floor;
S
Sujith 已提交
718 719 720
		ah->nfCalHist[i].invalidNFcount =
			AR_PHY_CCA_FILTERWINDOW_LENGTH;
		for (j = 0; j < ATH9K_NF_CAL_HIST_MAX; j++) {
721
			ah->nfCalHist[i].nfCalBuffer[j] = noise_floor;
S
Sujith 已提交
722 723 724 725
		}
	}
}

726
s16 ath9k_hw_getchan_noise(struct ath_hw *ah, struct ath9k_channel *chan)
S
Sujith 已提交
727 728 729
{
	s16 nf;

730
	if (chan->rawNoiseFloor == 0)
731 732
		nf = -96;
	else
733
		nf = chan->rawNoiseFloor;
S
Sujith 已提交
734 735 736 737 738 739 740

	if (!ath9k_hw_nf_in_range(ah, nf))
		nf = ATH_DEFAULT_NOISE_FLOOR;

	return nf;
}

741 742 743
static void ath9k_olc_temp_compensation(struct ath_hw *ah)
{
	u32 rddata, i;
744
	int delta, currPDADC, regval, slope;
745 746 747 748 749

	rddata = REG_READ(ah, AR_PHY_TX_PWRCTRL4);
	currPDADC = MS(rddata, AR_PHY_TX_PWRCTRL_PD_AVG_OUT);


750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775
	if (OLC_FOR_AR9287_10_LATER) {
		if (ah->initPDADC == 0 || currPDADC == 0) {
			return;
		} else {
			slope = ah->eep_ops->get_eeprom(ah, EEP_TEMPSENSE_SLOPE);
			if (slope == 0)
				delta = 0;
			else
				delta = ((currPDADC - ah->initPDADC)*4) / slope;
			REG_RMW_FIELD(ah, AR_PHY_CH0_TX_PWRCTRL11,
					AR_PHY_TX_PWRCTRL_OLPC_TEMP_COMP, delta);
			REG_RMW_FIELD(ah, AR_PHY_CH1_TX_PWRCTRL11,
					AR_PHY_TX_PWRCTRL_OLPC_TEMP_COMP, delta);
		}
	} else {
		if (ah->eep_ops->get_eeprom(ah, EEP_DAC_HPWR_5G))
			delta = (currPDADC - ah->initPDADC + 4) / 8;
		else
			delta = (currPDADC - ah->initPDADC + 5) / 10;

		if (delta != ah->PDADCdelta) {
			ah->PDADCdelta = delta;
			for (i = 1; i < AR9280_TX_GAIN_TABLE_SIZE; i++) {
				regval = ah->originalGain[i] - delta;
				if (regval < 0)
					regval = 0;
776

777 778 779
				REG_RMW_FIELD(ah, AR_PHY_TX_GAIN_TBL1 + i * 4,
						AR_PHY_TX_GAIN, regval);
			}
780 781 782 783
		}
	}
}

784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875
static void ath9k_hw_9271_pa_cal(struct ath_hw *ah)
{
	u32 regVal;
	unsigned int i;
	u32 regList [][2] = {
		{ 0x786c, 0 },
		{ 0x7854, 0 },
		{ 0x7820, 0 },
		{ 0x7824, 0 },
		{ 0x7868, 0 },
		{ 0x783c, 0 },
		{ 0x7838, 0 } ,
		{ 0x7828, 0 } ,
	};

	for (i = 0; i < ARRAY_SIZE(regList); i++)
		regList[i][1] = REG_READ(ah, regList[i][0]);

	regVal = REG_READ(ah, 0x7834);
	regVal &= (~(0x1));
	REG_WRITE(ah, 0x7834, regVal);
	regVal = REG_READ(ah, 0x9808);
	regVal |= (0x1 << 27);
	REG_WRITE(ah, 0x9808, regVal);

	/* 786c,b23,1, pwddac=1 */
	REG_RMW_FIELD(ah, AR9285_AN_TOP3, AR9285_AN_TOP3_PWDDAC, 1);
	/* 7854, b5,1, pdrxtxbb=1 */
	REG_RMW_FIELD(ah, AR9285_AN_RXTXBB1, AR9285_AN_RXTXBB1_PDRXTXBB1, 1);
	/* 7854, b7,1, pdv2i=1 */
	REG_RMW_FIELD(ah, AR9285_AN_RXTXBB1, AR9285_AN_RXTXBB1_PDV2I, 1);
	/* 7854, b8,1, pddacinterface=1 */
	REG_RMW_FIELD(ah, AR9285_AN_RXTXBB1, AR9285_AN_RXTXBB1_PDDACIF, 1);
	/* 7824,b12,0, offcal=0 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G2, AR9285_AN_RF2G2_OFFCAL, 0);
	/* 7838, b1,0, pwddb=0 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G7, AR9285_AN_RF2G7_PWDDB, 0);
	/* 7820,b11,0, enpacal=0 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1, AR9285_AN_RF2G1_ENPACAL, 0);
	/* 7820,b25,1, pdpadrv1=0 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1, AR9285_AN_RF2G1_PDPADRV1, 0);
	/* 7820,b24,0, pdpadrv2=0 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1,AR9285_AN_RF2G1_PDPADRV2,0);
	/* 7820,b23,0, pdpaout=0 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1, AR9285_AN_RF2G1_PDPAOUT, 0);
	/* 783c,b14-16,7, padrvgn2tab_0=7 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G8,AR9285_AN_RF2G8_PADRVGN2TAB0, 7);
	/*
	 * 7838,b29-31,0, padrvgn1tab_0=0
	 * does not matter since we turn it off
	 */
	REG_RMW_FIELD(ah, AR9285_AN_RF2G7,AR9285_AN_RF2G7_PADRVGN2TAB0, 0);

	REG_RMW_FIELD(ah, AR9285_AN_RF2G3, AR9271_AN_RF2G3_CCOMP, 0xfff);

	/* Set:
	 * localmode=1,bmode=1,bmoderxtx=1,synthon=1,
	 * txon=1,paon=1,oscon=1,synthon_force=1
	 */
	REG_WRITE(ah, AR9285_AN_TOP2, 0xca0358a0);
	udelay(30);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G6, AR9271_AN_RF2G6_OFFS, 0);

	/* find off_6_1; */
	for (i = 6; i >= 0; i--) {
		regVal = REG_READ(ah, 0x7834);
		regVal |= (1 << (20 + i));
		REG_WRITE(ah, 0x7834, regVal);
		udelay(1);
		//regVal = REG_READ(ah, 0x7834);
		regVal &= (~(0x1 << (20 + i)));
		regVal |= (MS(REG_READ(ah, 0x7840), AR9285_AN_RXTXBB1_SPARE9)
			    << (20 + i));
		REG_WRITE(ah, 0x7834, regVal);
	}

	/*  Empirical offset correction  */
#if 0
	REG_RMW_FIELD(ah, AR9285_AN_RF2G6, AR9271_AN_RF2G6_OFFS, 0x20);
#endif

	regVal = REG_READ(ah, 0x7834);
	regVal |= 0x1;
	REG_WRITE(ah, 0x7834, regVal);
	regVal = REG_READ(ah, 0x9808);
	regVal &= (~(0x1 << 27));
	REG_WRITE(ah, 0x9808, regVal);

	for (i = 0; i < ARRAY_SIZE(regList); i++)
		REG_WRITE(ah, regList[i][0], regList[i][1]);
}

876
static inline void ath9k_hw_9285_pa_cal(struct ath_hw *ah, bool is_reset)
877 878 879 880 881 882 883 884 885 886 887 888 889 890 891
{

	u32 regVal;
	int i, offset, offs_6_1, offs_0;
	u32 ccomp_org, reg_field;
	u32 regList[][2] = {
		{ 0x786c, 0 },
		{ 0x7854, 0 },
		{ 0x7820, 0 },
		{ 0x7824, 0 },
		{ 0x7868, 0 },
		{ 0x783c, 0 },
		{ 0x7838, 0 },
	};

892
	DPRINTF(ah, ATH_DBG_CALIBRATE, "Running PA Calibration\n");
893

S
Sujith 已提交
894 895 896 897 898
	/* PA CAL is not needed for high power solution */
	if (ah->eep_ops->get_eeprom(ah, EEP_TXGAIN_TYPE) ==
	    AR5416_EEP_TXGAIN_HIGH_POWER)
		return;

899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920
	if (AR_SREV_9285_11(ah)) {
		REG_WRITE(ah, AR9285_AN_TOP4, (AR9285_AN_TOP4_DEFAULT | 0x14));
		udelay(10);
	}

	for (i = 0; i < ARRAY_SIZE(regList); i++)
		regList[i][1] = REG_READ(ah, regList[i][0]);

	regVal = REG_READ(ah, 0x7834);
	regVal &= (~(0x1));
	REG_WRITE(ah, 0x7834, regVal);
	regVal = REG_READ(ah, 0x9808);
	regVal |= (0x1 << 27);
	REG_WRITE(ah, 0x9808, regVal);

	REG_RMW_FIELD(ah, AR9285_AN_TOP3, AR9285_AN_TOP3_PWDDAC, 1);
	REG_RMW_FIELD(ah, AR9285_AN_RXTXBB1, AR9285_AN_RXTXBB1_PDRXTXBB1, 1);
	REG_RMW_FIELD(ah, AR9285_AN_RXTXBB1, AR9285_AN_RXTXBB1_PDV2I, 1);
	REG_RMW_FIELD(ah, AR9285_AN_RXTXBB1, AR9285_AN_RXTXBB1_PDDACIF, 1);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G2, AR9285_AN_RF2G2_OFFCAL, 0);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G7, AR9285_AN_RF2G7_PWDDB, 0);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1, AR9285_AN_RF2G1_ENPACAL, 0);
921
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1, AR9285_AN_RF2G1_PDPADRV1, 0);
922 923 924 925 926
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1, AR9285_AN_RF2G1_PDPADRV2, 0);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G1, AR9285_AN_RF2G1_PDPAOUT, 0);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G8, AR9285_AN_RF2G8_PADRVGN2TAB0, 7);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G7, AR9285_AN_RF2G7_PADRVGN2TAB0, 0);
	ccomp_org = MS(REG_READ(ah, AR9285_AN_RF2G6), AR9285_AN_RF2G6_CCOMP);
927
	REG_RMW_FIELD(ah, AR9285_AN_RF2G6, AR9285_AN_RF2G6_CCOMP, 0xf);
928 929 930 931 932 933 934 935 936 937 938

	REG_WRITE(ah, AR9285_AN_TOP2, 0xca0358a0);
	udelay(30);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G6, AR9285_AN_RF2G6_OFFS, 0);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G3, AR9285_AN_RF2G3_PDVCCOMP, 0);

	for (i = 6; i > 0; i--) {
		regVal = REG_READ(ah, 0x7834);
		regVal |= (1 << (19 + i));
		REG_WRITE(ah, 0x7834, regVal);
		udelay(1);
S
Sujith 已提交
939
		regVal = REG_READ(ah, 0x7834);
940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957
		regVal &= (~(0x1 << (19 + i)));
		reg_field = MS(REG_READ(ah, 0x7840), AR9285_AN_RXTXBB1_SPARE9);
		regVal |= (reg_field << (19 + i));
		REG_WRITE(ah, 0x7834, regVal);
	}

	REG_RMW_FIELD(ah, AR9285_AN_RF2G3, AR9285_AN_RF2G3_PDVCCOMP, 1);
	udelay(1);
	reg_field = MS(REG_READ(ah, AR9285_AN_RF2G9), AR9285_AN_RXTXBB1_SPARE9);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G3, AR9285_AN_RF2G3_PDVCCOMP, reg_field);
	offs_6_1 = MS(REG_READ(ah, AR9285_AN_RF2G6), AR9285_AN_RF2G6_OFFS);
	offs_0   = MS(REG_READ(ah, AR9285_AN_RF2G3), AR9285_AN_RF2G3_PDVCCOMP);

	offset = (offs_6_1<<1) | offs_0;
	offset = offset - 0;
	offs_6_1 = offset>>1;
	offs_0 = offset & 1;

958 959 960 961 962 963 964 965 966 967 968
	if ((!is_reset) && (ah->pacal_info.prev_offset == offset)) {
		if (ah->pacal_info.max_skipcount < MAX_PACAL_SKIPCOUNT)
			ah->pacal_info.max_skipcount =
				2 * ah->pacal_info.max_skipcount;
		ah->pacal_info.skipcount = ah->pacal_info.max_skipcount;
	} else {
		ah->pacal_info.max_skipcount = 1;
		ah->pacal_info.skipcount = 0;
		ah->pacal_info.prev_offset = offset;
	}

969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988
	REG_RMW_FIELD(ah, AR9285_AN_RF2G6, AR9285_AN_RF2G6_OFFS, offs_6_1);
	REG_RMW_FIELD(ah, AR9285_AN_RF2G3, AR9285_AN_RF2G3_PDVCCOMP, offs_0);

	regVal = REG_READ(ah, 0x7834);
	regVal |= 0x1;
	REG_WRITE(ah, 0x7834, regVal);
	regVal = REG_READ(ah, 0x9808);
	regVal &= (~(0x1 << 27));
	REG_WRITE(ah, 0x9808, regVal);

	for (i = 0; i < ARRAY_SIZE(regList); i++)
		REG_WRITE(ah, regList[i][0], regList[i][1]);

	REG_RMW_FIELD(ah, AR9285_AN_RF2G6, AR9285_AN_RF2G6_CCOMP, ccomp_org);

	if (AR_SREV_9285_11(ah))
		REG_WRITE(ah, AR9285_AN_TOP4, AR9285_AN_TOP4_DEFAULT);

}

989
bool ath9k_hw_calibrate(struct ath_hw *ah, struct ath9k_channel *chan,
S
Sujith 已提交
990
			u8 rxchainmask, bool longcal)
991
{
S
Sujith 已提交
992
	bool iscaldone = true;
993
	struct ath9k_cal_list *currCal = ah->cal_list_curr;
994 995 996 997

	if (currCal &&
	    (currCal->calState == CAL_RUNNING ||
	     currCal->calState == CAL_WAITING)) {
S
Sujith 已提交
998 999 1000
		iscaldone = ath9k_hw_per_calibration(ah, chan,
						     rxchainmask, currCal);
		if (iscaldone) {
1001 1002 1003
			ah->cal_list_curr = currCal = currCal->calNext;

			if (currCal->calState == CAL_WAITING) {
S
Sujith 已提交
1004
				iscaldone = false;
1005 1006 1007 1008 1009
				ath9k_hw_reset_calibration(ah, currCal);
			}
		}
	}

1010
	/* Do NF cal only at longer intervals */
1011
	if (longcal) {
1012 1013 1014
		/* Do periodic PAOffset Cal */
		if (AR_SREV_9271(ah))
			ath9k_hw_9271_pa_cal(ah);
1015 1016 1017 1018 1019 1020
		else if (AR_SREV_9285_11_OR_LATER(ah)) {
			if (!ah->pacal_info.skipcount)
				ath9k_hw_9285_pa_cal(ah, false);
			else
				ah->pacal_info.skipcount--;
		}
1021

1022
		if (OLC_FOR_AR9280_20_LATER || OLC_FOR_AR9287_10_LATER)
1023
			ath9k_olc_temp_compensation(ah);
1024 1025

		/* Get the value from the previous NF cal and update history buffer */
1026
		ath9k_hw_getnf(ah, chan);
1027 1028 1029 1030 1031

		/*
		 * Load the NF from history buffer of the current channel.
		 * NF is slow time-variant, so it is OK to use a historical value.
		 */
1032
		ath9k_hw_loadnf(ah, ah->curchan);
1033

1034 1035 1036
		ath9k_hw_start_nfcal(ah);
	}

S
Sujith 已提交
1037
	return iscaldone;
1038 1039
}

1040
static bool ar9285_clc(struct ath_hw *ah, struct ath9k_channel *chan)
1041 1042
{
	REG_SET_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_CL_CAL_ENABLE);
S
Sujith 已提交
1043
	if (IS_CHAN_HT20(chan)) {
1044 1045 1046 1047 1048 1049 1050 1051
		REG_SET_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_PARALLEL_CAL_ENABLE);
		REG_SET_BIT(ah, AR_PHY_TURBO, AR_PHY_FC_DYN2040_EN);
		REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL,
			    AR_PHY_AGC_CONTROL_FLTR_CAL);
		REG_CLR_BIT(ah, AR_PHY_TPCRG1, AR_PHY_TPCRG1_PD_CAL_ENABLE);
		REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL);
		if (!ath9k_hw_wait(ah, AR_PHY_AGC_CONTROL,
				  AR_PHY_AGC_CONTROL_CAL, 0, AH_WAIT_TIMEOUT)) {
1052
			DPRINTF(ah, ATH_DBG_CALIBRATE, "offset "
1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066
				"calibration failed to complete in "
				"1ms; noisy ??\n");
			return false;
		}
		REG_CLR_BIT(ah, AR_PHY_TURBO, AR_PHY_FC_DYN2040_EN);
		REG_CLR_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_PARALLEL_CAL_ENABLE);
		REG_CLR_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_CL_CAL_ENABLE);
	}
	REG_CLR_BIT(ah, AR_PHY_ADC_CTL, AR_PHY_ADC_CTL_OFF_PWDADC);
	REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_FLTR_CAL);
	REG_SET_BIT(ah, AR_PHY_TPCRG1, AR_PHY_TPCRG1_PD_CAL_ENABLE);
	REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL);
	if (!ath9k_hw_wait(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL,
			  0, AH_WAIT_TIMEOUT)) {
1067
		DPRINTF(ah, ATH_DBG_CALIBRATE, "offset calibration "
1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078
				"failed to complete in 1ms; noisy ??\n");
		return false;
	}

	REG_SET_BIT(ah, AR_PHY_ADC_CTL, AR_PHY_ADC_CTL_OFF_PWDADC);
	REG_CLR_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_CL_CAL_ENABLE);
	REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_FLTR_CAL);

	return true;
}

1079
bool ath9k_hw_init_cal(struct ath_hw *ah, struct ath9k_channel *chan)
S
Sujith 已提交
1080
{
1081
	if (AR_SREV_9285_12_OR_LATER(ah)) {
1082 1083
		if (!ar9285_clc(ah, chan))
			return false;
1084 1085
	} else {
		if (AR_SREV_9280_10_OR_LATER(ah)) {
1086 1087 1088 1089 1090
			if (!AR_SREV_9287_10_OR_LATER(ah))
				REG_CLR_BIT(ah, AR_PHY_ADC_CTL,
					    AR_PHY_ADC_CTL_OFF_PWDADC);
			REG_SET_BIT(ah, AR_PHY_AGC_CONTROL,
				    AR_PHY_AGC_CONTROL_FLTR_CAL);
1091
		}
1092

1093
		/* Calibrate the AGC */
1094
		REG_WRITE(ah, AR_PHY_AGC_CONTROL,
1095 1096
			  REG_READ(ah, AR_PHY_AGC_CONTROL) |
			  AR_PHY_AGC_CONTROL_CAL);
1097

1098 1099 1100
		/* Poll for offset calibration complete */
		if (!ath9k_hw_wait(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL,
				   0, AH_WAIT_TIMEOUT)) {
1101
			DPRINTF(ah, ATH_DBG_CALIBRATE,
1102 1103 1104 1105 1106
				"offset calibration failed to complete in 1ms; "
				"noisy environment?\n");
			return false;
		}

1107
		if (AR_SREV_9280_10_OR_LATER(ah)) {
1108 1109 1110 1111 1112
			if (!AR_SREV_9287_10_OR_LATER(ah))
				REG_SET_BIT(ah, AR_PHY_ADC_CTL,
					    AR_PHY_ADC_CTL_OFF_PWDADC);
			REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL,
				    AR_PHY_AGC_CONTROL_FLTR_CAL);
1113
		}
1114 1115 1116
	}

	/* Do PA Calibration */
1117
	if (AR_SREV_9285_11_OR_LATER(ah))
1118
		ath9k_hw_9285_pa_cal(ah, true);
1119

1120
	/* Do NF Calibration after DC offset and other calibrations */
S
Sujith 已提交
1121
	REG_WRITE(ah, AR_PHY_AGC_CONTROL,
1122
		  REG_READ(ah, AR_PHY_AGC_CONTROL) | AR_PHY_AGC_CONTROL_NF);
S
Sujith 已提交
1123

1124
	ah->cal_list = ah->cal_list_last = ah->cal_list_curr = NULL;
S
Sujith 已提交
1125

1126
	/* Enable IQ, ADC Gain and ADC DC offset CALs */
S
Sujith 已提交
1127
	if (AR_SREV_9100(ah) || AR_SREV_9160_10_OR_LATER(ah)) {
1128
		if (ath9k_hw_iscal_supported(ah, ADC_GAIN_CAL)) {
1129 1130
			INIT_CAL(&ah->adcgain_caldata);
			INSERT_CAL(ah, &ah->adcgain_caldata);
1131
			DPRINTF(ah, ATH_DBG_CALIBRATE,
1132
				"enabling ADC Gain Calibration.\n");
S
Sujith 已提交
1133
		}
1134
		if (ath9k_hw_iscal_supported(ah, ADC_DC_CAL)) {
1135 1136
			INIT_CAL(&ah->adcdc_caldata);
			INSERT_CAL(ah, &ah->adcdc_caldata);
1137
			DPRINTF(ah, ATH_DBG_CALIBRATE,
1138
				"enabling ADC DC Calibration.\n");
S
Sujith 已提交
1139
		}
1140
		if (ath9k_hw_iscal_supported(ah, IQ_MISMATCH_CAL)) {
1141 1142
			INIT_CAL(&ah->iq_caldata);
			INSERT_CAL(ah, &ah->iq_caldata);
1143
			DPRINTF(ah, ATH_DBG_CALIBRATE,
1144
				"enabling IQ Calibration.\n");
S
Sujith 已提交
1145 1146
		}

1147
		ah->cal_list_curr = ah->cal_list;
S
Sujith 已提交
1148

1149 1150
		if (ah->cal_list_curr)
			ath9k_hw_reset_calibration(ah, ah->cal_list_curr);
S
Sujith 已提交
1151 1152
	}

1153
	chan->CalValid = 0;
S
Sujith 已提交
1154 1155 1156 1157

	return true;
}

1158
const struct ath9k_percal_data iq_cal_multi_sample = {
S
Sujith 已提交
1159 1160 1161 1162 1163 1164
	IQ_MISMATCH_CAL,
	MAX_CAL_SAMPLES,
	PER_MIN_LOG_COUNT,
	ath9k_hw_iqcal_collect,
	ath9k_hw_iqcalibrate
};
1165
const struct ath9k_percal_data iq_cal_single_sample = {
S
Sujith 已提交
1166 1167 1168 1169 1170 1171
	IQ_MISMATCH_CAL,
	MIN_CAL_SAMPLES,
	PER_MAX_LOG_COUNT,
	ath9k_hw_iqcal_collect,
	ath9k_hw_iqcalibrate
};
1172
const struct ath9k_percal_data adc_gain_cal_multi_sample = {
S
Sujith 已提交
1173 1174 1175 1176 1177 1178
	ADC_GAIN_CAL,
	MAX_CAL_SAMPLES,
	PER_MIN_LOG_COUNT,
	ath9k_hw_adc_gaincal_collect,
	ath9k_hw_adc_gaincal_calibrate
};
1179
const struct ath9k_percal_data adc_gain_cal_single_sample = {
S
Sujith 已提交
1180 1181 1182 1183 1184 1185
	ADC_GAIN_CAL,
	MIN_CAL_SAMPLES,
	PER_MAX_LOG_COUNT,
	ath9k_hw_adc_gaincal_collect,
	ath9k_hw_adc_gaincal_calibrate
};
1186
const struct ath9k_percal_data adc_dc_cal_multi_sample = {
S
Sujith 已提交
1187 1188 1189 1190 1191 1192
	ADC_DC_CAL,
	MAX_CAL_SAMPLES,
	PER_MIN_LOG_COUNT,
	ath9k_hw_adc_dccal_collect,
	ath9k_hw_adc_dccal_calibrate
};
1193
const struct ath9k_percal_data adc_dc_cal_single_sample = {
S
Sujith 已提交
1194 1195 1196 1197 1198 1199
	ADC_DC_CAL,
	MIN_CAL_SAMPLES,
	PER_MAX_LOG_COUNT,
	ath9k_hw_adc_dccal_collect,
	ath9k_hw_adc_dccal_calibrate
};
1200
const struct ath9k_percal_data adc_init_dc_cal = {
S
Sujith 已提交
1201 1202 1203 1204 1205 1206
	ADC_DC_INIT_CAL,
	MIN_CAL_SAMPLES,
	INIT_LOG_COUNT,
	ath9k_hw_adc_dccal_collect,
	ath9k_hw_adc_dccal_calibrate
};