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