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 } 331
Indexes created Sun Sep 21 20:09:37 GMT 2025