Home | History | Annotate | Line # | Download | only in ar5416 
      1 /*
      2  * Copyright (c) 2002-2008 Sam Leffler, Errno Consulting
      3  * Copyright (c) 2002-2008 Atheros Communications, Inc.
      4  *
      5  * Permission to use, copy, modify, and/or distribute this software for any
      6  * purpose with or without fee is hereby granted, provided that the above
      7  * copyright notice and this permission notice appear in all copies.
      8  *
      9  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     10  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     11  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     12  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     13  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     14  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     15  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     16  *
     17  * $Id: ar5416_cal_iq.c,v 1.2 2011/03/07 11:25:44 cegger Exp $
     18  */
     19 #include "opt_ah.h"
     20 
     21 #include "ah.h"
     22 #include "ah_internal.h"
     23 #include "ah_devid.h"
     24 
     25 #include "ar5416/ar5416.h"
     26 #include "ar5416/ar5416reg.h"
     27 #include "ar5416/ar5416phy.h"
     28 
     29 /* IQ Cal aliases */
     30 #define	totalPowerMeasI(i)	caldata[0][i].u
     31 #define	totalPowerMeasQ(i)	caldata[1][i].u
     32 #define	totalIqCorrMeas(i)	caldata[2][i].s
     33 
     34 /*
     35  * Collect data from HW to later perform IQ Mismatch Calibration
     36  */
     37 void
     38 ar5416IQCalCollect(struct ath_hal *ah)
     39 {
     40 	struct ar5416PerCal *cal = &AH5416(ah)->ah_cal;
     41 	int i;
     42 
     43 	/*
     44 	 * Accumulate IQ cal measures for active chains
     45 	 */
     46 	for (i = 0; i < AR5416_MAX_CHAINS; i++) {
     47 		cal->totalPowerMeasI(i) +=
     48 		    OS_REG_READ(ah, AR_PHY_CAL_MEAS_0(i));
     49 		cal->totalPowerMeasQ(i) +=
     50 		    OS_REG_READ(ah, AR_PHY_CAL_MEAS_1(i));
     51 		cal->totalIqCorrMeas(i) += (int32_t)
     52 		    OS_REG_READ(ah, AR_PHY_CAL_MEAS_2(i));
     53 		HALDEBUG(ah, HAL_DEBUG_PERCAL,
     54 		    "%d: Chn %d pmi=0x%08x;pmq=0x%08x;iqcm=0x%08x;\n",
     55 		    cal->calSamples, i, cal->totalPowerMeasI(i),
     56 		    cal->totalPowerMeasQ(i), cal->totalIqCorrMeas(i));
     57 	}
     58 }
     59 
     60 /*
     61  * Use HW data to do IQ Mismatch Calibration
     62  */
     63 void
     64 ar5416IQCalibration(struct ath_hal *ah, uint8_t numChains)
     65 {
     66 	struct ar5416PerCal *cal = &AH5416(ah)->ah_cal;
     67 	int i;
     68 
     69 	for (i = 0; i < numChains; i++) {
     70 		uint32_t powerMeasI = cal->totalPowerMeasI(i);
     71 		uint32_t powerMeasQ = cal->totalPowerMeasQ(i);
     72 		uint32_t iqCorrMeas = cal->totalIqCorrMeas(i);
     73 		uint32_t qCoffDenom, iCoffDenom;
     74 		int iqCorrNeg;
     75 
     76 		HALDEBUG(ah, HAL_DEBUG_PERCAL,
     77 		    "Start IQ Cal and Correction for Chain %d\n", i);
     78 		HALDEBUG(ah, HAL_DEBUG_PERCAL,
     79 		    "Orignal: iq_corr_meas = 0x%08x\n", iqCorrMeas);
     80 
     81 		iqCorrNeg = 0;
     82 		/* iqCorrMeas is always negative. */
     83 		if (iqCorrMeas > 0x80000000)  {
     84 			iqCorrMeas = (0xffffffff - iqCorrMeas) + 1;
     85 			iqCorrNeg = 1;
     86 		}
     87 
     88 		HALDEBUG(ah, HAL_DEBUG_PERCAL, " pwr_meas_i = 0x%08x\n",
     89 		    powerMeasI);
     90 		HALDEBUG(ah, HAL_DEBUG_PERCAL, " pwr_meas_q = 0x%08x\n",
     91 		    powerMeasQ);
     92 		HALDEBUG(ah, HAL_DEBUG_PERCAL, " iqCorrNeg is 0x%08x\n",
     93 		    iqCorrNeg);
     94 
     95 		iCoffDenom = (powerMeasI/2 + powerMeasQ/2)/ 128;
     96 		qCoffDenom = powerMeasQ / 64;
     97 		/* Protect against divide-by-0 */
     98 		if (powerMeasQ != 0) {
     99 			/* IQ corr_meas is already negated if iqcorr_neg == 1 */
    100 			int32_t iCoff = iqCorrMeas/iCoffDenom;
    101 			int32_t qCoff = powerMeasI/qCoffDenom - 64;
    102 
    103 			HALDEBUG(ah, HAL_DEBUG_PERCAL, " iCoff = 0x%08x\n",
    104 			    iCoff);
    105 			HALDEBUG(ah, HAL_DEBUG_PERCAL, " qCoff = 0x%08x\n",
    106 			    qCoff);
    107 
    108 			/* Negate iCoff if iqCorrNeg == 0 */
    109 			iCoff = iCoff & 0x3f;
    110 			HALDEBUG(ah, HAL_DEBUG_PERCAL,
    111 			    "New:  iCoff = 0x%08x\n", iCoff);
    112 
    113 			if (iqCorrNeg == 0x0)
    114 				iCoff = 0x40 - iCoff;
    115 			if (qCoff > 15)
    116 				qCoff = 15;
    117 			else if (qCoff <= -16)
    118 				qCoff = -16;
    119 			HALDEBUG(ah, HAL_DEBUG_PERCAL,
    120 			    " : iCoff = 0x%x  qCoff = 0x%x\n", iCoff, qCoff);
    121 
    122 			OS_REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4_CHAIN(i),
    123 			    AR_PHY_TIMING_CTRL4_IQCORR_Q_I_COFF, iCoff);
    124 			OS_REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4_CHAIN(i),
    125 			    AR_PHY_TIMING_CTRL4_IQCORR_Q_Q_COFF, qCoff);
    126 			HALDEBUG(ah, HAL_DEBUG_PERCAL,
    127 			    "IQ Cal and Correction done for Chain %d\n", i);
    128 		}
    129 	}
    130 	OS_REG_SET_BIT(ah, AR_PHY_TIMING_CTRL4,
    131 	    AR_PHY_TIMING_CTRL4_IQCORR_ENABLE);
    132 }
    133