sys/external/isc/atheros_hal/dist/ar5212/ar5212_rfgain.c

   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: ar5212_rfgain.c,v 1.1.1.1 2008/12/11 04:46:43 alc 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 "ar5212/ar5212.h"
  26 #include "ar5212/ar5212reg.h"
  27 #include "ar5212/ar5212phy.h"
  28
  29 #include "ah_eeprom_v3.h"
  30
  31 static const GAIN_OPTIMIZATION_LADDER gainLadder = {
  32         9,                                      /* numStepsInLadder */
  33         4,                                      /* defaultStepNum */
  34         { { {4, 1, 1, 1},  6, "FG8"},
  35           { {4, 0, 1, 1},  4, "FG7"},
  36           { {3, 1, 1, 1},  3, "FG6"},
  37           { {4, 0, 0, 1},  1, "FG5"},
  38           { {4, 1, 1, 0},  0, "FG4"},   /* noJack */
  39           { {4, 0, 1, 0}, -2, "FG3"},   /* halfJack */
  40           { {3, 1, 1, 0}, -3, "FG2"},   /* clip3 */
  41           { {4, 0, 0, 0}, -4, "FG1"},   /* noJack */
  42           { {2, 1, 1, 0}, -6, "FG0"}    /* clip2 */
  43         }
  44 };
  45
  46 static const GAIN_OPTIMIZATION_LADDER gainLadder5112 = {
  47         8,                                      /* numStepsInLadder */
  48         1,                                      /* defaultStepNum */
  49         { { {3, 0,0,0, 0,0,0},   6, "FG7"},     /* most fixed gain */
  50           { {2, 0,0,0, 0,0,0},   0, "FG6"},
  51           { {1, 0,0,0, 0,0,0},  -3, "FG5"},
  52           { {0, 0,0,0, 0,0,0},  -6, "FG4"},
  53           { {0, 1,1,0, 0,0,0},  -8, "FG3"},
  54           { {0, 1,1,0, 1,1,0}, -10, "FG2"},
  55           { {0, 1,0,1, 1,1,0}, -13, "FG1"},
  56           { {0, 1,0,1, 1,0,1}, -16, "FG0"},     /* least fixed gain */
  57         }
  58 };
  59
  60 /*
  61  * Initialize the gain structure to good values
  62  */
  63 void
  64 ar5212InitializeGainValues(struct ath_hal *ah)
  65 {
  66         struct ath_hal_5212 *ahp = AH5212(ah);
  67         GAIN_VALUES *gv = &ahp->ah_gainValues;
  68
  69         /* initialize gain optimization values */
  70         if (IS_RAD5112_ANY(ah)) {
  71                 gv->currStepNum = gainLadder5112.defaultStepNum;
  72                 gv->currStep =
  73                         &gainLadder5112.optStep[gainLadder5112.defaultStepNum];
  74                 gv->active = AH_TRUE;
  75                 gv->loTrig = 20;
  76                 gv->hiTrig = 85;
  77         } else {
  78                 gv->currStepNum = gainLadder.defaultStepNum;
  79                 gv->currStep = &gainLadder.optStep[gainLadder.defaultStepNum];
  80                 gv->active = AH_TRUE;
  81                 gv->loTrig = 20;
  82                 gv->hiTrig = 35;
  83         }
  84 }
  85
  86 #define MAX_ANALOG_START        319             /* XXX */
  87
  88 /*
  89  * Find analog bits of given parameter data and return a reversed value
  90  */
  91 static uint32_t
  92 ar5212GetRfField(uint32_t *rfBuf, uint32_t numBits, uint32_t firstBit, uint32_t column)
  93 {
  94         uint32_t reg32 = 0, mask, arrayEntry, lastBit;
  95         uint32_t bitPosition, bitsShifted;
  96         int32_t bitsLeft;
  97
  98         HALASSERT(column <= 3);
  99         HALASSERT(numBits <= 32);
 100         HALASSERT(firstBit + numBits <= MAX_ANALOG_START);
 101
 102         arrayEntry = (firstBit - 1) / 8;
 103         bitPosition = (firstBit - 1) % 8;
 104         bitsLeft = numBits;
 105         bitsShifted = 0;
 106         while (bitsLeft > 0) {
 107                 lastBit = (bitPosition + bitsLeft > 8) ?
 108                         (8) : (bitPosition + bitsLeft);
 109                 mask = (((1 << lastBit) - 1) ^ ((1 << bitPosition) - 1)) <<
 110                         (column * 8);
 111                 reg32 |= (((rfBuf[arrayEntry] & mask) >> (column * 8)) >>
 112                         bitPosition) << bitsShifted;
 113                 bitsShifted += lastBit - bitPosition;
 114                 bitsLeft -= (8 - bitPosition);
 115                 bitPosition = 0;
 116                 arrayEntry++;
 117         }
 118         reg32 = ath_hal_reverseBits(reg32, numBits);
 119         return reg32;
 120 }
 121
 122 static HAL_BOOL
 123 ar5212InvalidGainReadback(struct ath_hal *ah, GAIN_VALUES *gv)
 124 {
 125         uint32_t gStep, g, mixOvr;
 126         uint32_t L1, L2, L3, L4;
 127
 128         if (IS_RAD5112_ANY(ah)) {
 129                 mixOvr = ar5212GetRfField(ar5212GetRfBank(ah, 7), 1, 36, 0);
 130                 L1 = 0;
 131                 L2 = 107;
 132                 L3 = 0;
 133                 L4 = 107;
 134                 if (mixOvr == 1) {
 135                         L2 = 83;
 136                         L4 = 83;
 137                         gv->hiTrig = 55;
 138                 }
 139         } else {
 140                 gStep = ar5212GetRfField(ar5212GetRfBank(ah, 7), 6, 37, 0);
 141
 142                 L1 = 0;
 143                 L2 = (gStep == 0x3f) ? 50 : gStep + 4;
 144                 L3 = (gStep != 0x3f) ? 0x40 : L1;
 145                 L4 = L3 + 50;
 146
 147                 gv->loTrig = L1 + (gStep == 0x3f ? DYN_ADJ_LO_MARGIN : 0);
 148                 /* never adjust if != 0x3f */
 149                 gv->hiTrig = L4 - (gStep == 0x3f ? DYN_ADJ_UP_MARGIN : -5);
 150         }
 151         g = gv->currGain;
 152
 153         return !((g >= L1 && g<= L2) || (g >= L3 && g <= L4));
 154 }
 155
 156 /*
 157  * Enable the probe gain check on the next packet
 158  */
 159 void
 160 ar5212RequestRfgain(struct ath_hal *ah)
 161 {
 162         struct ath_hal_5212 *ahp = AH5212(ah);
 163         uint32_t probePowerIndex;
 164
 165         /* Enable the gain readback probe */
 166         probePowerIndex = ahp->ah_ofdmTxPower + ahp->ah_txPowerIndexOffset;
 167         OS_REG_WRITE(ah, AR_PHY_PAPD_PROBE,
 168                   SM(probePowerIndex, AR_PHY_PAPD_PROBE_POWERTX)
 169                 | AR_PHY_PAPD_PROBE_NEXT_TX);
 170
 171         ahp->ah_rfgainState = HAL_RFGAIN_READ_REQUESTED;
 172 }
 173
 174 /*
 175  * Check to see if our readback gain level sits within the linear
 176  * region of our current variable attenuation window
 177  */
 178 static HAL_BOOL
 179 ar5212IsGainAdjustNeeded(struct ath_hal *ah, const GAIN_VALUES *gv)
 180 {
 181         return (gv->currGain <= gv->loTrig || gv->currGain >= gv->hiTrig);
 182 }
 183
 184 /*
 185  * Move the rabbit ears in the correct direction.
 186  */
 187 static int32_t
 188 ar5212AdjustGain(struct ath_hal *ah, GAIN_VALUES *gv)
 189 {
 190         const GAIN_OPTIMIZATION_LADDER *gl;
 191
 192         if (IS_RAD5112_ANY(ah))
 193                 gl = &gainLadder5112;
 194         else
 195                 gl = &gainLadder;
 196         gv->currStep = &gl->optStep[gv->currStepNum];
 197         if (gv->currGain >= gv->hiTrig) {
 198                 if (gv->currStepNum == 0) {
 199                         HALDEBUG(ah, HAL_DEBUG_ANY, "%s: Max gain limit.\n",
 200                             __func__);
 201                         return -1;
 202                 }
 203                 HALDEBUG(ah, HAL_DEBUG_RFPARAM,
 204                     "%s: Adding gain: currG=%d [%s] --> ",
 205                     __func__, gv->currGain, gv->currStep->stepName);
 206                 gv->targetGain = gv->currGain;
 207                 while (gv->targetGain >= gv->hiTrig && gv->currStepNum > 0) {
 208                         gv->targetGain -= 2 * (gl->optStep[--(gv->currStepNum)].stepGain -
 209                                 gv->currStep->stepGain);
 210                         gv->currStep = &gl->optStep[gv->currStepNum];
 211                 }
 212                 HALDEBUG(ah, HAL_DEBUG_RFPARAM, "targG=%d [%s]\n",
 213                     gv->targetGain, gv->currStep->stepName);
 214                 return 1;
 215         }
 216         if (gv->currGain <= gv->loTrig) {
 217                 if (gv->currStepNum == gl->numStepsInLadder-1) {
 218                         HALDEBUG(ah, HAL_DEBUG_RFPARAM,
 219                             "%s: Min gain limit.\n", __func__);
 220                         return -2;
 221                 }
 222                 HALDEBUG(ah, HAL_DEBUG_RFPARAM,
 223                     "%s: Deducting gain: currG=%d [%s] --> ",
 224                     __func__, gv->currGain, gv->currStep->stepName);
 225                 gv->targetGain = gv->currGain;
 226                 while (gv->targetGain <= gv->loTrig &&
 227                       gv->currStepNum < (gl->numStepsInLadder - 1)) {
 228                         gv->targetGain -= 2 *
 229                                 (gl->optStep[++(gv->currStepNum)].stepGain - gv->currStep->stepGain);
 230                         gv->currStep = &gl->optStep[gv->currStepNum];
 231                 }
 232                 HALDEBUG(ah, HAL_DEBUG_RFPARAM, "targG=%d [%s]\n",
 233                     gv->targetGain, gv->currStep->stepName);
 234                 return 2;
 235         }
 236         return 0;               /* caller didn't call needAdjGain first */
 237 }
 238
 239 /*
 240  * Read rf register to determine if gainF needs correction
 241  */
 242 static void
 243 ar5212GetGainFCorrection(struct ath_hal *ah)
 244 {
 245         struct ath_hal_5212 *ahp = AH5212(ah);
 246         GAIN_VALUES *gv = &ahp->ah_gainValues;
 247
 248         HALASSERT(IS_RADX112_REV2(ah));
 249
 250         gv->gainFCorrection = 0;
 251         if (ar5212GetRfField(ar5212GetRfBank(ah, 7), 1, 36, 0) == 1) {
 252                 uint32_t mixGain = gv->currStep->paramVal[0];
 253                 uint32_t gainStep =
 254                         ar5212GetRfField(ar5212GetRfBank(ah, 7), 4, 32, 0);
 255                 switch (mixGain) {
 256                 case 0 :
 257                         gv->gainFCorrection = 0;
 258                         break;
 259                 case 1 :
 260                         gv->gainFCorrection = gainStep;
 261                         break;
 262                 case 2 :
 263                         gv->gainFCorrection = 2 * gainStep - 5;
 264                         break;
 265                 case 3 :
 266                         gv->gainFCorrection = 2 * gainStep;
 267                         break;
 268                 }
 269         }
 270 }
 271
 272 /*
 273  * Exported call to check for a recent gain reading and return
 274  * the current state of the thermal calibration gain engine.
 275  */
 276 HAL_RFGAIN
 277 ar5212GetRfgain(struct ath_hal *ah)
 278 {
 279         struct ath_hal_5212 *ahp = AH5212(ah);
 280         GAIN_VALUES *gv = &ahp->ah_gainValues;
 281         uint32_t rddata, probeType;
 282
 283         if (!gv->active)
 284                 return HAL_RFGAIN_INACTIVE;
 285
 286         if (ahp->ah_rfgainState == HAL_RFGAIN_READ_REQUESTED) {
 287                 /* Caller had asked to setup a new reading. Check it. */
 288                 rddata = OS_REG_READ(ah, AR_PHY_PAPD_PROBE);
 289
 290                 if ((rddata & AR_PHY_PAPD_PROBE_NEXT_TX) == 0) {
 291                         /* bit got cleared, we have a new reading. */
 292                         gv->currGain = rddata >> AR_PHY_PAPD_PROBE_GAINF_S;
 293                         probeType = MS(rddata, AR_PHY_PAPD_PROBE_TYPE);
 294                         if (probeType == AR_PHY_PAPD_PROBE_TYPE_CCK) {
 295                                 const HAL_EEPROM *ee = AH_PRIVATE(ah)->ah_eeprom;
 296
 297                                 HALASSERT(IS_RAD5112_ANY(ah));
 298                                 HALASSERT(ah->ah_magic == AR5212_MAGIC);
 299                                 if (AH_PRIVATE(ah)->ah_phyRev >= AR_PHY_CHIP_ID_REV_2)
 300                                         gv->currGain += ee->ee_cckOfdmGainDelta;
 301                                 else
 302                                         gv->currGain += PHY_PROBE_CCK_CORRECTION;
 303                         }
 304                         if (IS_RADX112_REV2(ah)) {
 305                                 ar5212GetGainFCorrection(ah);
 306                                 if (gv->currGain >= gv->gainFCorrection)
 307                                         gv->currGain -= gv->gainFCorrection;
 308                                 else
 309                                         gv->currGain = 0;
 310                         }
 311                         /* inactive by default */
 312                         ahp->ah_rfgainState = HAL_RFGAIN_INACTIVE;
 313
 314                         if (!ar5212InvalidGainReadback(ah, gv) &&
 315                             ar5212IsGainAdjustNeeded(ah, gv) &&
 316                             ar5212AdjustGain(ah, gv) > 0) {
 317                                 /*
 318                                  * Change needed. Copy ladder info
 319                                  * into eeprom info.
 320                                  */
 321                                 ahp->ah_rfgainState = HAL_RFGAIN_NEED_CHANGE;
 322                                 /* for ap51 */
 323                                 ahp->ah_cwCalRequire = AH_TRUE;
 324                                 /* Request IQ recalibration for temperature chang */
 325                                 ahp->ah_bIQCalibration = IQ_CAL_INACTIVE;
 326                         }
 327                 }
 328         }
 329         return ahp->ah_rfgainState;
 330 }