162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci * Copyright (c) 2010-2011 Atheros Communications Inc.
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * Permission to use, copy, modify, and/or distribute this software for any
562306a36Sopenharmony_ci * purpose with or without fee is hereby granted, provided that the above
662306a36Sopenharmony_ci * copyright notice and this permission notice appear in all copies.
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
962306a36Sopenharmony_ci * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
1062306a36Sopenharmony_ci * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
1162306a36Sopenharmony_ci * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
1262306a36Sopenharmony_ci * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
1362306a36Sopenharmony_ci * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
1462306a36Sopenharmony_ci * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
1562306a36Sopenharmony_ci */
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include "hw.h"
1862306a36Sopenharmony_ci#include "hw-ops.h"
1962306a36Sopenharmony_ci#include "ar9003_phy.h"
2062306a36Sopenharmony_ci#include "ar9003_rtt.h"
2162306a36Sopenharmony_ci#include "ar9003_mci.h"
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#define MAX_MEASUREMENT	MAX_IQCAL_MEASUREMENT
2462306a36Sopenharmony_ci#define MAX_MAG_DELTA	11
2562306a36Sopenharmony_ci#define MAX_PHS_DELTA	10
2662306a36Sopenharmony_ci#define MAXIQCAL        3
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_cistruct coeff {
2962306a36Sopenharmony_ci	int mag_coeff[AR9300_MAX_CHAINS][MAX_MEASUREMENT][MAXIQCAL];
3062306a36Sopenharmony_ci	int phs_coeff[AR9300_MAX_CHAINS][MAX_MEASUREMENT][MAXIQCAL];
3162306a36Sopenharmony_ci	int iqc_coeff[2];
3262306a36Sopenharmony_ci};
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_cienum ar9003_cal_types {
3562306a36Sopenharmony_ci	IQ_MISMATCH_CAL = BIT(0),
3662306a36Sopenharmony_ci};
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_cistatic void ar9003_hw_setup_calibration(struct ath_hw *ah,
3962306a36Sopenharmony_ci					struct ath9k_cal_list *currCal)
4062306a36Sopenharmony_ci{
4162306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_ci	/* Select calibration to run */
4462306a36Sopenharmony_ci	switch (currCal->calData->calType) {
4562306a36Sopenharmony_ci	case IQ_MISMATCH_CAL:
4662306a36Sopenharmony_ci		/*
4762306a36Sopenharmony_ci		 * Start calibration with
4862306a36Sopenharmony_ci		 * 2^(INIT_IQCAL_LOG_COUNT_MAX+1) samples
4962306a36Sopenharmony_ci		 */
5062306a36Sopenharmony_ci		REG_RMW_FIELD(ah, AR_PHY_TIMING4,
5162306a36Sopenharmony_ci			      AR_PHY_TIMING4_IQCAL_LOG_COUNT_MAX,
5262306a36Sopenharmony_ci			      currCal->calData->calCountMax);
5362306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_IQ);
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
5662306a36Sopenharmony_ci			"starting IQ Mismatch Calibration\n");
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_ci		/* Kick-off cal */
5962306a36Sopenharmony_ci		REG_SET_BIT(ah, AR_PHY_TIMING4, AR_PHY_TIMING4_DO_CAL);
6062306a36Sopenharmony_ci		break;
6162306a36Sopenharmony_ci	default:
6262306a36Sopenharmony_ci		ath_err(common, "Invalid calibration type\n");
6362306a36Sopenharmony_ci		break;
6462306a36Sopenharmony_ci	}
6562306a36Sopenharmony_ci}
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_ci/*
6862306a36Sopenharmony_ci * Generic calibration routine.
6962306a36Sopenharmony_ci * Recalibrate the lower PHY chips to account for temperature/environment
7062306a36Sopenharmony_ci * changes.
7162306a36Sopenharmony_ci */
7262306a36Sopenharmony_cistatic bool ar9003_hw_per_calibration(struct ath_hw *ah,
7362306a36Sopenharmony_ci				      struct ath9k_channel *ichan,
7462306a36Sopenharmony_ci				      u8 rxchainmask,
7562306a36Sopenharmony_ci				      struct ath9k_cal_list *currCal)
7662306a36Sopenharmony_ci{
7762306a36Sopenharmony_ci	struct ath9k_hw_cal_data *caldata = ah->caldata;
7862306a36Sopenharmony_ci	const struct ath9k_percal_data *cur_caldata = currCal->calData;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	/* Calibration in progress. */
8162306a36Sopenharmony_ci	if (currCal->calState == CAL_RUNNING) {
8262306a36Sopenharmony_ci		/* Check to see if it has finished. */
8362306a36Sopenharmony_ci		if (REG_READ(ah, AR_PHY_TIMING4) & AR_PHY_TIMING4_DO_CAL)
8462306a36Sopenharmony_ci			return false;
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci		/*
8762306a36Sopenharmony_ci		* Accumulate cal measures for active chains
8862306a36Sopenharmony_ci		*/
8962306a36Sopenharmony_ci		cur_caldata->calCollect(ah);
9062306a36Sopenharmony_ci		ah->cal_samples++;
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_ci		if (ah->cal_samples >= cur_caldata->calNumSamples) {
9362306a36Sopenharmony_ci			unsigned int i, numChains = 0;
9462306a36Sopenharmony_ci			for (i = 0; i < AR9300_MAX_CHAINS; i++) {
9562306a36Sopenharmony_ci				if (rxchainmask & (1 << i))
9662306a36Sopenharmony_ci					numChains++;
9762306a36Sopenharmony_ci			}
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_ci			/*
10062306a36Sopenharmony_ci			* Process accumulated data
10162306a36Sopenharmony_ci			*/
10262306a36Sopenharmony_ci			cur_caldata->calPostProc(ah, numChains);
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci			/* Calibration has finished. */
10562306a36Sopenharmony_ci			caldata->CalValid |= cur_caldata->calType;
10662306a36Sopenharmony_ci			currCal->calState = CAL_DONE;
10762306a36Sopenharmony_ci			return true;
10862306a36Sopenharmony_ci		} else {
10962306a36Sopenharmony_ci			/*
11062306a36Sopenharmony_ci			 * Set-up collection of another sub-sample until we
11162306a36Sopenharmony_ci			 * get desired number
11262306a36Sopenharmony_ci			 */
11362306a36Sopenharmony_ci			ar9003_hw_setup_calibration(ah, currCal);
11462306a36Sopenharmony_ci		}
11562306a36Sopenharmony_ci	} else if (!(caldata->CalValid & cur_caldata->calType)) {
11662306a36Sopenharmony_ci		/* If current cal is marked invalid in channel, kick it off */
11762306a36Sopenharmony_ci		ath9k_hw_reset_calibration(ah, currCal);
11862306a36Sopenharmony_ci	}
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	return false;
12162306a36Sopenharmony_ci}
12262306a36Sopenharmony_ci
12362306a36Sopenharmony_cistatic int ar9003_hw_calibrate(struct ath_hw *ah, struct ath9k_channel *chan,
12462306a36Sopenharmony_ci			       u8 rxchainmask, bool longcal)
12562306a36Sopenharmony_ci{
12662306a36Sopenharmony_ci	bool iscaldone = true;
12762306a36Sopenharmony_ci	struct ath9k_cal_list *currCal = ah->cal_list_curr;
12862306a36Sopenharmony_ci	int ret;
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci	/*
13162306a36Sopenharmony_ci	 * For given calibration:
13262306a36Sopenharmony_ci	 * 1. Call generic cal routine
13362306a36Sopenharmony_ci	 * 2. When this cal is done (isCalDone) if we have more cals waiting
13462306a36Sopenharmony_ci	 *    (eg after reset), mask this to upper layers by not propagating
13562306a36Sopenharmony_ci	 *    isCalDone if it is set to TRUE.
13662306a36Sopenharmony_ci	 *    Instead, change isCalDone to FALSE and setup the waiting cal(s)
13762306a36Sopenharmony_ci	 *    to be run.
13862306a36Sopenharmony_ci	 */
13962306a36Sopenharmony_ci	if (currCal &&
14062306a36Sopenharmony_ci	    (currCal->calState == CAL_RUNNING ||
14162306a36Sopenharmony_ci	     currCal->calState == CAL_WAITING)) {
14262306a36Sopenharmony_ci		iscaldone = ar9003_hw_per_calibration(ah, chan,
14362306a36Sopenharmony_ci						      rxchainmask, currCal);
14462306a36Sopenharmony_ci		if (iscaldone) {
14562306a36Sopenharmony_ci			ah->cal_list_curr = currCal = currCal->calNext;
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci			if (currCal->calState == CAL_WAITING) {
14862306a36Sopenharmony_ci				iscaldone = false;
14962306a36Sopenharmony_ci				ath9k_hw_reset_calibration(ah, currCal);
15062306a36Sopenharmony_ci			}
15162306a36Sopenharmony_ci		}
15262306a36Sopenharmony_ci	}
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_ci	/*
15562306a36Sopenharmony_ci	 * Do NF cal only at longer intervals. Get the value from
15662306a36Sopenharmony_ci	 * the previous NF cal and update history buffer.
15762306a36Sopenharmony_ci	 */
15862306a36Sopenharmony_ci	if (longcal && ath9k_hw_getnf(ah, chan)) {
15962306a36Sopenharmony_ci		/*
16062306a36Sopenharmony_ci		 * Load the NF from history buffer of the current channel.
16162306a36Sopenharmony_ci		 * NF is slow time-variant, so it is OK to use a historical
16262306a36Sopenharmony_ci		 * value.
16362306a36Sopenharmony_ci		 */
16462306a36Sopenharmony_ci		ret = ath9k_hw_loadnf(ah, ah->curchan);
16562306a36Sopenharmony_ci		if (ret < 0)
16662306a36Sopenharmony_ci			return ret;
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci		/* start NF calibration, without updating BB NF register */
16962306a36Sopenharmony_ci		ath9k_hw_start_nfcal(ah, false);
17062306a36Sopenharmony_ci	}
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_ci	return iscaldone;
17362306a36Sopenharmony_ci}
17462306a36Sopenharmony_ci
17562306a36Sopenharmony_cistatic void ar9003_hw_iqcal_collect(struct ath_hw *ah)
17662306a36Sopenharmony_ci{
17762306a36Sopenharmony_ci	int i;
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_ci	/* Accumulate IQ cal measures for active chains */
18062306a36Sopenharmony_ci	for (i = 0; i < AR9300_MAX_CHAINS; i++) {
18162306a36Sopenharmony_ci		if (ah->txchainmask & BIT(i)) {
18262306a36Sopenharmony_ci			ah->totalPowerMeasI[i] +=
18362306a36Sopenharmony_ci				REG_READ(ah, AR_PHY_CAL_MEAS_0(i));
18462306a36Sopenharmony_ci			ah->totalPowerMeasQ[i] +=
18562306a36Sopenharmony_ci				REG_READ(ah, AR_PHY_CAL_MEAS_1(i));
18662306a36Sopenharmony_ci			ah->totalIqCorrMeas[i] +=
18762306a36Sopenharmony_ci				(int32_t) REG_READ(ah, AR_PHY_CAL_MEAS_2(i));
18862306a36Sopenharmony_ci			ath_dbg(ath9k_hw_common(ah), CALIBRATE,
18962306a36Sopenharmony_ci				"%d: Chn %d pmi=0x%08x;pmq=0x%08x;iqcm=0x%08x;\n",
19062306a36Sopenharmony_ci				ah->cal_samples, i, ah->totalPowerMeasI[i],
19162306a36Sopenharmony_ci				ah->totalPowerMeasQ[i],
19262306a36Sopenharmony_ci				ah->totalIqCorrMeas[i]);
19362306a36Sopenharmony_ci		}
19462306a36Sopenharmony_ci	}
19562306a36Sopenharmony_ci}
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_cistatic void ar9003_hw_iqcalibrate(struct ath_hw *ah, u8 numChains)
19862306a36Sopenharmony_ci{
19962306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
20062306a36Sopenharmony_ci	u32 powerMeasQ, powerMeasI, iqCorrMeas;
20162306a36Sopenharmony_ci	u32 qCoffDenom, iCoffDenom;
20262306a36Sopenharmony_ci	int32_t qCoff, iCoff;
20362306a36Sopenharmony_ci	int iqCorrNeg, i;
20462306a36Sopenharmony_ci	static const u_int32_t offset_array[3] = {
20562306a36Sopenharmony_ci		AR_PHY_RX_IQCAL_CORR_B0,
20662306a36Sopenharmony_ci		AR_PHY_RX_IQCAL_CORR_B1,
20762306a36Sopenharmony_ci		AR_PHY_RX_IQCAL_CORR_B2,
20862306a36Sopenharmony_ci	};
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_ci	for (i = 0; i < numChains; i++) {
21162306a36Sopenharmony_ci		powerMeasI = ah->totalPowerMeasI[i];
21262306a36Sopenharmony_ci		powerMeasQ = ah->totalPowerMeasQ[i];
21362306a36Sopenharmony_ci		iqCorrMeas = ah->totalIqCorrMeas[i];
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
21662306a36Sopenharmony_ci			"Starting IQ Cal and Correction for Chain %d\n", i);
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
21962306a36Sopenharmony_ci			"Original: Chn %d iq_corr_meas = 0x%08x\n",
22062306a36Sopenharmony_ci			i, ah->totalIqCorrMeas[i]);
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci		iqCorrNeg = 0;
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci		if (iqCorrMeas > 0x80000000) {
22562306a36Sopenharmony_ci			iqCorrMeas = (0xffffffff - iqCorrMeas) + 1;
22662306a36Sopenharmony_ci			iqCorrNeg = 1;
22762306a36Sopenharmony_ci		}
22862306a36Sopenharmony_ci
22962306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE, "Chn %d pwr_meas_i = 0x%08x\n",
23062306a36Sopenharmony_ci			i, powerMeasI);
23162306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE, "Chn %d pwr_meas_q = 0x%08x\n",
23262306a36Sopenharmony_ci			i, powerMeasQ);
23362306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE, "iqCorrNeg is 0x%08x\n", iqCorrNeg);
23462306a36Sopenharmony_ci
23562306a36Sopenharmony_ci		iCoffDenom = (powerMeasI / 2 + powerMeasQ / 2) / 256;
23662306a36Sopenharmony_ci		qCoffDenom = powerMeasQ / 64;
23762306a36Sopenharmony_ci
23862306a36Sopenharmony_ci		if ((iCoffDenom != 0) && (qCoffDenom != 0)) {
23962306a36Sopenharmony_ci			iCoff = iqCorrMeas / iCoffDenom;
24062306a36Sopenharmony_ci			qCoff = powerMeasI / qCoffDenom - 64;
24162306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE, "Chn %d iCoff = 0x%08x\n",
24262306a36Sopenharmony_ci				i, iCoff);
24362306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE, "Chn %d qCoff = 0x%08x\n",
24462306a36Sopenharmony_ci				i, qCoff);
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci			/* Force bounds on iCoff */
24762306a36Sopenharmony_ci			if (iCoff >= 63)
24862306a36Sopenharmony_ci				iCoff = 63;
24962306a36Sopenharmony_ci			else if (iCoff <= -63)
25062306a36Sopenharmony_ci				iCoff = -63;
25162306a36Sopenharmony_ci
25262306a36Sopenharmony_ci			/* Negate iCoff if iqCorrNeg == 0 */
25362306a36Sopenharmony_ci			if (iqCorrNeg == 0x0)
25462306a36Sopenharmony_ci				iCoff = -iCoff;
25562306a36Sopenharmony_ci
25662306a36Sopenharmony_ci			/* Force bounds on qCoff */
25762306a36Sopenharmony_ci			if (qCoff >= 63)
25862306a36Sopenharmony_ci				qCoff = 63;
25962306a36Sopenharmony_ci			else if (qCoff <= -63)
26062306a36Sopenharmony_ci				qCoff = -63;
26162306a36Sopenharmony_ci
26262306a36Sopenharmony_ci			iCoff = iCoff & 0x7f;
26362306a36Sopenharmony_ci			qCoff = qCoff & 0x7f;
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE,
26662306a36Sopenharmony_ci				"Chn %d : iCoff = 0x%x  qCoff = 0x%x\n",
26762306a36Sopenharmony_ci				i, iCoff, qCoff);
26862306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE,
26962306a36Sopenharmony_ci				"Register offset (0x%04x) before update = 0x%x\n",
27062306a36Sopenharmony_ci				offset_array[i],
27162306a36Sopenharmony_ci				REG_READ(ah, offset_array[i]));
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_ci			if (AR_SREV_9565(ah) &&
27462306a36Sopenharmony_ci			    (iCoff == 63 || qCoff == 63 ||
27562306a36Sopenharmony_ci			     iCoff == -63 || qCoff == -63))
27662306a36Sopenharmony_ci				return;
27762306a36Sopenharmony_ci
27862306a36Sopenharmony_ci			REG_RMW_FIELD(ah, offset_array[i],
27962306a36Sopenharmony_ci				      AR_PHY_RX_IQCAL_CORR_IQCORR_Q_I_COFF,
28062306a36Sopenharmony_ci				      iCoff);
28162306a36Sopenharmony_ci			REG_RMW_FIELD(ah, offset_array[i],
28262306a36Sopenharmony_ci				      AR_PHY_RX_IQCAL_CORR_IQCORR_Q_Q_COFF,
28362306a36Sopenharmony_ci				      qCoff);
28462306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE,
28562306a36Sopenharmony_ci				"Register offset (0x%04x) QI COFF (bitfields 0x%08x) after update = 0x%x\n",
28662306a36Sopenharmony_ci				offset_array[i],
28762306a36Sopenharmony_ci				AR_PHY_RX_IQCAL_CORR_IQCORR_Q_I_COFF,
28862306a36Sopenharmony_ci				REG_READ(ah, offset_array[i]));
28962306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE,
29062306a36Sopenharmony_ci				"Register offset (0x%04x) QQ COFF (bitfields 0x%08x) after update = 0x%x\n",
29162306a36Sopenharmony_ci				offset_array[i],
29262306a36Sopenharmony_ci				AR_PHY_RX_IQCAL_CORR_IQCORR_Q_Q_COFF,
29362306a36Sopenharmony_ci				REG_READ(ah, offset_array[i]));
29462306a36Sopenharmony_ci
29562306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE,
29662306a36Sopenharmony_ci				"IQ Cal and Correction done for Chain %d\n", i);
29762306a36Sopenharmony_ci		}
29862306a36Sopenharmony_ci	}
29962306a36Sopenharmony_ci
30062306a36Sopenharmony_ci	REG_SET_BIT(ah, AR_PHY_RX_IQCAL_CORR_B0,
30162306a36Sopenharmony_ci		    AR_PHY_RX_IQCAL_CORR_IQCORR_ENABLE);
30262306a36Sopenharmony_ci	ath_dbg(common, CALIBRATE,
30362306a36Sopenharmony_ci		"IQ Cal and Correction (offset 0x%04x) enabled (bit position 0x%08x). New Value 0x%08x\n",
30462306a36Sopenharmony_ci		(unsigned) (AR_PHY_RX_IQCAL_CORR_B0),
30562306a36Sopenharmony_ci		AR_PHY_RX_IQCAL_CORR_IQCORR_ENABLE,
30662306a36Sopenharmony_ci		REG_READ(ah, AR_PHY_RX_IQCAL_CORR_B0));
30762306a36Sopenharmony_ci}
30862306a36Sopenharmony_ci
30962306a36Sopenharmony_cistatic const struct ath9k_percal_data iq_cal_single_sample = {
31062306a36Sopenharmony_ci	IQ_MISMATCH_CAL,
31162306a36Sopenharmony_ci	MIN_CAL_SAMPLES,
31262306a36Sopenharmony_ci	PER_MAX_LOG_COUNT,
31362306a36Sopenharmony_ci	ar9003_hw_iqcal_collect,
31462306a36Sopenharmony_ci	ar9003_hw_iqcalibrate
31562306a36Sopenharmony_ci};
31662306a36Sopenharmony_ci
31762306a36Sopenharmony_cistatic void ar9003_hw_init_cal_settings(struct ath_hw *ah)
31862306a36Sopenharmony_ci{
31962306a36Sopenharmony_ci	ah->iq_caldata.calData = &iq_cal_single_sample;
32062306a36Sopenharmony_ci
32162306a36Sopenharmony_ci	if (AR_SREV_9300_20_OR_LATER(ah)) {
32262306a36Sopenharmony_ci		ah->enabled_cals |= TX_IQ_CAL;
32362306a36Sopenharmony_ci		if (AR_SREV_9485_OR_LATER(ah) && !AR_SREV_9340(ah))
32462306a36Sopenharmony_ci			ah->enabled_cals |= TX_IQ_ON_AGC_CAL;
32562306a36Sopenharmony_ci	}
32662306a36Sopenharmony_ci
32762306a36Sopenharmony_ci	ah->supp_cals = IQ_MISMATCH_CAL;
32862306a36Sopenharmony_ci}
32962306a36Sopenharmony_ci
33062306a36Sopenharmony_ci#define OFF_UPPER_LT 24
33162306a36Sopenharmony_ci#define OFF_LOWER_LT 7
33262306a36Sopenharmony_ci
33362306a36Sopenharmony_cistatic bool ar9003_hw_dynamic_osdac_selection(struct ath_hw *ah,
33462306a36Sopenharmony_ci					      bool txiqcal_done)
33562306a36Sopenharmony_ci{
33662306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
33762306a36Sopenharmony_ci	int ch0_done, osdac_ch0, dc_off_ch0_i1, dc_off_ch0_q1, dc_off_ch0_i2,
33862306a36Sopenharmony_ci		dc_off_ch0_q2, dc_off_ch0_i3, dc_off_ch0_q3;
33962306a36Sopenharmony_ci	int ch1_done, osdac_ch1, dc_off_ch1_i1, dc_off_ch1_q1, dc_off_ch1_i2,
34062306a36Sopenharmony_ci		dc_off_ch1_q2, dc_off_ch1_i3, dc_off_ch1_q3;
34162306a36Sopenharmony_ci	int ch2_done, osdac_ch2, dc_off_ch2_i1, dc_off_ch2_q1, dc_off_ch2_i2,
34262306a36Sopenharmony_ci		dc_off_ch2_q2, dc_off_ch2_i3, dc_off_ch2_q3;
34362306a36Sopenharmony_ci	bool status;
34462306a36Sopenharmony_ci	u32 temp, val;
34562306a36Sopenharmony_ci
34662306a36Sopenharmony_ci	/*
34762306a36Sopenharmony_ci	 * Clear offset and IQ calibration, run AGC cal.
34862306a36Sopenharmony_ci	 */
34962306a36Sopenharmony_ci	REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL(ah),
35062306a36Sopenharmony_ci		    AR_PHY_AGC_CONTROL_OFFSET_CAL);
35162306a36Sopenharmony_ci	REG_CLR_BIT(ah, AR_PHY_TX_IQCAL_CONTROL_0(ah),
35262306a36Sopenharmony_ci		    AR_PHY_TX_IQCAL_CONTROL_0_ENABLE_TXIQ_CAL);
35362306a36Sopenharmony_ci	REG_WRITE(ah, AR_PHY_AGC_CONTROL(ah),
35462306a36Sopenharmony_ci		  REG_READ(ah, AR_PHY_AGC_CONTROL(ah)) | AR_PHY_AGC_CONTROL_CAL);
35562306a36Sopenharmony_ci
35662306a36Sopenharmony_ci	status = ath9k_hw_wait(ah, AR_PHY_AGC_CONTROL(ah),
35762306a36Sopenharmony_ci			       AR_PHY_AGC_CONTROL_CAL,
35862306a36Sopenharmony_ci			       0, AH_WAIT_TIMEOUT);
35962306a36Sopenharmony_ci	if (!status) {
36062306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
36162306a36Sopenharmony_ci			"AGC cal without offset cal failed to complete in 1ms");
36262306a36Sopenharmony_ci		return false;
36362306a36Sopenharmony_ci	}
36462306a36Sopenharmony_ci
36562306a36Sopenharmony_ci	/*
36662306a36Sopenharmony_ci	 * Allow only offset calibration and disable the others
36762306a36Sopenharmony_ci	 * (Carrier Leak calibration, TX Filter calibration and
36862306a36Sopenharmony_ci	 *  Peak Detector offset calibration).
36962306a36Sopenharmony_ci	 */
37062306a36Sopenharmony_ci	REG_SET_BIT(ah, AR_PHY_AGC_CONTROL(ah),
37162306a36Sopenharmony_ci		    AR_PHY_AGC_CONTROL_OFFSET_CAL);
37262306a36Sopenharmony_ci	REG_CLR_BIT(ah, AR_PHY_CL_CAL_CTL,
37362306a36Sopenharmony_ci		    AR_PHY_CL_CAL_ENABLE);
37462306a36Sopenharmony_ci	REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL(ah),
37562306a36Sopenharmony_ci		    AR_PHY_AGC_CONTROL_FLTR_CAL);
37662306a36Sopenharmony_ci	REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL(ah),
37762306a36Sopenharmony_ci		    AR_PHY_AGC_CONTROL_PKDET_CAL);
37862306a36Sopenharmony_ci
37962306a36Sopenharmony_ci	ch0_done = 0;
38062306a36Sopenharmony_ci	ch1_done = 0;
38162306a36Sopenharmony_ci	ch2_done = 0;
38262306a36Sopenharmony_ci
38362306a36Sopenharmony_ci	while ((ch0_done == 0) || (ch1_done == 0) || (ch2_done == 0)) {
38462306a36Sopenharmony_ci		osdac_ch0 = (REG_READ(ah, AR_PHY_65NM_CH0_BB1) >> 30) & 0x3;
38562306a36Sopenharmony_ci		osdac_ch1 = (REG_READ(ah, AR_PHY_65NM_CH1_BB1) >> 30) & 0x3;
38662306a36Sopenharmony_ci		osdac_ch2 = (REG_READ(ah, AR_PHY_65NM_CH2_BB1) >> 30) & 0x3;
38762306a36Sopenharmony_ci
38862306a36Sopenharmony_ci		REG_SET_BIT(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
38962306a36Sopenharmony_ci
39062306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_AGC_CONTROL(ah),
39162306a36Sopenharmony_ci			  REG_READ(ah, AR_PHY_AGC_CONTROL(ah)) | AR_PHY_AGC_CONTROL_CAL);
39262306a36Sopenharmony_ci
39362306a36Sopenharmony_ci		status = ath9k_hw_wait(ah, AR_PHY_AGC_CONTROL(ah),
39462306a36Sopenharmony_ci				       AR_PHY_AGC_CONTROL_CAL,
39562306a36Sopenharmony_ci				       0, AH_WAIT_TIMEOUT);
39662306a36Sopenharmony_ci		if (!status) {
39762306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE,
39862306a36Sopenharmony_ci				"DC offset cal failed to complete in 1ms");
39962306a36Sopenharmony_ci			return false;
40062306a36Sopenharmony_ci		}
40162306a36Sopenharmony_ci
40262306a36Sopenharmony_ci		REG_CLR_BIT(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
40362306a36Sopenharmony_ci
40462306a36Sopenharmony_ci		/*
40562306a36Sopenharmony_ci		 * High gain.
40662306a36Sopenharmony_ci		 */
40762306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH0_BB3,
40862306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH0_BB3) & 0xfffffcff) | (1 << 8)));
40962306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH1_BB3,
41062306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH1_BB3) & 0xfffffcff) | (1 << 8)));
41162306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH2_BB3,
41262306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH2_BB3) & 0xfffffcff) | (1 << 8)));
41362306a36Sopenharmony_ci
41462306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH0_BB3);
41562306a36Sopenharmony_ci		dc_off_ch0_i1 = (temp >> 26) & 0x1f;
41662306a36Sopenharmony_ci		dc_off_ch0_q1 = (temp >> 21) & 0x1f;
41762306a36Sopenharmony_ci
41862306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH1_BB3);
41962306a36Sopenharmony_ci		dc_off_ch1_i1 = (temp >> 26) & 0x1f;
42062306a36Sopenharmony_ci		dc_off_ch1_q1 = (temp >> 21) & 0x1f;
42162306a36Sopenharmony_ci
42262306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH2_BB3);
42362306a36Sopenharmony_ci		dc_off_ch2_i1 = (temp >> 26) & 0x1f;
42462306a36Sopenharmony_ci		dc_off_ch2_q1 = (temp >> 21) & 0x1f;
42562306a36Sopenharmony_ci
42662306a36Sopenharmony_ci		/*
42762306a36Sopenharmony_ci		 * Low gain.
42862306a36Sopenharmony_ci		 */
42962306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH0_BB3,
43062306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH0_BB3) & 0xfffffcff) | (2 << 8)));
43162306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH1_BB3,
43262306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH1_BB3) & 0xfffffcff) | (2 << 8)));
43362306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH2_BB3,
43462306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH2_BB3) & 0xfffffcff) | (2 << 8)));
43562306a36Sopenharmony_ci
43662306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH0_BB3);
43762306a36Sopenharmony_ci		dc_off_ch0_i2 = (temp >> 26) & 0x1f;
43862306a36Sopenharmony_ci		dc_off_ch0_q2 = (temp >> 21) & 0x1f;
43962306a36Sopenharmony_ci
44062306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH1_BB3);
44162306a36Sopenharmony_ci		dc_off_ch1_i2 = (temp >> 26) & 0x1f;
44262306a36Sopenharmony_ci		dc_off_ch1_q2 = (temp >> 21) & 0x1f;
44362306a36Sopenharmony_ci
44462306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH2_BB3);
44562306a36Sopenharmony_ci		dc_off_ch2_i2 = (temp >> 26) & 0x1f;
44662306a36Sopenharmony_ci		dc_off_ch2_q2 = (temp >> 21) & 0x1f;
44762306a36Sopenharmony_ci
44862306a36Sopenharmony_ci		/*
44962306a36Sopenharmony_ci		 * Loopback.
45062306a36Sopenharmony_ci		 */
45162306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH0_BB3,
45262306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH0_BB3) & 0xfffffcff) | (3 << 8)));
45362306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH1_BB3,
45462306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH1_BB3) & 0xfffffcff) | (3 << 8)));
45562306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_65NM_CH2_BB3,
45662306a36Sopenharmony_ci			  ((REG_READ(ah, AR_PHY_65NM_CH2_BB3) & 0xfffffcff) | (3 << 8)));
45762306a36Sopenharmony_ci
45862306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH0_BB3);
45962306a36Sopenharmony_ci		dc_off_ch0_i3 = (temp >> 26) & 0x1f;
46062306a36Sopenharmony_ci		dc_off_ch0_q3 = (temp >> 21) & 0x1f;
46162306a36Sopenharmony_ci
46262306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH1_BB3);
46362306a36Sopenharmony_ci		dc_off_ch1_i3 = (temp >> 26) & 0x1f;
46462306a36Sopenharmony_ci		dc_off_ch1_q3 = (temp >> 21) & 0x1f;
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_ci		temp = REG_READ(ah, AR_PHY_65NM_CH2_BB3);
46762306a36Sopenharmony_ci		dc_off_ch2_i3 = (temp >> 26) & 0x1f;
46862306a36Sopenharmony_ci		dc_off_ch2_q3 = (temp >> 21) & 0x1f;
46962306a36Sopenharmony_ci
47062306a36Sopenharmony_ci		if ((dc_off_ch0_i1 > OFF_UPPER_LT) || (dc_off_ch0_i1 < OFF_LOWER_LT) ||
47162306a36Sopenharmony_ci		    (dc_off_ch0_i2 > OFF_UPPER_LT) || (dc_off_ch0_i2 < OFF_LOWER_LT) ||
47262306a36Sopenharmony_ci		    (dc_off_ch0_i3 > OFF_UPPER_LT) || (dc_off_ch0_i3 < OFF_LOWER_LT) ||
47362306a36Sopenharmony_ci		    (dc_off_ch0_q1 > OFF_UPPER_LT) || (dc_off_ch0_q1 < OFF_LOWER_LT) ||
47462306a36Sopenharmony_ci		    (dc_off_ch0_q2 > OFF_UPPER_LT) || (dc_off_ch0_q2 < OFF_LOWER_LT) ||
47562306a36Sopenharmony_ci		    (dc_off_ch0_q3 > OFF_UPPER_LT) || (dc_off_ch0_q3 < OFF_LOWER_LT)) {
47662306a36Sopenharmony_ci			if (osdac_ch0 == 3) {
47762306a36Sopenharmony_ci				ch0_done = 1;
47862306a36Sopenharmony_ci			} else {
47962306a36Sopenharmony_ci				osdac_ch0++;
48062306a36Sopenharmony_ci
48162306a36Sopenharmony_ci				val = REG_READ(ah, AR_PHY_65NM_CH0_BB1) & 0x3fffffff;
48262306a36Sopenharmony_ci				val |= (osdac_ch0 << 30);
48362306a36Sopenharmony_ci				REG_WRITE(ah, AR_PHY_65NM_CH0_BB1, val);
48462306a36Sopenharmony_ci
48562306a36Sopenharmony_ci				ch0_done = 0;
48662306a36Sopenharmony_ci			}
48762306a36Sopenharmony_ci		} else {
48862306a36Sopenharmony_ci			ch0_done = 1;
48962306a36Sopenharmony_ci		}
49062306a36Sopenharmony_ci
49162306a36Sopenharmony_ci		if ((dc_off_ch1_i1 > OFF_UPPER_LT) || (dc_off_ch1_i1 < OFF_LOWER_LT) ||
49262306a36Sopenharmony_ci		    (dc_off_ch1_i2 > OFF_UPPER_LT) || (dc_off_ch1_i2 < OFF_LOWER_LT) ||
49362306a36Sopenharmony_ci		    (dc_off_ch1_i3 > OFF_UPPER_LT) || (dc_off_ch1_i3 < OFF_LOWER_LT) ||
49462306a36Sopenharmony_ci		    (dc_off_ch1_q1 > OFF_UPPER_LT) || (dc_off_ch1_q1 < OFF_LOWER_LT) ||
49562306a36Sopenharmony_ci		    (dc_off_ch1_q2 > OFF_UPPER_LT) || (dc_off_ch1_q2 < OFF_LOWER_LT) ||
49662306a36Sopenharmony_ci		    (dc_off_ch1_q3 > OFF_UPPER_LT) || (dc_off_ch1_q3 < OFF_LOWER_LT)) {
49762306a36Sopenharmony_ci			if (osdac_ch1 == 3) {
49862306a36Sopenharmony_ci				ch1_done = 1;
49962306a36Sopenharmony_ci			} else {
50062306a36Sopenharmony_ci				osdac_ch1++;
50162306a36Sopenharmony_ci
50262306a36Sopenharmony_ci				val = REG_READ(ah, AR_PHY_65NM_CH1_BB1) & 0x3fffffff;
50362306a36Sopenharmony_ci				val |= (osdac_ch1 << 30);
50462306a36Sopenharmony_ci				REG_WRITE(ah, AR_PHY_65NM_CH1_BB1, val);
50562306a36Sopenharmony_ci
50662306a36Sopenharmony_ci				ch1_done = 0;
50762306a36Sopenharmony_ci			}
50862306a36Sopenharmony_ci		} else {
50962306a36Sopenharmony_ci			ch1_done = 1;
51062306a36Sopenharmony_ci		}
51162306a36Sopenharmony_ci
51262306a36Sopenharmony_ci		if ((dc_off_ch2_i1 > OFF_UPPER_LT) || (dc_off_ch2_i1 < OFF_LOWER_LT) ||
51362306a36Sopenharmony_ci		    (dc_off_ch2_i2 > OFF_UPPER_LT) || (dc_off_ch2_i2 < OFF_LOWER_LT) ||
51462306a36Sopenharmony_ci		    (dc_off_ch2_i3 > OFF_UPPER_LT) || (dc_off_ch2_i3 < OFF_LOWER_LT) ||
51562306a36Sopenharmony_ci		    (dc_off_ch2_q1 > OFF_UPPER_LT) || (dc_off_ch2_q1 < OFF_LOWER_LT) ||
51662306a36Sopenharmony_ci		    (dc_off_ch2_q2 > OFF_UPPER_LT) || (dc_off_ch2_q2 < OFF_LOWER_LT) ||
51762306a36Sopenharmony_ci		    (dc_off_ch2_q3 > OFF_UPPER_LT) || (dc_off_ch2_q3 < OFF_LOWER_LT)) {
51862306a36Sopenharmony_ci			if (osdac_ch2 == 3) {
51962306a36Sopenharmony_ci				ch2_done = 1;
52062306a36Sopenharmony_ci			} else {
52162306a36Sopenharmony_ci				osdac_ch2++;
52262306a36Sopenharmony_ci
52362306a36Sopenharmony_ci				val = REG_READ(ah, AR_PHY_65NM_CH2_BB1) & 0x3fffffff;
52462306a36Sopenharmony_ci				val |= (osdac_ch2 << 30);
52562306a36Sopenharmony_ci				REG_WRITE(ah, AR_PHY_65NM_CH2_BB1, val);
52662306a36Sopenharmony_ci
52762306a36Sopenharmony_ci				ch2_done = 0;
52862306a36Sopenharmony_ci			}
52962306a36Sopenharmony_ci		} else {
53062306a36Sopenharmony_ci			ch2_done = 1;
53162306a36Sopenharmony_ci		}
53262306a36Sopenharmony_ci	}
53362306a36Sopenharmony_ci
53462306a36Sopenharmony_ci	REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL(ah),
53562306a36Sopenharmony_ci		    AR_PHY_AGC_CONTROL_OFFSET_CAL);
53662306a36Sopenharmony_ci	REG_SET_BIT(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
53762306a36Sopenharmony_ci
53862306a36Sopenharmony_ci	/*
53962306a36Sopenharmony_ci	 * We don't need to check txiqcal_done here since it is always
54062306a36Sopenharmony_ci	 * set for AR9550.
54162306a36Sopenharmony_ci	 */
54262306a36Sopenharmony_ci	REG_SET_BIT(ah, AR_PHY_TX_IQCAL_CONTROL_0(ah),
54362306a36Sopenharmony_ci		    AR_PHY_TX_IQCAL_CONTROL_0_ENABLE_TXIQ_CAL);
54462306a36Sopenharmony_ci
54562306a36Sopenharmony_ci	return true;
54662306a36Sopenharmony_ci}
54762306a36Sopenharmony_ci
54862306a36Sopenharmony_ci/*
54962306a36Sopenharmony_ci * solve 4x4 linear equation used in loopback iq cal.
55062306a36Sopenharmony_ci */
55162306a36Sopenharmony_cistatic bool ar9003_hw_solve_iq_cal(struct ath_hw *ah,
55262306a36Sopenharmony_ci				   s32 sin_2phi_1,
55362306a36Sopenharmony_ci				   s32 cos_2phi_1,
55462306a36Sopenharmony_ci				   s32 sin_2phi_2,
55562306a36Sopenharmony_ci				   s32 cos_2phi_2,
55662306a36Sopenharmony_ci				   s32 mag_a0_d0,
55762306a36Sopenharmony_ci				   s32 phs_a0_d0,
55862306a36Sopenharmony_ci				   s32 mag_a1_d0,
55962306a36Sopenharmony_ci				   s32 phs_a1_d0,
56062306a36Sopenharmony_ci				   s32 solved_eq[])
56162306a36Sopenharmony_ci{
56262306a36Sopenharmony_ci	s32 f1 = cos_2phi_1 - cos_2phi_2,
56362306a36Sopenharmony_ci	    f3 = sin_2phi_1 - sin_2phi_2,
56462306a36Sopenharmony_ci	    f2;
56562306a36Sopenharmony_ci	s32 mag_tx, phs_tx, mag_rx, phs_rx;
56662306a36Sopenharmony_ci	const s32 result_shift = 1 << 15;
56762306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
56862306a36Sopenharmony_ci
56962306a36Sopenharmony_ci	f2 = ((f1 >> 3) * (f1 >> 3) + (f3 >> 3) * (f3 >> 3)) >> 9;
57062306a36Sopenharmony_ci
57162306a36Sopenharmony_ci	if (!f2) {
57262306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE, "Divide by 0\n");
57362306a36Sopenharmony_ci		return false;
57462306a36Sopenharmony_ci	}
57562306a36Sopenharmony_ci
57662306a36Sopenharmony_ci	/* mag mismatch, tx */
57762306a36Sopenharmony_ci	mag_tx = f1 * (mag_a0_d0  - mag_a1_d0) + f3 * (phs_a0_d0 - phs_a1_d0);
57862306a36Sopenharmony_ci	/* phs mismatch, tx */
57962306a36Sopenharmony_ci	phs_tx = f3 * (-mag_a0_d0 + mag_a1_d0) + f1 * (phs_a0_d0 - phs_a1_d0);
58062306a36Sopenharmony_ci
58162306a36Sopenharmony_ci	mag_tx = (mag_tx / f2);
58262306a36Sopenharmony_ci	phs_tx = (phs_tx / f2);
58362306a36Sopenharmony_ci
58462306a36Sopenharmony_ci	/* mag mismatch, rx */
58562306a36Sopenharmony_ci	mag_rx = mag_a0_d0 - (cos_2phi_1 * mag_tx + sin_2phi_1 * phs_tx) /
58662306a36Sopenharmony_ci		 result_shift;
58762306a36Sopenharmony_ci	/* phs mismatch, rx */
58862306a36Sopenharmony_ci	phs_rx = phs_a0_d0 + (sin_2phi_1 * mag_tx - cos_2phi_1 * phs_tx) /
58962306a36Sopenharmony_ci		 result_shift;
59062306a36Sopenharmony_ci
59162306a36Sopenharmony_ci	solved_eq[0] = mag_tx;
59262306a36Sopenharmony_ci	solved_eq[1] = phs_tx;
59362306a36Sopenharmony_ci	solved_eq[2] = mag_rx;
59462306a36Sopenharmony_ci	solved_eq[3] = phs_rx;
59562306a36Sopenharmony_ci
59662306a36Sopenharmony_ci	return true;
59762306a36Sopenharmony_ci}
59862306a36Sopenharmony_ci
59962306a36Sopenharmony_cistatic s32 ar9003_hw_find_mag_approx(struct ath_hw *ah, s32 in_re, s32 in_im)
60062306a36Sopenharmony_ci{
60162306a36Sopenharmony_ci	s32 abs_i = abs(in_re),
60262306a36Sopenharmony_ci	    abs_q = abs(in_im),
60362306a36Sopenharmony_ci	    max_abs, min_abs;
60462306a36Sopenharmony_ci
60562306a36Sopenharmony_ci	if (abs_i > abs_q) {
60662306a36Sopenharmony_ci		max_abs = abs_i;
60762306a36Sopenharmony_ci		min_abs = abs_q;
60862306a36Sopenharmony_ci	} else {
60962306a36Sopenharmony_ci		max_abs = abs_q;
61062306a36Sopenharmony_ci		min_abs = abs_i;
61162306a36Sopenharmony_ci	}
61262306a36Sopenharmony_ci
61362306a36Sopenharmony_ci	return max_abs - (max_abs / 32) + (min_abs / 8) + (min_abs / 4);
61462306a36Sopenharmony_ci}
61562306a36Sopenharmony_ci
61662306a36Sopenharmony_ci#define DELPT 32
61762306a36Sopenharmony_ci
61862306a36Sopenharmony_cistatic bool ar9003_hw_calc_iq_corr(struct ath_hw *ah,
61962306a36Sopenharmony_ci				   s32 chain_idx,
62062306a36Sopenharmony_ci				   const s32 iq_res[],
62162306a36Sopenharmony_ci				   s32 iqc_coeff[])
62262306a36Sopenharmony_ci{
62362306a36Sopenharmony_ci	s32 i2_m_q2_a0_d0, i2_p_q2_a0_d0, iq_corr_a0_d0,
62462306a36Sopenharmony_ci	    i2_m_q2_a0_d1, i2_p_q2_a0_d1, iq_corr_a0_d1,
62562306a36Sopenharmony_ci	    i2_m_q2_a1_d0, i2_p_q2_a1_d0, iq_corr_a1_d0,
62662306a36Sopenharmony_ci	    i2_m_q2_a1_d1, i2_p_q2_a1_d1, iq_corr_a1_d1;
62762306a36Sopenharmony_ci	s32 mag_a0_d0, mag_a1_d0, mag_a0_d1, mag_a1_d1,
62862306a36Sopenharmony_ci	    phs_a0_d0, phs_a1_d0, phs_a0_d1, phs_a1_d1,
62962306a36Sopenharmony_ci	    sin_2phi_1, cos_2phi_1,
63062306a36Sopenharmony_ci	    sin_2phi_2, cos_2phi_2;
63162306a36Sopenharmony_ci	s32 mag_tx, phs_tx, mag_rx, phs_rx;
63262306a36Sopenharmony_ci	s32 solved_eq[4], mag_corr_tx, phs_corr_tx, mag_corr_rx, phs_corr_rx,
63362306a36Sopenharmony_ci	    q_q_coff, q_i_coff;
63462306a36Sopenharmony_ci	const s32 res_scale = 1 << 15;
63562306a36Sopenharmony_ci	const s32 delpt_shift = 1 << 8;
63662306a36Sopenharmony_ci	s32 mag1, mag2;
63762306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
63862306a36Sopenharmony_ci
63962306a36Sopenharmony_ci	i2_m_q2_a0_d0 = iq_res[0] & 0xfff;
64062306a36Sopenharmony_ci	i2_p_q2_a0_d0 = (iq_res[0] >> 12) & 0xfff;
64162306a36Sopenharmony_ci	iq_corr_a0_d0 = ((iq_res[0] >> 24) & 0xff) + ((iq_res[1] & 0xf) << 8);
64262306a36Sopenharmony_ci
64362306a36Sopenharmony_ci	if (i2_m_q2_a0_d0 > 0x800)
64462306a36Sopenharmony_ci		i2_m_q2_a0_d0 = -((0xfff - i2_m_q2_a0_d0) + 1);
64562306a36Sopenharmony_ci
64662306a36Sopenharmony_ci	if (i2_p_q2_a0_d0 > 0x800)
64762306a36Sopenharmony_ci		i2_p_q2_a0_d0 = -((0xfff - i2_p_q2_a0_d0) + 1);
64862306a36Sopenharmony_ci
64962306a36Sopenharmony_ci	if (iq_corr_a0_d0 > 0x800)
65062306a36Sopenharmony_ci		iq_corr_a0_d0 = -((0xfff - iq_corr_a0_d0) + 1);
65162306a36Sopenharmony_ci
65262306a36Sopenharmony_ci	i2_m_q2_a0_d1 = (iq_res[1] >> 4) & 0xfff;
65362306a36Sopenharmony_ci	i2_p_q2_a0_d1 = (iq_res[2] & 0xfff);
65462306a36Sopenharmony_ci	iq_corr_a0_d1 = (iq_res[2] >> 12) & 0xfff;
65562306a36Sopenharmony_ci
65662306a36Sopenharmony_ci	if (i2_m_q2_a0_d1 > 0x800)
65762306a36Sopenharmony_ci		i2_m_q2_a0_d1 = -((0xfff - i2_m_q2_a0_d1) + 1);
65862306a36Sopenharmony_ci
65962306a36Sopenharmony_ci	if (iq_corr_a0_d1 > 0x800)
66062306a36Sopenharmony_ci		iq_corr_a0_d1 = -((0xfff - iq_corr_a0_d1) + 1);
66162306a36Sopenharmony_ci
66262306a36Sopenharmony_ci	i2_m_q2_a1_d0 = ((iq_res[2] >> 24) & 0xff) + ((iq_res[3] & 0xf) << 8);
66362306a36Sopenharmony_ci	i2_p_q2_a1_d0 = (iq_res[3] >> 4) & 0xfff;
66462306a36Sopenharmony_ci	iq_corr_a1_d0 = iq_res[4] & 0xfff;
66562306a36Sopenharmony_ci
66662306a36Sopenharmony_ci	if (i2_m_q2_a1_d0 > 0x800)
66762306a36Sopenharmony_ci		i2_m_q2_a1_d0 = -((0xfff - i2_m_q2_a1_d0) + 1);
66862306a36Sopenharmony_ci
66962306a36Sopenharmony_ci	if (i2_p_q2_a1_d0 > 0x800)
67062306a36Sopenharmony_ci		i2_p_q2_a1_d0 = -((0xfff - i2_p_q2_a1_d0) + 1);
67162306a36Sopenharmony_ci
67262306a36Sopenharmony_ci	if (iq_corr_a1_d0 > 0x800)
67362306a36Sopenharmony_ci		iq_corr_a1_d0 = -((0xfff - iq_corr_a1_d0) + 1);
67462306a36Sopenharmony_ci
67562306a36Sopenharmony_ci	i2_m_q2_a1_d1 = (iq_res[4] >> 12) & 0xfff;
67662306a36Sopenharmony_ci	i2_p_q2_a1_d1 = ((iq_res[4] >> 24) & 0xff) + ((iq_res[5] & 0xf) << 8);
67762306a36Sopenharmony_ci	iq_corr_a1_d1 = (iq_res[5] >> 4) & 0xfff;
67862306a36Sopenharmony_ci
67962306a36Sopenharmony_ci	if (i2_m_q2_a1_d1 > 0x800)
68062306a36Sopenharmony_ci		i2_m_q2_a1_d1 = -((0xfff - i2_m_q2_a1_d1) + 1);
68162306a36Sopenharmony_ci
68262306a36Sopenharmony_ci	if (i2_p_q2_a1_d1 > 0x800)
68362306a36Sopenharmony_ci		i2_p_q2_a1_d1 = -((0xfff - i2_p_q2_a1_d1) + 1);
68462306a36Sopenharmony_ci
68562306a36Sopenharmony_ci	if (iq_corr_a1_d1 > 0x800)
68662306a36Sopenharmony_ci		iq_corr_a1_d1 = -((0xfff - iq_corr_a1_d1) + 1);
68762306a36Sopenharmony_ci
68862306a36Sopenharmony_ci	if ((i2_p_q2_a0_d0 == 0) || (i2_p_q2_a0_d1 == 0) ||
68962306a36Sopenharmony_ci	    (i2_p_q2_a1_d0 == 0) || (i2_p_q2_a1_d1 == 0)) {
69062306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
69162306a36Sopenharmony_ci			"Divide by 0:\n"
69262306a36Sopenharmony_ci			"a0_d0=%d\n"
69362306a36Sopenharmony_ci			"a0_d1=%d\n"
69462306a36Sopenharmony_ci			"a2_d0=%d\n"
69562306a36Sopenharmony_ci			"a1_d1=%d\n",
69662306a36Sopenharmony_ci			i2_p_q2_a0_d0, i2_p_q2_a0_d1,
69762306a36Sopenharmony_ci			i2_p_q2_a1_d0, i2_p_q2_a1_d1);
69862306a36Sopenharmony_ci		return false;
69962306a36Sopenharmony_ci	}
70062306a36Sopenharmony_ci
70162306a36Sopenharmony_ci	if ((i2_p_q2_a0_d0 < 1024) || (i2_p_q2_a0_d0 > 2047) ||
70262306a36Sopenharmony_ci            (i2_p_q2_a1_d0 < 0) || (i2_p_q2_a1_d1 < 0) ||
70362306a36Sopenharmony_ci            (i2_p_q2_a0_d0 <= i2_m_q2_a0_d0) ||
70462306a36Sopenharmony_ci            (i2_p_q2_a0_d0 <= iq_corr_a0_d0) ||
70562306a36Sopenharmony_ci            (i2_p_q2_a0_d1 <= i2_m_q2_a0_d1) ||
70662306a36Sopenharmony_ci            (i2_p_q2_a0_d1 <= iq_corr_a0_d1) ||
70762306a36Sopenharmony_ci            (i2_p_q2_a1_d0 <= i2_m_q2_a1_d0) ||
70862306a36Sopenharmony_ci            (i2_p_q2_a1_d0 <= iq_corr_a1_d0) ||
70962306a36Sopenharmony_ci            (i2_p_q2_a1_d1 <= i2_m_q2_a1_d1) ||
71062306a36Sopenharmony_ci            (i2_p_q2_a1_d1 <= iq_corr_a1_d1)) {
71162306a36Sopenharmony_ci		return false;
71262306a36Sopenharmony_ci	}
71362306a36Sopenharmony_ci
71462306a36Sopenharmony_ci	mag_a0_d0 = (i2_m_q2_a0_d0 * res_scale) / i2_p_q2_a0_d0;
71562306a36Sopenharmony_ci	phs_a0_d0 = (iq_corr_a0_d0 * res_scale) / i2_p_q2_a0_d0;
71662306a36Sopenharmony_ci
71762306a36Sopenharmony_ci	mag_a0_d1 = (i2_m_q2_a0_d1 * res_scale) / i2_p_q2_a0_d1;
71862306a36Sopenharmony_ci	phs_a0_d1 = (iq_corr_a0_d1 * res_scale) / i2_p_q2_a0_d1;
71962306a36Sopenharmony_ci
72062306a36Sopenharmony_ci	mag_a1_d0 = (i2_m_q2_a1_d0 * res_scale) / i2_p_q2_a1_d0;
72162306a36Sopenharmony_ci	phs_a1_d0 = (iq_corr_a1_d0 * res_scale) / i2_p_q2_a1_d0;
72262306a36Sopenharmony_ci
72362306a36Sopenharmony_ci	mag_a1_d1 = (i2_m_q2_a1_d1 * res_scale) / i2_p_q2_a1_d1;
72462306a36Sopenharmony_ci	phs_a1_d1 = (iq_corr_a1_d1 * res_scale) / i2_p_q2_a1_d1;
72562306a36Sopenharmony_ci
72662306a36Sopenharmony_ci	/* w/o analog phase shift */
72762306a36Sopenharmony_ci	sin_2phi_1 = (((mag_a0_d0 - mag_a0_d1) * delpt_shift) / DELPT);
72862306a36Sopenharmony_ci	/* w/o analog phase shift */
72962306a36Sopenharmony_ci	cos_2phi_1 = (((phs_a0_d1 - phs_a0_d0) * delpt_shift) / DELPT);
73062306a36Sopenharmony_ci	/* w/  analog phase shift */
73162306a36Sopenharmony_ci	sin_2phi_2 = (((mag_a1_d0 - mag_a1_d1) * delpt_shift) / DELPT);
73262306a36Sopenharmony_ci	/* w/  analog phase shift */
73362306a36Sopenharmony_ci	cos_2phi_2 = (((phs_a1_d1 - phs_a1_d0) * delpt_shift) / DELPT);
73462306a36Sopenharmony_ci
73562306a36Sopenharmony_ci	/*
73662306a36Sopenharmony_ci	 * force sin^2 + cos^2 = 1;
73762306a36Sopenharmony_ci	 * find magnitude by approximation
73862306a36Sopenharmony_ci	 */
73962306a36Sopenharmony_ci	mag1 = ar9003_hw_find_mag_approx(ah, cos_2phi_1, sin_2phi_1);
74062306a36Sopenharmony_ci	mag2 = ar9003_hw_find_mag_approx(ah, cos_2phi_2, sin_2phi_2);
74162306a36Sopenharmony_ci
74262306a36Sopenharmony_ci	if ((mag1 == 0) || (mag2 == 0)) {
74362306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE, "Divide by 0: mag1=%d, mag2=%d\n",
74462306a36Sopenharmony_ci			mag1, mag2);
74562306a36Sopenharmony_ci		return false;
74662306a36Sopenharmony_ci	}
74762306a36Sopenharmony_ci
74862306a36Sopenharmony_ci	/* normalization sin and cos by mag */
74962306a36Sopenharmony_ci	sin_2phi_1 = (sin_2phi_1 * res_scale / mag1);
75062306a36Sopenharmony_ci	cos_2phi_1 = (cos_2phi_1 * res_scale / mag1);
75162306a36Sopenharmony_ci	sin_2phi_2 = (sin_2phi_2 * res_scale / mag2);
75262306a36Sopenharmony_ci	cos_2phi_2 = (cos_2phi_2 * res_scale / mag2);
75362306a36Sopenharmony_ci
75462306a36Sopenharmony_ci	/* calculate IQ mismatch */
75562306a36Sopenharmony_ci	if (!ar9003_hw_solve_iq_cal(ah,
75662306a36Sopenharmony_ci			     sin_2phi_1, cos_2phi_1,
75762306a36Sopenharmony_ci			     sin_2phi_2, cos_2phi_2,
75862306a36Sopenharmony_ci			     mag_a0_d0, phs_a0_d0,
75962306a36Sopenharmony_ci			     mag_a1_d0,
76062306a36Sopenharmony_ci			     phs_a1_d0, solved_eq)) {
76162306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
76262306a36Sopenharmony_ci			"Call to ar9003_hw_solve_iq_cal() failed\n");
76362306a36Sopenharmony_ci		return false;
76462306a36Sopenharmony_ci	}
76562306a36Sopenharmony_ci
76662306a36Sopenharmony_ci	mag_tx = solved_eq[0];
76762306a36Sopenharmony_ci	phs_tx = solved_eq[1];
76862306a36Sopenharmony_ci	mag_rx = solved_eq[2];
76962306a36Sopenharmony_ci	phs_rx = solved_eq[3];
77062306a36Sopenharmony_ci
77162306a36Sopenharmony_ci	ath_dbg(common, CALIBRATE,
77262306a36Sopenharmony_ci		"chain %d: mag mismatch=%d phase mismatch=%d\n",
77362306a36Sopenharmony_ci		chain_idx, mag_tx/res_scale, phs_tx/res_scale);
77462306a36Sopenharmony_ci
77562306a36Sopenharmony_ci	if (res_scale == mag_tx) {
77662306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
77762306a36Sopenharmony_ci			"Divide by 0: mag_tx=%d, res_scale=%d\n",
77862306a36Sopenharmony_ci			mag_tx, res_scale);
77962306a36Sopenharmony_ci		return false;
78062306a36Sopenharmony_ci	}
78162306a36Sopenharmony_ci
78262306a36Sopenharmony_ci	/* calculate and quantize Tx IQ correction factor */
78362306a36Sopenharmony_ci	mag_corr_tx = (mag_tx * res_scale) / (res_scale - mag_tx);
78462306a36Sopenharmony_ci	phs_corr_tx = -phs_tx;
78562306a36Sopenharmony_ci
78662306a36Sopenharmony_ci	q_q_coff = (mag_corr_tx * 128 / res_scale);
78762306a36Sopenharmony_ci	q_i_coff = (phs_corr_tx * 256 / res_scale);
78862306a36Sopenharmony_ci
78962306a36Sopenharmony_ci	ath_dbg(common, CALIBRATE, "tx chain %d: mag corr=%d  phase corr=%d\n",
79062306a36Sopenharmony_ci		chain_idx, q_q_coff, q_i_coff);
79162306a36Sopenharmony_ci
79262306a36Sopenharmony_ci	if (q_i_coff < -63)
79362306a36Sopenharmony_ci		q_i_coff = -63;
79462306a36Sopenharmony_ci	if (q_i_coff > 63)
79562306a36Sopenharmony_ci		q_i_coff = 63;
79662306a36Sopenharmony_ci	if (q_q_coff < -63)
79762306a36Sopenharmony_ci		q_q_coff = -63;
79862306a36Sopenharmony_ci	if (q_q_coff > 63)
79962306a36Sopenharmony_ci		q_q_coff = 63;
80062306a36Sopenharmony_ci
80162306a36Sopenharmony_ci	iqc_coeff[0] = (q_q_coff * 128) + (0x7f & q_i_coff);
80262306a36Sopenharmony_ci
80362306a36Sopenharmony_ci	ath_dbg(common, CALIBRATE, "tx chain %d: iq corr coeff=%x\n",
80462306a36Sopenharmony_ci		chain_idx, iqc_coeff[0]);
80562306a36Sopenharmony_ci
80662306a36Sopenharmony_ci	if (-mag_rx == res_scale) {
80762306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
80862306a36Sopenharmony_ci			"Divide by 0: mag_rx=%d, res_scale=%d\n",
80962306a36Sopenharmony_ci			mag_rx, res_scale);
81062306a36Sopenharmony_ci		return false;
81162306a36Sopenharmony_ci	}
81262306a36Sopenharmony_ci
81362306a36Sopenharmony_ci	/* calculate and quantize Rx IQ correction factors */
81462306a36Sopenharmony_ci	mag_corr_rx = (-mag_rx * res_scale) / (res_scale + mag_rx);
81562306a36Sopenharmony_ci	phs_corr_rx = -phs_rx;
81662306a36Sopenharmony_ci
81762306a36Sopenharmony_ci	q_q_coff = (mag_corr_rx * 128 / res_scale);
81862306a36Sopenharmony_ci	q_i_coff = (phs_corr_rx * 256 / res_scale);
81962306a36Sopenharmony_ci
82062306a36Sopenharmony_ci	ath_dbg(common, CALIBRATE, "rx chain %d: mag corr=%d  phase corr=%d\n",
82162306a36Sopenharmony_ci		chain_idx, q_q_coff, q_i_coff);
82262306a36Sopenharmony_ci
82362306a36Sopenharmony_ci	if (q_i_coff < -63)
82462306a36Sopenharmony_ci		q_i_coff = -63;
82562306a36Sopenharmony_ci	if (q_i_coff > 63)
82662306a36Sopenharmony_ci		q_i_coff = 63;
82762306a36Sopenharmony_ci	if (q_q_coff < -63)
82862306a36Sopenharmony_ci		q_q_coff = -63;
82962306a36Sopenharmony_ci	if (q_q_coff > 63)
83062306a36Sopenharmony_ci		q_q_coff = 63;
83162306a36Sopenharmony_ci
83262306a36Sopenharmony_ci	iqc_coeff[1] = (q_q_coff * 128) + (0x7f & q_i_coff);
83362306a36Sopenharmony_ci
83462306a36Sopenharmony_ci	ath_dbg(common, CALIBRATE, "rx chain %d: iq corr coeff=%x\n",
83562306a36Sopenharmony_ci		chain_idx, iqc_coeff[1]);
83662306a36Sopenharmony_ci
83762306a36Sopenharmony_ci	return true;
83862306a36Sopenharmony_ci}
83962306a36Sopenharmony_ci
84062306a36Sopenharmony_cistatic void ar9003_hw_detect_outlier(int mp_coeff[][MAXIQCAL],
84162306a36Sopenharmony_ci				     int nmeasurement,
84262306a36Sopenharmony_ci				     int max_delta)
84362306a36Sopenharmony_ci{
84462306a36Sopenharmony_ci	int mp_max = -64, max_idx = 0;
84562306a36Sopenharmony_ci	int mp_min = 63, min_idx = 0;
84662306a36Sopenharmony_ci	int mp_avg = 0, i, outlier_idx = 0, mp_count = 0;
84762306a36Sopenharmony_ci
84862306a36Sopenharmony_ci	/* find min/max mismatch across all calibrated gains */
84962306a36Sopenharmony_ci	for (i = 0; i < nmeasurement; i++) {
85062306a36Sopenharmony_ci		if (mp_coeff[i][0] > mp_max) {
85162306a36Sopenharmony_ci			mp_max = mp_coeff[i][0];
85262306a36Sopenharmony_ci			max_idx = i;
85362306a36Sopenharmony_ci		} else if (mp_coeff[i][0] < mp_min) {
85462306a36Sopenharmony_ci			mp_min = mp_coeff[i][0];
85562306a36Sopenharmony_ci			min_idx = i;
85662306a36Sopenharmony_ci		}
85762306a36Sopenharmony_ci	}
85862306a36Sopenharmony_ci
85962306a36Sopenharmony_ci	/* find average (exclude max abs value) */
86062306a36Sopenharmony_ci	for (i = 0; i < nmeasurement; i++) {
86162306a36Sopenharmony_ci		if ((abs(mp_coeff[i][0]) < abs(mp_max)) ||
86262306a36Sopenharmony_ci		    (abs(mp_coeff[i][0]) < abs(mp_min))) {
86362306a36Sopenharmony_ci			mp_avg += mp_coeff[i][0];
86462306a36Sopenharmony_ci			mp_count++;
86562306a36Sopenharmony_ci		}
86662306a36Sopenharmony_ci	}
86762306a36Sopenharmony_ci
86862306a36Sopenharmony_ci	/*
86962306a36Sopenharmony_ci	 * finding mean magnitude/phase if possible, otherwise
87062306a36Sopenharmony_ci	 * just use the last value as the mean
87162306a36Sopenharmony_ci	 */
87262306a36Sopenharmony_ci	if (mp_count)
87362306a36Sopenharmony_ci		mp_avg /= mp_count;
87462306a36Sopenharmony_ci	else
87562306a36Sopenharmony_ci		mp_avg = mp_coeff[nmeasurement - 1][0];
87662306a36Sopenharmony_ci
87762306a36Sopenharmony_ci	/* detect outlier */
87862306a36Sopenharmony_ci	if (abs(mp_max - mp_min) > max_delta) {
87962306a36Sopenharmony_ci		if (abs(mp_max - mp_avg) > abs(mp_min - mp_avg))
88062306a36Sopenharmony_ci			outlier_idx = max_idx;
88162306a36Sopenharmony_ci		else
88262306a36Sopenharmony_ci			outlier_idx = min_idx;
88362306a36Sopenharmony_ci
88462306a36Sopenharmony_ci		mp_coeff[outlier_idx][0] = mp_avg;
88562306a36Sopenharmony_ci	}
88662306a36Sopenharmony_ci}
88762306a36Sopenharmony_ci
88862306a36Sopenharmony_cistatic void ar9003_hw_tx_iq_cal_outlier_detection(struct ath_hw *ah,
88962306a36Sopenharmony_ci						  struct coeff *coeff,
89062306a36Sopenharmony_ci						  bool is_reusable)
89162306a36Sopenharmony_ci{
89262306a36Sopenharmony_ci	int i, im, nmeasurement;
89362306a36Sopenharmony_ci	int magnitude, phase;
89462306a36Sopenharmony_ci	u32 tx_corr_coeff[MAX_MEASUREMENT][AR9300_MAX_CHAINS];
89562306a36Sopenharmony_ci	struct ath9k_hw_cal_data *caldata = ah->caldata;
89662306a36Sopenharmony_ci
89762306a36Sopenharmony_ci	memset(tx_corr_coeff, 0, sizeof(tx_corr_coeff));
89862306a36Sopenharmony_ci	for (i = 0; i < MAX_MEASUREMENT / 2; i++) {
89962306a36Sopenharmony_ci		tx_corr_coeff[i * 2][0] = tx_corr_coeff[(i * 2) + 1][0] =
90062306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_B0(ah, i);
90162306a36Sopenharmony_ci		if (!AR_SREV_9485(ah)) {
90262306a36Sopenharmony_ci			tx_corr_coeff[i * 2][1] =
90362306a36Sopenharmony_ci			tx_corr_coeff[(i * 2) + 1][1] =
90462306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_B1(i);
90562306a36Sopenharmony_ci
90662306a36Sopenharmony_ci			tx_corr_coeff[i * 2][2] =
90762306a36Sopenharmony_ci			tx_corr_coeff[(i * 2) + 1][2] =
90862306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_B2(i);
90962306a36Sopenharmony_ci		}
91062306a36Sopenharmony_ci	}
91162306a36Sopenharmony_ci
91262306a36Sopenharmony_ci	/* Load the average of 2 passes */
91362306a36Sopenharmony_ci	for (i = 0; i < AR9300_MAX_CHAINS; i++) {
91462306a36Sopenharmony_ci		if (!(ah->txchainmask & (1 << i)))
91562306a36Sopenharmony_ci			continue;
91662306a36Sopenharmony_ci		nmeasurement = REG_READ_FIELD(ah,
91762306a36Sopenharmony_ci				AR_PHY_TX_IQCAL_STATUS_B0(ah),
91862306a36Sopenharmony_ci				AR_PHY_CALIBRATED_GAINS_0);
91962306a36Sopenharmony_ci
92062306a36Sopenharmony_ci		if (nmeasurement > MAX_MEASUREMENT)
92162306a36Sopenharmony_ci			nmeasurement = MAX_MEASUREMENT;
92262306a36Sopenharmony_ci
92362306a36Sopenharmony_ci		/*
92462306a36Sopenharmony_ci		 * Skip normal outlier detection for AR9550.
92562306a36Sopenharmony_ci		 */
92662306a36Sopenharmony_ci		if (!AR_SREV_9550(ah)) {
92762306a36Sopenharmony_ci			/* detect outlier only if nmeasurement > 1 */
92862306a36Sopenharmony_ci			if (nmeasurement > 1) {
92962306a36Sopenharmony_ci				/* Detect magnitude outlier */
93062306a36Sopenharmony_ci				ar9003_hw_detect_outlier(coeff->mag_coeff[i],
93162306a36Sopenharmony_ci							 nmeasurement,
93262306a36Sopenharmony_ci							 MAX_MAG_DELTA);
93362306a36Sopenharmony_ci
93462306a36Sopenharmony_ci				/* Detect phase outlier */
93562306a36Sopenharmony_ci				ar9003_hw_detect_outlier(coeff->phs_coeff[i],
93662306a36Sopenharmony_ci							 nmeasurement,
93762306a36Sopenharmony_ci							 MAX_PHS_DELTA);
93862306a36Sopenharmony_ci			}
93962306a36Sopenharmony_ci		}
94062306a36Sopenharmony_ci
94162306a36Sopenharmony_ci		for (im = 0; im < nmeasurement; im++) {
94262306a36Sopenharmony_ci			magnitude = coeff->mag_coeff[i][im][0];
94362306a36Sopenharmony_ci			phase = coeff->phs_coeff[i][im][0];
94462306a36Sopenharmony_ci
94562306a36Sopenharmony_ci			coeff->iqc_coeff[0] =
94662306a36Sopenharmony_ci				(phase & 0x7f) | ((magnitude & 0x7f) << 7);
94762306a36Sopenharmony_ci
94862306a36Sopenharmony_ci			if ((im % 2) == 0)
94962306a36Sopenharmony_ci				REG_RMW_FIELD(ah, tx_corr_coeff[im][i],
95062306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_00_COEFF_TABLE,
95162306a36Sopenharmony_ci					coeff->iqc_coeff[0]);
95262306a36Sopenharmony_ci			else
95362306a36Sopenharmony_ci				REG_RMW_FIELD(ah, tx_corr_coeff[im][i],
95462306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_01_COEFF_TABLE,
95562306a36Sopenharmony_ci					coeff->iqc_coeff[0]);
95662306a36Sopenharmony_ci
95762306a36Sopenharmony_ci			if (caldata)
95862306a36Sopenharmony_ci				caldata->tx_corr_coeff[im][i] =
95962306a36Sopenharmony_ci					coeff->iqc_coeff[0];
96062306a36Sopenharmony_ci		}
96162306a36Sopenharmony_ci		if (caldata)
96262306a36Sopenharmony_ci			caldata->num_measures[i] = nmeasurement;
96362306a36Sopenharmony_ci	}
96462306a36Sopenharmony_ci
96562306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_TX_IQCAL_CONTROL_3,
96662306a36Sopenharmony_ci		      AR_PHY_TX_IQCAL_CONTROL_3_IQCORR_EN, 0x1);
96762306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_RX_IQCAL_CORR_B0,
96862306a36Sopenharmony_ci		      AR_PHY_RX_IQCAL_CORR_B0_LOOPBACK_IQCORR_EN, 0x1);
96962306a36Sopenharmony_ci
97062306a36Sopenharmony_ci	if (caldata) {
97162306a36Sopenharmony_ci		if (is_reusable)
97262306a36Sopenharmony_ci			set_bit(TXIQCAL_DONE, &caldata->cal_flags);
97362306a36Sopenharmony_ci		else
97462306a36Sopenharmony_ci			clear_bit(TXIQCAL_DONE, &caldata->cal_flags);
97562306a36Sopenharmony_ci	}
97662306a36Sopenharmony_ci
97762306a36Sopenharmony_ci	return;
97862306a36Sopenharmony_ci}
97962306a36Sopenharmony_ci
98062306a36Sopenharmony_cistatic bool ar9003_hw_tx_iq_cal_run(struct ath_hw *ah)
98162306a36Sopenharmony_ci{
98262306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
98362306a36Sopenharmony_ci	u8 tx_gain_forced;
98462306a36Sopenharmony_ci
98562306a36Sopenharmony_ci	tx_gain_forced = REG_READ_FIELD(ah, AR_PHY_TX_FORCED_GAIN,
98662306a36Sopenharmony_ci					AR_PHY_TXGAIN_FORCE);
98762306a36Sopenharmony_ci	if (tx_gain_forced)
98862306a36Sopenharmony_ci		REG_RMW_FIELD(ah, AR_PHY_TX_FORCED_GAIN,
98962306a36Sopenharmony_ci			      AR_PHY_TXGAIN_FORCE, 0);
99062306a36Sopenharmony_ci
99162306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_TX_IQCAL_START(ah),
99262306a36Sopenharmony_ci		      AR_PHY_TX_IQCAL_START_DO_CAL, 1);
99362306a36Sopenharmony_ci
99462306a36Sopenharmony_ci	if (!ath9k_hw_wait(ah, AR_PHY_TX_IQCAL_START(ah),
99562306a36Sopenharmony_ci			AR_PHY_TX_IQCAL_START_DO_CAL, 0,
99662306a36Sopenharmony_ci			AH_WAIT_TIMEOUT)) {
99762306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE, "Tx IQ Cal is not completed\n");
99862306a36Sopenharmony_ci		return false;
99962306a36Sopenharmony_ci	}
100062306a36Sopenharmony_ci	return true;
100162306a36Sopenharmony_ci}
100262306a36Sopenharmony_ci
100362306a36Sopenharmony_cistatic void __ar955x_tx_iq_cal_sort(struct ath_hw *ah,
100462306a36Sopenharmony_ci				    struct coeff *coeff,
100562306a36Sopenharmony_ci				    int i, int nmeasurement)
100662306a36Sopenharmony_ci{
100762306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
100862306a36Sopenharmony_ci	int im, ix, iy;
100962306a36Sopenharmony_ci
101062306a36Sopenharmony_ci	for (im = 0; im < nmeasurement; im++) {
101162306a36Sopenharmony_ci		for (ix = 0; ix < MAXIQCAL - 1; ix++) {
101262306a36Sopenharmony_ci			for (iy = ix + 1; iy <= MAXIQCAL - 1; iy++) {
101362306a36Sopenharmony_ci				if (coeff->mag_coeff[i][im][iy] <
101462306a36Sopenharmony_ci				    coeff->mag_coeff[i][im][ix]) {
101562306a36Sopenharmony_ci					swap(coeff->mag_coeff[i][im][ix],
101662306a36Sopenharmony_ci					     coeff->mag_coeff[i][im][iy]);
101762306a36Sopenharmony_ci				}
101862306a36Sopenharmony_ci				if (coeff->phs_coeff[i][im][iy] <
101962306a36Sopenharmony_ci				    coeff->phs_coeff[i][im][ix]) {
102062306a36Sopenharmony_ci					swap(coeff->phs_coeff[i][im][ix],
102162306a36Sopenharmony_ci					     coeff->phs_coeff[i][im][iy]);
102262306a36Sopenharmony_ci				}
102362306a36Sopenharmony_ci			}
102462306a36Sopenharmony_ci		}
102562306a36Sopenharmony_ci		coeff->mag_coeff[i][im][0] = coeff->mag_coeff[i][im][MAXIQCAL / 2];
102662306a36Sopenharmony_ci		coeff->phs_coeff[i][im][0] = coeff->phs_coeff[i][im][MAXIQCAL / 2];
102762306a36Sopenharmony_ci
102862306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
102962306a36Sopenharmony_ci			"IQCAL: Median [ch%d][gain%d]: mag = %d phase = %d\n",
103062306a36Sopenharmony_ci			i, im,
103162306a36Sopenharmony_ci			coeff->mag_coeff[i][im][0],
103262306a36Sopenharmony_ci			coeff->phs_coeff[i][im][0]);
103362306a36Sopenharmony_ci	}
103462306a36Sopenharmony_ci}
103562306a36Sopenharmony_ci
103662306a36Sopenharmony_cistatic bool ar955x_tx_iq_cal_median(struct ath_hw *ah,
103762306a36Sopenharmony_ci				    struct coeff *coeff,
103862306a36Sopenharmony_ci				    int iqcal_idx,
103962306a36Sopenharmony_ci				    int nmeasurement)
104062306a36Sopenharmony_ci{
104162306a36Sopenharmony_ci	int i;
104262306a36Sopenharmony_ci
104362306a36Sopenharmony_ci	if ((iqcal_idx + 1) != MAXIQCAL)
104462306a36Sopenharmony_ci		return false;
104562306a36Sopenharmony_ci
104662306a36Sopenharmony_ci	for (i = 0; i < AR9300_MAX_CHAINS; i++) {
104762306a36Sopenharmony_ci		__ar955x_tx_iq_cal_sort(ah, coeff, i, nmeasurement);
104862306a36Sopenharmony_ci	}
104962306a36Sopenharmony_ci
105062306a36Sopenharmony_ci	return true;
105162306a36Sopenharmony_ci}
105262306a36Sopenharmony_ci
105362306a36Sopenharmony_cistatic void ar9003_hw_tx_iq_cal_post_proc(struct ath_hw *ah,
105462306a36Sopenharmony_ci					  int iqcal_idx,
105562306a36Sopenharmony_ci					  bool is_reusable)
105662306a36Sopenharmony_ci{
105762306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
105862306a36Sopenharmony_ci	const u32 txiqcal_status[AR9300_MAX_CHAINS] = {
105962306a36Sopenharmony_ci		AR_PHY_TX_IQCAL_STATUS_B0(ah),
106062306a36Sopenharmony_ci		AR_PHY_TX_IQCAL_STATUS_B1,
106162306a36Sopenharmony_ci		AR_PHY_TX_IQCAL_STATUS_B2,
106262306a36Sopenharmony_ci	};
106362306a36Sopenharmony_ci	const u_int32_t chan_info_tab[] = {
106462306a36Sopenharmony_ci		AR_PHY_CHAN_INFO_TAB_0,
106562306a36Sopenharmony_ci		AR_PHY_CHAN_INFO_TAB_1,
106662306a36Sopenharmony_ci		AR_PHY_CHAN_INFO_TAB_2,
106762306a36Sopenharmony_ci	};
106862306a36Sopenharmony_ci	static struct coeff coeff;
106962306a36Sopenharmony_ci	s32 iq_res[6];
107062306a36Sopenharmony_ci	int i, im, j;
107162306a36Sopenharmony_ci	int nmeasurement = 0;
107262306a36Sopenharmony_ci	bool outlier_detect = true;
107362306a36Sopenharmony_ci
107462306a36Sopenharmony_ci	for (i = 0; i < AR9300_MAX_CHAINS; i++) {
107562306a36Sopenharmony_ci		if (!(ah->txchainmask & (1 << i)))
107662306a36Sopenharmony_ci			continue;
107762306a36Sopenharmony_ci
107862306a36Sopenharmony_ci		nmeasurement = REG_READ_FIELD(ah,
107962306a36Sopenharmony_ci				AR_PHY_TX_IQCAL_STATUS_B0(ah),
108062306a36Sopenharmony_ci				AR_PHY_CALIBRATED_GAINS_0);
108162306a36Sopenharmony_ci		if (nmeasurement > MAX_MEASUREMENT)
108262306a36Sopenharmony_ci			nmeasurement = MAX_MEASUREMENT;
108362306a36Sopenharmony_ci
108462306a36Sopenharmony_ci		for (im = 0; im < nmeasurement; im++) {
108562306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE,
108662306a36Sopenharmony_ci				"Doing Tx IQ Cal for chain %d\n", i);
108762306a36Sopenharmony_ci
108862306a36Sopenharmony_ci			if (REG_READ(ah, txiqcal_status[i]) &
108962306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_STATUS_FAILED) {
109062306a36Sopenharmony_ci				ath_dbg(common, CALIBRATE,
109162306a36Sopenharmony_ci					"Tx IQ Cal failed for chain %d\n", i);
109262306a36Sopenharmony_ci				goto tx_iqcal_fail;
109362306a36Sopenharmony_ci			}
109462306a36Sopenharmony_ci
109562306a36Sopenharmony_ci			for (j = 0; j < 3; j++) {
109662306a36Sopenharmony_ci				u32 idx = 2 * j, offset = 4 * (3 * im + j);
109762306a36Sopenharmony_ci
109862306a36Sopenharmony_ci				REG_RMW_FIELD(ah,
109962306a36Sopenharmony_ci						AR_PHY_CHAN_INFO_MEMORY(ah),
110062306a36Sopenharmony_ci						AR_PHY_CHAN_INFO_TAB_S2_READ,
110162306a36Sopenharmony_ci						0);
110262306a36Sopenharmony_ci
110362306a36Sopenharmony_ci				/* 32 bits */
110462306a36Sopenharmony_ci				iq_res[idx] = REG_READ(ah,
110562306a36Sopenharmony_ci						chan_info_tab[i] +
110662306a36Sopenharmony_ci						offset);
110762306a36Sopenharmony_ci
110862306a36Sopenharmony_ci				REG_RMW_FIELD(ah,
110962306a36Sopenharmony_ci						AR_PHY_CHAN_INFO_MEMORY(ah),
111062306a36Sopenharmony_ci						AR_PHY_CHAN_INFO_TAB_S2_READ,
111162306a36Sopenharmony_ci						1);
111262306a36Sopenharmony_ci
111362306a36Sopenharmony_ci				/* 16 bits */
111462306a36Sopenharmony_ci				iq_res[idx + 1] = 0xffff & REG_READ(ah,
111562306a36Sopenharmony_ci						chan_info_tab[i] + offset);
111662306a36Sopenharmony_ci
111762306a36Sopenharmony_ci				ath_dbg(common, CALIBRATE,
111862306a36Sopenharmony_ci					"IQ_RES[%d]=0x%x IQ_RES[%d]=0x%x\n",
111962306a36Sopenharmony_ci					idx, iq_res[idx], idx + 1,
112062306a36Sopenharmony_ci					iq_res[idx + 1]);
112162306a36Sopenharmony_ci			}
112262306a36Sopenharmony_ci
112362306a36Sopenharmony_ci			if (!ar9003_hw_calc_iq_corr(ah, i, iq_res,
112462306a36Sopenharmony_ci						coeff.iqc_coeff)) {
112562306a36Sopenharmony_ci				ath_dbg(common, CALIBRATE,
112662306a36Sopenharmony_ci					"Failed in calculation of IQ correction\n");
112762306a36Sopenharmony_ci				goto tx_iqcal_fail;
112862306a36Sopenharmony_ci			}
112962306a36Sopenharmony_ci
113062306a36Sopenharmony_ci			coeff.phs_coeff[i][im][iqcal_idx] =
113162306a36Sopenharmony_ci				coeff.iqc_coeff[0] & 0x7f;
113262306a36Sopenharmony_ci			coeff.mag_coeff[i][im][iqcal_idx] =
113362306a36Sopenharmony_ci				(coeff.iqc_coeff[0] >> 7) & 0x7f;
113462306a36Sopenharmony_ci
113562306a36Sopenharmony_ci			if (coeff.mag_coeff[i][im][iqcal_idx] > 63)
113662306a36Sopenharmony_ci				coeff.mag_coeff[i][im][iqcal_idx] -= 128;
113762306a36Sopenharmony_ci			if (coeff.phs_coeff[i][im][iqcal_idx] > 63)
113862306a36Sopenharmony_ci				coeff.phs_coeff[i][im][iqcal_idx] -= 128;
113962306a36Sopenharmony_ci		}
114062306a36Sopenharmony_ci	}
114162306a36Sopenharmony_ci
114262306a36Sopenharmony_ci	if (AR_SREV_9550(ah))
114362306a36Sopenharmony_ci		outlier_detect = ar955x_tx_iq_cal_median(ah, &coeff,
114462306a36Sopenharmony_ci							 iqcal_idx, nmeasurement);
114562306a36Sopenharmony_ci	if (outlier_detect)
114662306a36Sopenharmony_ci		ar9003_hw_tx_iq_cal_outlier_detection(ah, &coeff, is_reusable);
114762306a36Sopenharmony_ci
114862306a36Sopenharmony_ci	return;
114962306a36Sopenharmony_ci
115062306a36Sopenharmony_citx_iqcal_fail:
115162306a36Sopenharmony_ci	ath_dbg(common, CALIBRATE, "Tx IQ Cal failed\n");
115262306a36Sopenharmony_ci	return;
115362306a36Sopenharmony_ci}
115462306a36Sopenharmony_ci
115562306a36Sopenharmony_cistatic void ar9003_hw_tx_iq_cal_reload(struct ath_hw *ah)
115662306a36Sopenharmony_ci{
115762306a36Sopenharmony_ci	struct ath9k_hw_cal_data *caldata = ah->caldata;
115862306a36Sopenharmony_ci	u32 tx_corr_coeff[MAX_MEASUREMENT][AR9300_MAX_CHAINS];
115962306a36Sopenharmony_ci	int i, im;
116062306a36Sopenharmony_ci
116162306a36Sopenharmony_ci	memset(tx_corr_coeff, 0, sizeof(tx_corr_coeff));
116262306a36Sopenharmony_ci	for (i = 0; i < MAX_MEASUREMENT / 2; i++) {
116362306a36Sopenharmony_ci		tx_corr_coeff[i * 2][0] = tx_corr_coeff[(i * 2) + 1][0] =
116462306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_B0(ah, i);
116562306a36Sopenharmony_ci		if (!AR_SREV_9485(ah)) {
116662306a36Sopenharmony_ci			tx_corr_coeff[i * 2][1] =
116762306a36Sopenharmony_ci			tx_corr_coeff[(i * 2) + 1][1] =
116862306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_B1(i);
116962306a36Sopenharmony_ci
117062306a36Sopenharmony_ci			tx_corr_coeff[i * 2][2] =
117162306a36Sopenharmony_ci			tx_corr_coeff[(i * 2) + 1][2] =
117262306a36Sopenharmony_ci					AR_PHY_TX_IQCAL_CORR_COEFF_B2(i);
117362306a36Sopenharmony_ci		}
117462306a36Sopenharmony_ci	}
117562306a36Sopenharmony_ci
117662306a36Sopenharmony_ci	for (i = 0; i < AR9300_MAX_CHAINS; i++) {
117762306a36Sopenharmony_ci		if (!(ah->txchainmask & (1 << i)))
117862306a36Sopenharmony_ci			continue;
117962306a36Sopenharmony_ci
118062306a36Sopenharmony_ci		for (im = 0; im < caldata->num_measures[i]; im++) {
118162306a36Sopenharmony_ci			if ((im % 2) == 0)
118262306a36Sopenharmony_ci				REG_RMW_FIELD(ah, tx_corr_coeff[im][i],
118362306a36Sopenharmony_ci				     AR_PHY_TX_IQCAL_CORR_COEFF_00_COEFF_TABLE,
118462306a36Sopenharmony_ci				     caldata->tx_corr_coeff[im][i]);
118562306a36Sopenharmony_ci			else
118662306a36Sopenharmony_ci				REG_RMW_FIELD(ah, tx_corr_coeff[im][i],
118762306a36Sopenharmony_ci				     AR_PHY_TX_IQCAL_CORR_COEFF_01_COEFF_TABLE,
118862306a36Sopenharmony_ci				     caldata->tx_corr_coeff[im][i]);
118962306a36Sopenharmony_ci		}
119062306a36Sopenharmony_ci	}
119162306a36Sopenharmony_ci
119262306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_TX_IQCAL_CONTROL_3,
119362306a36Sopenharmony_ci		      AR_PHY_TX_IQCAL_CONTROL_3_IQCORR_EN, 0x1);
119462306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_RX_IQCAL_CORR_B0,
119562306a36Sopenharmony_ci		      AR_PHY_RX_IQCAL_CORR_B0_LOOPBACK_IQCORR_EN, 0x1);
119662306a36Sopenharmony_ci}
119762306a36Sopenharmony_ci
119862306a36Sopenharmony_cistatic void ar9003_hw_manual_peak_cal(struct ath_hw *ah, u8 chain, bool is_2g)
119962306a36Sopenharmony_ci{
120062306a36Sopenharmony_ci	int offset[8] = {0}, total = 0, test;
120162306a36Sopenharmony_ci	int agc_out, i, peak_detect_threshold = 0;
120262306a36Sopenharmony_ci
120362306a36Sopenharmony_ci	if (AR_SREV_9550(ah) || AR_SREV_9531(ah))
120462306a36Sopenharmony_ci		peak_detect_threshold = 8;
120562306a36Sopenharmony_ci	else if (AR_SREV_9561(ah))
120662306a36Sopenharmony_ci		peak_detect_threshold = 11;
120762306a36Sopenharmony_ci
120862306a36Sopenharmony_ci	/*
120962306a36Sopenharmony_ci	 * Turn off LNA/SW.
121062306a36Sopenharmony_ci	 */
121162306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_GAINSTAGES(chain),
121262306a36Sopenharmony_ci		      AR_PHY_65NM_RXRF_GAINSTAGES_RX_OVERRIDE, 0x1);
121362306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_GAINSTAGES(chain),
121462306a36Sopenharmony_ci		      AR_PHY_65NM_RXRF_GAINSTAGES_LNAON_CALDC, 0x0);
121562306a36Sopenharmony_ci
121662306a36Sopenharmony_ci	if (AR_SREV_9003_PCOEM(ah) || AR_SREV_9330_11(ah)) {
121762306a36Sopenharmony_ci		if (is_2g)
121862306a36Sopenharmony_ci			REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_GAINSTAGES(chain),
121962306a36Sopenharmony_ci				      AR_PHY_65NM_RXRF_GAINSTAGES_LNA2G_GAIN_OVR, 0x0);
122062306a36Sopenharmony_ci		else
122162306a36Sopenharmony_ci			REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_GAINSTAGES(chain),
122262306a36Sopenharmony_ci				      AR_PHY_65NM_RXRF_GAINSTAGES_LNA5G_GAIN_OVR, 0x0);
122362306a36Sopenharmony_ci	}
122462306a36Sopenharmony_ci
122562306a36Sopenharmony_ci	/*
122662306a36Sopenharmony_ci	 * Turn off RXON.
122762306a36Sopenharmony_ci	 */
122862306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXTX2(chain),
122962306a36Sopenharmony_ci		      AR_PHY_65NM_RXTX2_RXON_OVR, 0x1);
123062306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXTX2(chain),
123162306a36Sopenharmony_ci		      AR_PHY_65NM_RXTX2_RXON, 0x0);
123262306a36Sopenharmony_ci
123362306a36Sopenharmony_ci	/*
123462306a36Sopenharmony_ci	 * Turn on AGC for cal.
123562306a36Sopenharmony_ci	 */
123662306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
123762306a36Sopenharmony_ci		      AR_PHY_65NM_RXRF_AGC_AGC_OVERRIDE, 0x1);
123862306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
123962306a36Sopenharmony_ci		      AR_PHY_65NM_RXRF_AGC_AGC_ON_OVR, 0x1);
124062306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
124162306a36Sopenharmony_ci		      AR_PHY_65NM_RXRF_AGC_AGC_CAL_OVR, 0x1);
124262306a36Sopenharmony_ci
124362306a36Sopenharmony_ci	if (AR_SREV_9330_11(ah))
124462306a36Sopenharmony_ci		REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
124562306a36Sopenharmony_ci			      AR_PHY_65NM_RXRF_AGC_AGC2G_CALDAC_OVR, 0x0);
124662306a36Sopenharmony_ci
124762306a36Sopenharmony_ci	if (is_2g)
124862306a36Sopenharmony_ci		REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
124962306a36Sopenharmony_ci			      AR_PHY_65NM_RXRF_AGC_AGC2G_DBDAC_OVR,
125062306a36Sopenharmony_ci			      peak_detect_threshold);
125162306a36Sopenharmony_ci	else
125262306a36Sopenharmony_ci		REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
125362306a36Sopenharmony_ci			      AR_PHY_65NM_RXRF_AGC_AGC5G_DBDAC_OVR,
125462306a36Sopenharmony_ci			      peak_detect_threshold);
125562306a36Sopenharmony_ci
125662306a36Sopenharmony_ci	for (i = 6; i > 0; i--) {
125762306a36Sopenharmony_ci		offset[i] = BIT(i - 1);
125862306a36Sopenharmony_ci		test = total + offset[i];
125962306a36Sopenharmony_ci
126062306a36Sopenharmony_ci		if (is_2g)
126162306a36Sopenharmony_ci			REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
126262306a36Sopenharmony_ci				      AR_PHY_65NM_RXRF_AGC_AGC2G_CALDAC_OVR,
126362306a36Sopenharmony_ci				      test);
126462306a36Sopenharmony_ci		else
126562306a36Sopenharmony_ci			REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
126662306a36Sopenharmony_ci				      AR_PHY_65NM_RXRF_AGC_AGC5G_CALDAC_OVR,
126762306a36Sopenharmony_ci				      test);
126862306a36Sopenharmony_ci		udelay(100);
126962306a36Sopenharmony_ci		agc_out = REG_READ_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
127062306a36Sopenharmony_ci					 AR_PHY_65NM_RXRF_AGC_AGC_OUT);
127162306a36Sopenharmony_ci		offset[i] = (agc_out) ? 0 : 1;
127262306a36Sopenharmony_ci		total += (offset[i] << (i - 1));
127362306a36Sopenharmony_ci	}
127462306a36Sopenharmony_ci
127562306a36Sopenharmony_ci	if (is_2g)
127662306a36Sopenharmony_ci		REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
127762306a36Sopenharmony_ci			      AR_PHY_65NM_RXRF_AGC_AGC2G_CALDAC_OVR, total);
127862306a36Sopenharmony_ci	else
127962306a36Sopenharmony_ci		REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
128062306a36Sopenharmony_ci			      AR_PHY_65NM_RXRF_AGC_AGC5G_CALDAC_OVR, total);
128162306a36Sopenharmony_ci
128262306a36Sopenharmony_ci	/*
128362306a36Sopenharmony_ci	 * Turn on LNA.
128462306a36Sopenharmony_ci	 */
128562306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_GAINSTAGES(chain),
128662306a36Sopenharmony_ci		      AR_PHY_65NM_RXRF_GAINSTAGES_RX_OVERRIDE, 0);
128762306a36Sopenharmony_ci	/*
128862306a36Sopenharmony_ci	 * Turn off RXON.
128962306a36Sopenharmony_ci	 */
129062306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXTX2(chain),
129162306a36Sopenharmony_ci		      AR_PHY_65NM_RXTX2_RXON_OVR, 0);
129262306a36Sopenharmony_ci	/*
129362306a36Sopenharmony_ci	 * Turn off peak detect calibration.
129462306a36Sopenharmony_ci	 */
129562306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
129662306a36Sopenharmony_ci		      AR_PHY_65NM_RXRF_AGC_AGC_CAL_OVR, 0);
129762306a36Sopenharmony_ci}
129862306a36Sopenharmony_ci
129962306a36Sopenharmony_cistatic void ar9003_hw_do_pcoem_manual_peak_cal(struct ath_hw *ah,
130062306a36Sopenharmony_ci					       struct ath9k_channel *chan,
130162306a36Sopenharmony_ci					       bool run_rtt_cal)
130262306a36Sopenharmony_ci{
130362306a36Sopenharmony_ci	struct ath9k_hw_cal_data *caldata = ah->caldata;
130462306a36Sopenharmony_ci	int i;
130562306a36Sopenharmony_ci
130662306a36Sopenharmony_ci	if ((ah->caps.hw_caps & ATH9K_HW_CAP_RTT) && !run_rtt_cal)
130762306a36Sopenharmony_ci		return;
130862306a36Sopenharmony_ci
130962306a36Sopenharmony_ci	for (i = 0; i < AR9300_MAX_CHAINS; i++) {
131062306a36Sopenharmony_ci		if (!(ah->rxchainmask & (1 << i)))
131162306a36Sopenharmony_ci			continue;
131262306a36Sopenharmony_ci		ar9003_hw_manual_peak_cal(ah, i, IS_CHAN_2GHZ(chan));
131362306a36Sopenharmony_ci	}
131462306a36Sopenharmony_ci
131562306a36Sopenharmony_ci	if (caldata)
131662306a36Sopenharmony_ci		set_bit(SW_PKDET_DONE, &caldata->cal_flags);
131762306a36Sopenharmony_ci
131862306a36Sopenharmony_ci	if ((ah->caps.hw_caps & ATH9K_HW_CAP_RTT) && caldata) {
131962306a36Sopenharmony_ci		if (IS_CHAN_2GHZ(chan)){
132062306a36Sopenharmony_ci			caldata->caldac[0] = REG_READ_FIELD(ah,
132162306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC(0),
132262306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC_AGC2G_CALDAC_OVR);
132362306a36Sopenharmony_ci			caldata->caldac[1] = REG_READ_FIELD(ah,
132462306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC(1),
132562306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC_AGC2G_CALDAC_OVR);
132662306a36Sopenharmony_ci		} else {
132762306a36Sopenharmony_ci			caldata->caldac[0] = REG_READ_FIELD(ah,
132862306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC(0),
132962306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC_AGC5G_CALDAC_OVR);
133062306a36Sopenharmony_ci			caldata->caldac[1] = REG_READ_FIELD(ah,
133162306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC(1),
133262306a36Sopenharmony_ci						    AR_PHY_65NM_RXRF_AGC_AGC5G_CALDAC_OVR);
133362306a36Sopenharmony_ci		}
133462306a36Sopenharmony_ci	}
133562306a36Sopenharmony_ci}
133662306a36Sopenharmony_ci
133762306a36Sopenharmony_cistatic void ar9003_hw_cl_cal_post_proc(struct ath_hw *ah, bool is_reusable)
133862306a36Sopenharmony_ci{
133962306a36Sopenharmony_ci	u32 cl_idx[AR9300_MAX_CHAINS] = { AR_PHY_CL_TAB_0,
134062306a36Sopenharmony_ci					  AR_PHY_CL_TAB_1,
134162306a36Sopenharmony_ci					  AR_PHY_CL_TAB_2 };
134262306a36Sopenharmony_ci	struct ath9k_hw_cal_data *caldata = ah->caldata;
134362306a36Sopenharmony_ci	bool txclcal_done = false;
134462306a36Sopenharmony_ci	int i, j;
134562306a36Sopenharmony_ci
134662306a36Sopenharmony_ci	if (!caldata || !(ah->enabled_cals & TX_CL_CAL))
134762306a36Sopenharmony_ci		return;
134862306a36Sopenharmony_ci
134962306a36Sopenharmony_ci	txclcal_done = !!(REG_READ(ah, AR_PHY_AGC_CONTROL(ah)) &
135062306a36Sopenharmony_ci			  AR_PHY_AGC_CONTROL_CLC_SUCCESS);
135162306a36Sopenharmony_ci
135262306a36Sopenharmony_ci	if (test_bit(TXCLCAL_DONE, &caldata->cal_flags)) {
135362306a36Sopenharmony_ci		for (i = 0; i < AR9300_MAX_CHAINS; i++) {
135462306a36Sopenharmony_ci			if (!(ah->txchainmask & (1 << i)))
135562306a36Sopenharmony_ci				continue;
135662306a36Sopenharmony_ci			for (j = 0; j < MAX_CL_TAB_ENTRY; j++)
135762306a36Sopenharmony_ci				REG_WRITE(ah, CL_TAB_ENTRY(cl_idx[i]),
135862306a36Sopenharmony_ci					  caldata->tx_clcal[i][j]);
135962306a36Sopenharmony_ci		}
136062306a36Sopenharmony_ci	} else if (is_reusable && txclcal_done) {
136162306a36Sopenharmony_ci		for (i = 0; i < AR9300_MAX_CHAINS; i++) {
136262306a36Sopenharmony_ci			if (!(ah->txchainmask & (1 << i)))
136362306a36Sopenharmony_ci				continue;
136462306a36Sopenharmony_ci			for (j = 0; j < MAX_CL_TAB_ENTRY; j++)
136562306a36Sopenharmony_ci				caldata->tx_clcal[i][j] =
136662306a36Sopenharmony_ci					REG_READ(ah, CL_TAB_ENTRY(cl_idx[i]));
136762306a36Sopenharmony_ci		}
136862306a36Sopenharmony_ci		set_bit(TXCLCAL_DONE, &caldata->cal_flags);
136962306a36Sopenharmony_ci	}
137062306a36Sopenharmony_ci}
137162306a36Sopenharmony_ci
137262306a36Sopenharmony_cistatic void ar9003_hw_init_cal_common(struct ath_hw *ah)
137362306a36Sopenharmony_ci{
137462306a36Sopenharmony_ci	struct ath9k_hw_cal_data *caldata = ah->caldata;
137562306a36Sopenharmony_ci
137662306a36Sopenharmony_ci	/* Initialize list pointers */
137762306a36Sopenharmony_ci	ah->cal_list = ah->cal_list_last = ah->cal_list_curr = NULL;
137862306a36Sopenharmony_ci
137962306a36Sopenharmony_ci	INIT_CAL(&ah->iq_caldata);
138062306a36Sopenharmony_ci	INSERT_CAL(ah, &ah->iq_caldata);
138162306a36Sopenharmony_ci
138262306a36Sopenharmony_ci	/* Initialize current pointer to first element in list */
138362306a36Sopenharmony_ci	ah->cal_list_curr = ah->cal_list;
138462306a36Sopenharmony_ci
138562306a36Sopenharmony_ci	if (ah->cal_list_curr)
138662306a36Sopenharmony_ci		ath9k_hw_reset_calibration(ah, ah->cal_list_curr);
138762306a36Sopenharmony_ci
138862306a36Sopenharmony_ci	if (caldata)
138962306a36Sopenharmony_ci		caldata->CalValid = 0;
139062306a36Sopenharmony_ci}
139162306a36Sopenharmony_ci
139262306a36Sopenharmony_cistatic bool ar9003_hw_init_cal_pcoem(struct ath_hw *ah,
139362306a36Sopenharmony_ci				     struct ath9k_channel *chan)
139462306a36Sopenharmony_ci{
139562306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
139662306a36Sopenharmony_ci	struct ath9k_hw_cal_data *caldata = ah->caldata;
139762306a36Sopenharmony_ci	bool txiqcal_done = false;
139862306a36Sopenharmony_ci	bool is_reusable = true, status = true;
139962306a36Sopenharmony_ci	bool run_rtt_cal = false, run_agc_cal;
140062306a36Sopenharmony_ci	bool rtt = !!(ah->caps.hw_caps & ATH9K_HW_CAP_RTT);
140162306a36Sopenharmony_ci	u32 rx_delay = 0;
140262306a36Sopenharmony_ci	u32 agc_ctrl = 0, agc_supp_cals = AR_PHY_AGC_CONTROL_OFFSET_CAL |
140362306a36Sopenharmony_ci					  AR_PHY_AGC_CONTROL_FLTR_CAL   |
140462306a36Sopenharmony_ci					  AR_PHY_AGC_CONTROL_PKDET_CAL;
140562306a36Sopenharmony_ci
140662306a36Sopenharmony_ci	/* Use chip chainmask only for calibration */
140762306a36Sopenharmony_ci	ar9003_hw_set_chain_masks(ah, ah->caps.rx_chainmask, ah->caps.tx_chainmask);
140862306a36Sopenharmony_ci
140962306a36Sopenharmony_ci	if (rtt) {
141062306a36Sopenharmony_ci		if (!ar9003_hw_rtt_restore(ah, chan))
141162306a36Sopenharmony_ci			run_rtt_cal = true;
141262306a36Sopenharmony_ci
141362306a36Sopenharmony_ci		if (run_rtt_cal)
141462306a36Sopenharmony_ci			ath_dbg(common, CALIBRATE, "RTT calibration to be done\n");
141562306a36Sopenharmony_ci	}
141662306a36Sopenharmony_ci
141762306a36Sopenharmony_ci	run_agc_cal = run_rtt_cal;
141862306a36Sopenharmony_ci
141962306a36Sopenharmony_ci	if (run_rtt_cal) {
142062306a36Sopenharmony_ci		ar9003_hw_rtt_enable(ah);
142162306a36Sopenharmony_ci		ar9003_hw_rtt_set_mask(ah, 0x00);
142262306a36Sopenharmony_ci		ar9003_hw_rtt_clear_hist(ah);
142362306a36Sopenharmony_ci	}
142462306a36Sopenharmony_ci
142562306a36Sopenharmony_ci	if (rtt) {
142662306a36Sopenharmony_ci		if (!run_rtt_cal) {
142762306a36Sopenharmony_ci			agc_ctrl = REG_READ(ah, AR_PHY_AGC_CONTROL(ah));
142862306a36Sopenharmony_ci			agc_supp_cals &= agc_ctrl;
142962306a36Sopenharmony_ci			agc_ctrl &= ~(AR_PHY_AGC_CONTROL_OFFSET_CAL |
143062306a36Sopenharmony_ci				      AR_PHY_AGC_CONTROL_FLTR_CAL |
143162306a36Sopenharmony_ci				      AR_PHY_AGC_CONTROL_PKDET_CAL);
143262306a36Sopenharmony_ci			REG_WRITE(ah, AR_PHY_AGC_CONTROL(ah), agc_ctrl);
143362306a36Sopenharmony_ci		} else {
143462306a36Sopenharmony_ci			if (ah->ah_flags & AH_FASTCC)
143562306a36Sopenharmony_ci				run_agc_cal = true;
143662306a36Sopenharmony_ci		}
143762306a36Sopenharmony_ci	}
143862306a36Sopenharmony_ci
143962306a36Sopenharmony_ci	if (ah->enabled_cals & TX_CL_CAL) {
144062306a36Sopenharmony_ci		if (caldata && test_bit(TXCLCAL_DONE, &caldata->cal_flags))
144162306a36Sopenharmony_ci			REG_CLR_BIT(ah, AR_PHY_CL_CAL_CTL,
144262306a36Sopenharmony_ci				    AR_PHY_CL_CAL_ENABLE);
144362306a36Sopenharmony_ci		else {
144462306a36Sopenharmony_ci			REG_SET_BIT(ah, AR_PHY_CL_CAL_CTL,
144562306a36Sopenharmony_ci				    AR_PHY_CL_CAL_ENABLE);
144662306a36Sopenharmony_ci			run_agc_cal = true;
144762306a36Sopenharmony_ci		}
144862306a36Sopenharmony_ci	}
144962306a36Sopenharmony_ci
145062306a36Sopenharmony_ci	if ((IS_CHAN_HALF_RATE(chan) || IS_CHAN_QUARTER_RATE(chan)) ||
145162306a36Sopenharmony_ci	    !(ah->enabled_cals & TX_IQ_CAL))
145262306a36Sopenharmony_ci		goto skip_tx_iqcal;
145362306a36Sopenharmony_ci
145462306a36Sopenharmony_ci	/* Do Tx IQ Calibration */
145562306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_TX_IQCAL_CONTROL_1(ah),
145662306a36Sopenharmony_ci		      AR_PHY_TX_IQCAL_CONTROL_1_IQCORR_I_Q_COFF_DELPT,
145762306a36Sopenharmony_ci		      DELPT);
145862306a36Sopenharmony_ci
145962306a36Sopenharmony_ci	/*
146062306a36Sopenharmony_ci	 * For AR9485 or later chips, TxIQ cal runs as part of
146162306a36Sopenharmony_ci	 * AGC calibration
146262306a36Sopenharmony_ci	 */
146362306a36Sopenharmony_ci	if (ah->enabled_cals & TX_IQ_ON_AGC_CAL) {
146462306a36Sopenharmony_ci		if (caldata && !test_bit(TXIQCAL_DONE, &caldata->cal_flags))
146562306a36Sopenharmony_ci			REG_SET_BIT(ah, AR_PHY_TX_IQCAL_CONTROL_0(ah),
146662306a36Sopenharmony_ci				    AR_PHY_TX_IQCAL_CONTROL_0_ENABLE_TXIQ_CAL);
146762306a36Sopenharmony_ci		else
146862306a36Sopenharmony_ci			REG_CLR_BIT(ah, AR_PHY_TX_IQCAL_CONTROL_0(ah),
146962306a36Sopenharmony_ci				    AR_PHY_TX_IQCAL_CONTROL_0_ENABLE_TXIQ_CAL);
147062306a36Sopenharmony_ci		txiqcal_done = run_agc_cal = true;
147162306a36Sopenharmony_ci	}
147262306a36Sopenharmony_ci
147362306a36Sopenharmony_ciskip_tx_iqcal:
147462306a36Sopenharmony_ci	if (ath9k_hw_mci_is_enabled(ah) && IS_CHAN_2GHZ(chan) && run_agc_cal)
147562306a36Sopenharmony_ci		ar9003_mci_init_cal_req(ah, &is_reusable);
147662306a36Sopenharmony_ci
147762306a36Sopenharmony_ci	if (REG_READ(ah, AR_PHY_CL_CAL_CTL) & AR_PHY_CL_CAL_ENABLE) {
147862306a36Sopenharmony_ci		rx_delay = REG_READ(ah, AR_PHY_RX_DELAY);
147962306a36Sopenharmony_ci		/* Disable BB_active */
148062306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_DIS);
148162306a36Sopenharmony_ci		udelay(5);
148262306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_RX_DELAY, AR_PHY_RX_DELAY_DELAY);
148362306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
148462306a36Sopenharmony_ci	}
148562306a36Sopenharmony_ci
148662306a36Sopenharmony_ci	if (run_agc_cal || !(ah->ah_flags & AH_FASTCC)) {
148762306a36Sopenharmony_ci		/* Calibrate the AGC */
148862306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_AGC_CONTROL(ah),
148962306a36Sopenharmony_ci			  REG_READ(ah, AR_PHY_AGC_CONTROL(ah)) |
149062306a36Sopenharmony_ci			  AR_PHY_AGC_CONTROL_CAL);
149162306a36Sopenharmony_ci
149262306a36Sopenharmony_ci		/* Poll for offset calibration complete */
149362306a36Sopenharmony_ci		status = ath9k_hw_wait(ah, AR_PHY_AGC_CONTROL(ah),
149462306a36Sopenharmony_ci				       AR_PHY_AGC_CONTROL_CAL,
149562306a36Sopenharmony_ci				       0, AH_WAIT_TIMEOUT);
149662306a36Sopenharmony_ci
149762306a36Sopenharmony_ci		ar9003_hw_do_pcoem_manual_peak_cal(ah, chan, run_rtt_cal);
149862306a36Sopenharmony_ci	}
149962306a36Sopenharmony_ci
150062306a36Sopenharmony_ci	if (REG_READ(ah, AR_PHY_CL_CAL_CTL) & AR_PHY_CL_CAL_ENABLE) {
150162306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_RX_DELAY, rx_delay);
150262306a36Sopenharmony_ci		udelay(5);
150362306a36Sopenharmony_ci	}
150462306a36Sopenharmony_ci
150562306a36Sopenharmony_ci	if (ath9k_hw_mci_is_enabled(ah) && IS_CHAN_2GHZ(chan) && run_agc_cal)
150662306a36Sopenharmony_ci		ar9003_mci_init_cal_done(ah);
150762306a36Sopenharmony_ci
150862306a36Sopenharmony_ci	if (rtt && !run_rtt_cal) {
150962306a36Sopenharmony_ci		agc_ctrl |= agc_supp_cals;
151062306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_AGC_CONTROL(ah), agc_ctrl);
151162306a36Sopenharmony_ci	}
151262306a36Sopenharmony_ci
151362306a36Sopenharmony_ci	if (!status) {
151462306a36Sopenharmony_ci		if (run_rtt_cal)
151562306a36Sopenharmony_ci			ar9003_hw_rtt_disable(ah);
151662306a36Sopenharmony_ci
151762306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
151862306a36Sopenharmony_ci			"offset calibration failed to complete in %d ms; noisy environment?\n",
151962306a36Sopenharmony_ci			AH_WAIT_TIMEOUT / 1000);
152062306a36Sopenharmony_ci		return false;
152162306a36Sopenharmony_ci	}
152262306a36Sopenharmony_ci
152362306a36Sopenharmony_ci	if (txiqcal_done)
152462306a36Sopenharmony_ci		ar9003_hw_tx_iq_cal_post_proc(ah, 0, is_reusable);
152562306a36Sopenharmony_ci	else if (caldata && test_bit(TXIQCAL_DONE, &caldata->cal_flags))
152662306a36Sopenharmony_ci		ar9003_hw_tx_iq_cal_reload(ah);
152762306a36Sopenharmony_ci
152862306a36Sopenharmony_ci	ar9003_hw_cl_cal_post_proc(ah, is_reusable);
152962306a36Sopenharmony_ci
153062306a36Sopenharmony_ci	if (run_rtt_cal && caldata) {
153162306a36Sopenharmony_ci		if (is_reusable) {
153262306a36Sopenharmony_ci			if (!ath9k_hw_rfbus_req(ah)) {
153362306a36Sopenharmony_ci				ath_err(ath9k_hw_common(ah),
153462306a36Sopenharmony_ci					"Could not stop baseband\n");
153562306a36Sopenharmony_ci			} else {
153662306a36Sopenharmony_ci				ar9003_hw_rtt_fill_hist(ah);
153762306a36Sopenharmony_ci
153862306a36Sopenharmony_ci				if (test_bit(SW_PKDET_DONE, &caldata->cal_flags))
153962306a36Sopenharmony_ci					ar9003_hw_rtt_load_hist(ah);
154062306a36Sopenharmony_ci			}
154162306a36Sopenharmony_ci
154262306a36Sopenharmony_ci			ath9k_hw_rfbus_done(ah);
154362306a36Sopenharmony_ci		}
154462306a36Sopenharmony_ci
154562306a36Sopenharmony_ci		ar9003_hw_rtt_disable(ah);
154662306a36Sopenharmony_ci	}
154762306a36Sopenharmony_ci
154862306a36Sopenharmony_ci	/* Revert chainmask to runtime parameters */
154962306a36Sopenharmony_ci	ar9003_hw_set_chain_masks(ah, ah->rxchainmask, ah->txchainmask);
155062306a36Sopenharmony_ci
155162306a36Sopenharmony_ci	ar9003_hw_init_cal_common(ah);
155262306a36Sopenharmony_ci
155362306a36Sopenharmony_ci	return true;
155462306a36Sopenharmony_ci}
155562306a36Sopenharmony_ci
155662306a36Sopenharmony_cistatic bool do_ar9003_agc_cal(struct ath_hw *ah)
155762306a36Sopenharmony_ci{
155862306a36Sopenharmony_ci	struct ath_common *common = ath9k_hw_common(ah);
155962306a36Sopenharmony_ci	bool status;
156062306a36Sopenharmony_ci
156162306a36Sopenharmony_ci	REG_WRITE(ah, AR_PHY_AGC_CONTROL(ah),
156262306a36Sopenharmony_ci		  REG_READ(ah, AR_PHY_AGC_CONTROL(ah)) |
156362306a36Sopenharmony_ci		  AR_PHY_AGC_CONTROL_CAL);
156462306a36Sopenharmony_ci
156562306a36Sopenharmony_ci	status = ath9k_hw_wait(ah, AR_PHY_AGC_CONTROL(ah),
156662306a36Sopenharmony_ci			       AR_PHY_AGC_CONTROL_CAL,
156762306a36Sopenharmony_ci			       0, AH_WAIT_TIMEOUT);
156862306a36Sopenharmony_ci	if (!status) {
156962306a36Sopenharmony_ci		ath_dbg(common, CALIBRATE,
157062306a36Sopenharmony_ci			"offset calibration failed to complete in %d ms,"
157162306a36Sopenharmony_ci			"noisy environment?\n",
157262306a36Sopenharmony_ci			AH_WAIT_TIMEOUT / 1000);
157362306a36Sopenharmony_ci		return false;
157462306a36Sopenharmony_ci	}
157562306a36Sopenharmony_ci
157662306a36Sopenharmony_ci	return true;
157762306a36Sopenharmony_ci}
157862306a36Sopenharmony_ci
157962306a36Sopenharmony_cistatic bool ar9003_hw_init_cal_soc(struct ath_hw *ah,
158062306a36Sopenharmony_ci				   struct ath9k_channel *chan)
158162306a36Sopenharmony_ci{
158262306a36Sopenharmony_ci	bool txiqcal_done = false;
158362306a36Sopenharmony_ci	bool status = true;
158462306a36Sopenharmony_ci	bool run_agc_cal = false, sep_iq_cal = false;
158562306a36Sopenharmony_ci	int i = 0;
158662306a36Sopenharmony_ci
158762306a36Sopenharmony_ci	/* Use chip chainmask only for calibration */
158862306a36Sopenharmony_ci	ar9003_hw_set_chain_masks(ah, ah->caps.rx_chainmask, ah->caps.tx_chainmask);
158962306a36Sopenharmony_ci
159062306a36Sopenharmony_ci	if (ah->enabled_cals & TX_CL_CAL) {
159162306a36Sopenharmony_ci		REG_SET_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_CL_CAL_ENABLE);
159262306a36Sopenharmony_ci		run_agc_cal = true;
159362306a36Sopenharmony_ci	}
159462306a36Sopenharmony_ci
159562306a36Sopenharmony_ci	if (IS_CHAN_HALF_RATE(chan) || IS_CHAN_QUARTER_RATE(chan))
159662306a36Sopenharmony_ci		goto skip_tx_iqcal;
159762306a36Sopenharmony_ci
159862306a36Sopenharmony_ci	/* Do Tx IQ Calibration */
159962306a36Sopenharmony_ci	REG_RMW_FIELD(ah, AR_PHY_TX_IQCAL_CONTROL_1(ah),
160062306a36Sopenharmony_ci		      AR_PHY_TX_IQCAL_CONTROL_1_IQCORR_I_Q_COFF_DELPT,
160162306a36Sopenharmony_ci		      DELPT);
160262306a36Sopenharmony_ci
160362306a36Sopenharmony_ci	/*
160462306a36Sopenharmony_ci	 * For AR9485 or later chips, TxIQ cal runs as part of
160562306a36Sopenharmony_ci	 * AGC calibration. Specifically, AR9550 in SoC chips.
160662306a36Sopenharmony_ci	 */
160762306a36Sopenharmony_ci	if (ah->enabled_cals & TX_IQ_ON_AGC_CAL) {
160862306a36Sopenharmony_ci		if (REG_READ_FIELD(ah, AR_PHY_TX_IQCAL_CONTROL_0(ah),
160962306a36Sopenharmony_ci				   AR_PHY_TX_IQCAL_CONTROL_0_ENABLE_TXIQ_CAL)) {
161062306a36Sopenharmony_ci				txiqcal_done = true;
161162306a36Sopenharmony_ci		} else {
161262306a36Sopenharmony_ci			txiqcal_done = false;
161362306a36Sopenharmony_ci		}
161462306a36Sopenharmony_ci		run_agc_cal = true;
161562306a36Sopenharmony_ci	} else {
161662306a36Sopenharmony_ci		sep_iq_cal = true;
161762306a36Sopenharmony_ci		run_agc_cal = true;
161862306a36Sopenharmony_ci	}
161962306a36Sopenharmony_ci
162062306a36Sopenharmony_ci	/*
162162306a36Sopenharmony_ci	 * In the SoC family, this will run for AR9300, AR9331 and AR9340.
162262306a36Sopenharmony_ci	 */
162362306a36Sopenharmony_ci	if (sep_iq_cal) {
162462306a36Sopenharmony_ci		txiqcal_done = ar9003_hw_tx_iq_cal_run(ah);
162562306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_DIS);
162662306a36Sopenharmony_ci		udelay(5);
162762306a36Sopenharmony_ci		REG_WRITE(ah, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
162862306a36Sopenharmony_ci	}
162962306a36Sopenharmony_ci
163062306a36Sopenharmony_ci	if (AR_SREV_9550(ah) && IS_CHAN_2GHZ(chan)) {
163162306a36Sopenharmony_ci		if (!ar9003_hw_dynamic_osdac_selection(ah, txiqcal_done))
163262306a36Sopenharmony_ci			return false;
163362306a36Sopenharmony_ci	}
163462306a36Sopenharmony_ci
163562306a36Sopenharmony_ciskip_tx_iqcal:
163662306a36Sopenharmony_ci	if (run_agc_cal || !(ah->ah_flags & AH_FASTCC)) {
163762306a36Sopenharmony_ci		for (i = 0; i < AR9300_MAX_CHAINS; i++) {
163862306a36Sopenharmony_ci			if (!(ah->rxchainmask & (1 << i)))
163962306a36Sopenharmony_ci				continue;
164062306a36Sopenharmony_ci
164162306a36Sopenharmony_ci			ar9003_hw_manual_peak_cal(ah, i,
164262306a36Sopenharmony_ci						  IS_CHAN_2GHZ(chan));
164362306a36Sopenharmony_ci		}
164462306a36Sopenharmony_ci
164562306a36Sopenharmony_ci		/*
164662306a36Sopenharmony_ci		 * For non-AR9550 chips, we just trigger AGC calibration
164762306a36Sopenharmony_ci		 * in the HW, poll for completion and then process
164862306a36Sopenharmony_ci		 * the results.
164962306a36Sopenharmony_ci		 *
165062306a36Sopenharmony_ci		 * For AR955x, we run it multiple times and use
165162306a36Sopenharmony_ci		 * median IQ correction.
165262306a36Sopenharmony_ci		 */
165362306a36Sopenharmony_ci		if (!AR_SREV_9550(ah)) {
165462306a36Sopenharmony_ci			status = do_ar9003_agc_cal(ah);
165562306a36Sopenharmony_ci			if (!status)
165662306a36Sopenharmony_ci				return false;
165762306a36Sopenharmony_ci
165862306a36Sopenharmony_ci			if (txiqcal_done)
165962306a36Sopenharmony_ci				ar9003_hw_tx_iq_cal_post_proc(ah, 0, false);
166062306a36Sopenharmony_ci		} else {
166162306a36Sopenharmony_ci			if (!txiqcal_done) {
166262306a36Sopenharmony_ci				status = do_ar9003_agc_cal(ah);
166362306a36Sopenharmony_ci				if (!status)
166462306a36Sopenharmony_ci					return false;
166562306a36Sopenharmony_ci			} else {
166662306a36Sopenharmony_ci				for (i = 0; i < MAXIQCAL; i++) {
166762306a36Sopenharmony_ci					status = do_ar9003_agc_cal(ah);
166862306a36Sopenharmony_ci					if (!status)
166962306a36Sopenharmony_ci						return false;
167062306a36Sopenharmony_ci					ar9003_hw_tx_iq_cal_post_proc(ah, i, false);
167162306a36Sopenharmony_ci				}
167262306a36Sopenharmony_ci			}
167362306a36Sopenharmony_ci		}
167462306a36Sopenharmony_ci	}
167562306a36Sopenharmony_ci
167662306a36Sopenharmony_ci	/* Revert chainmask to runtime parameters */
167762306a36Sopenharmony_ci	ar9003_hw_set_chain_masks(ah, ah->rxchainmask, ah->txchainmask);
167862306a36Sopenharmony_ci
167962306a36Sopenharmony_ci	ar9003_hw_init_cal_common(ah);
168062306a36Sopenharmony_ci
168162306a36Sopenharmony_ci	return true;
168262306a36Sopenharmony_ci}
168362306a36Sopenharmony_ci
168462306a36Sopenharmony_civoid ar9003_hw_attach_calib_ops(struct ath_hw *ah)
168562306a36Sopenharmony_ci{
168662306a36Sopenharmony_ci	struct ath_hw_private_ops *priv_ops = ath9k_hw_private_ops(ah);
168762306a36Sopenharmony_ci	struct ath_hw_ops *ops = ath9k_hw_ops(ah);
168862306a36Sopenharmony_ci
168962306a36Sopenharmony_ci	if (AR_SREV_9003_PCOEM(ah))
169062306a36Sopenharmony_ci		priv_ops->init_cal = ar9003_hw_init_cal_pcoem;
169162306a36Sopenharmony_ci	else
169262306a36Sopenharmony_ci		priv_ops->init_cal = ar9003_hw_init_cal_soc;
169362306a36Sopenharmony_ci
169462306a36Sopenharmony_ci	priv_ops->init_cal_settings = ar9003_hw_init_cal_settings;
169562306a36Sopenharmony_ci	priv_ops->setup_calibration = ar9003_hw_setup_calibration;
169662306a36Sopenharmony_ci
169762306a36Sopenharmony_ci	ops->calibrate = ar9003_hw_calibrate;
169862306a36Sopenharmony_ci}
1699