1 /* 2 * Copyright (c) 2002-2009 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 * $FreeBSD$ 18 */ 19 #include "opt_ah.h" 20 21 #include "ah.h" 22 #include "ah_internal.h" 23 #include "ah_devid.h" 24 25 #include "ah_eeprom_v14.h" 26 27 #include "ar5212/ar5212.h" /* for NF cal related declarations */ 28 29 #include "ar5416/ar5416.h" 30 #include "ar5416/ar5416reg.h" 31 #include "ar5416/ar5416phy.h" 32 33 /* Owl specific stuff */ 34 #define NUM_NOISEFLOOR_READINGS 6 /* 3 chains * (ctl + ext) */ 35 36 static void ar5416StartNFCal(struct ath_hal *ah); 37 static void ar5416LoadNF(struct ath_hal *ah, const struct ieee80211_channel *); 38 static int16_t ar5416GetNf(struct ath_hal *, struct ieee80211_channel *); 39 40 static uint16_t ar5416GetDefaultNF(struct ath_hal *ah, const struct ieee80211_channel *chan); 41 static void ar5416SanitizeNF(struct ath_hal *ah, int16_t *nf); 42 43 /* 44 * Determine if calibration is supported by device and channel flags 45 */ 46 47 /* 48 * ADC GAIN/DC offset calibration is for calibrating two ADCs that 49 * are acting as one by interleaving incoming symbols. This isn't 50 * relevant for 2.4GHz 20MHz wide modes because, as far as I can tell, 51 * the secondary ADC is never enabled. It is enabled however for 52 * 5GHz modes. 53 * 54 * It hasn't been confirmed whether doing this calibration is needed 55 * at all in the above modes and/or whether it's actually harmful. 56 * So for now, let's leave it enabled and just remember to get 57 * confirmation that it needs to be clarified. 58 * 59 * See US Patent No: US 7,541,952 B1: 60 * " Method and Apparatus for Offset and Gain Compensation for 61 * Analog-to-Digital Converters." 62 */ 63 static OS_INLINE HAL_BOOL 64 ar5416IsCalSupp(struct ath_hal *ah, const struct ieee80211_channel *chan, 65 HAL_CAL_TYPE calType) 66 { 67 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 68 69 switch (calType & cal->suppCals) { 70 case IQ_MISMATCH_CAL: 71 /* Run IQ Mismatch for non-CCK only */ 72 return !IEEE80211_IS_CHAN_B(chan); 73 case ADC_GAIN_CAL: 74 case ADC_DC_CAL: 75 /* 76 * Run ADC Gain Cal for either 5ghz any or 2ghz HT40. 77 * 78 * Don't run ADC calibrations for 5ghz fast clock mode 79 * in HT20 - only one ADC is used. 80 */ 81 if (IEEE80211_IS_CHAN_HT20(chan) && 82 (IS_5GHZ_FAST_CLOCK_EN(ah, chan))) 83 return AH_FALSE; 84 if (IEEE80211_IS_CHAN_5GHZ(chan)) 85 return AH_TRUE; 86 if (IEEE80211_IS_CHAN_HT40(chan)) 87 return AH_TRUE; 88 return AH_FALSE; 89 } 90 return AH_FALSE; 91 } 92 93 /* 94 * Setup HW to collect samples used for current cal 95 */ 96 static void 97 ar5416SetupMeasurement(struct ath_hal *ah, HAL_CAL_LIST *currCal) 98 { 99 /* Start calibration w/ 2^(INIT_IQCAL_LOG_COUNT_MAX+1) samples */ 100 OS_REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4, 101 AR_PHY_TIMING_CTRL4_IQCAL_LOG_COUNT_MAX, 102 currCal->calData->calCountMax); 103 104 /* Select calibration to run */ 105 switch (currCal->calData->calType) { 106 case IQ_MISMATCH_CAL: 107 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_IQ); 108 HALDEBUG(ah, HAL_DEBUG_PERCAL, 109 "%s: start IQ Mismatch calibration\n", __func__); 110 break; 111 case ADC_GAIN_CAL: 112 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_GAIN); 113 HALDEBUG(ah, HAL_DEBUG_PERCAL, 114 "%s: start ADC Gain calibration\n", __func__); 115 break; 116 case ADC_DC_CAL: 117 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_DC_PER); 118 HALDEBUG(ah, HAL_DEBUG_PERCAL, 119 "%s: start ADC DC calibration\n", __func__); 120 break; 121 case ADC_DC_INIT_CAL: 122 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_DC_INIT); 123 HALDEBUG(ah, HAL_DEBUG_PERCAL, 124 "%s: start Init ADC DC calibration\n", __func__); 125 break; 126 } 127 /* Kick-off cal */ 128 OS_REG_SET_BIT(ah, AR_PHY_TIMING_CTRL4, AR_PHY_TIMING_CTRL4_DO_CAL); 129 } 130 131 /* 132 * Initialize shared data structures and prepare a cal to be run. 133 */ 134 static void 135 ar5416ResetMeasurement(struct ath_hal *ah, HAL_CAL_LIST *currCal) 136 { 137 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 138 139 /* Reset data structures shared between different calibrations */ 140 OS_MEMZERO(cal->caldata, sizeof(cal->caldata)); 141 cal->calSamples = 0; 142 143 /* Setup HW for new calibration */ 144 ar5416SetupMeasurement(ah, currCal); 145 146 /* Change SW state to RUNNING for this calibration */ 147 currCal->calState = CAL_RUNNING; 148 } 149 150 #if 0 151 /* 152 * Run non-periodic calibrations. 153 */ 154 static HAL_BOOL 155 ar5416RunInitCals(struct ath_hal *ah, int init_cal_count) 156 { 157 struct ath_hal_5416 *ahp = AH5416(ah); 158 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 159 HAL_CHANNEL_INTERNAL ichan; /* XXX bogus */ 160 HAL_CAL_LIST *curCal = ahp->ah_cal_curr; 161 HAL_BOOL isCalDone; 162 int i; 163 164 if (curCal == AH_NULL) 165 return AH_FALSE; 166 167 ichan.calValid = 0; 168 for (i = 0; i < init_cal_count; i++) { 169 /* Reset this Cal */ 170 ar5416ResetMeasurement(ah, curCal); 171 /* Poll for offset calibration complete */ 172 if (!ath_hal_wait(ah, AR_PHY_TIMING_CTRL4, AR_PHY_TIMING_CTRL4_DO_CAL, 0)) { 173 HALDEBUG(ah, HAL_DEBUG_ANY, 174 "%s: Cal %d failed to finish in 100ms.\n", 175 __func__, curCal->calData->calType); 176 /* Re-initialize list pointers for periodic cals */ 177 cal->cal_list = cal->cal_last = cal->cal_curr = AH_NULL; 178 return AH_FALSE; 179 } 180 /* Run this cal */ 181 ar5416DoCalibration(ah, &ichan, ahp->ah_rxchainmask, 182 curCal, &isCalDone); 183 if (!isCalDone) 184 HALDEBUG(ah, HAL_DEBUG_ANY, 185 "%s: init cal %d did not complete.\n", 186 __func__, curCal->calData->calType); 187 if (curCal->calNext != AH_NULL) 188 curCal = curCal->calNext; 189 } 190 191 /* Re-initialize list pointers for periodic cals */ 192 cal->cal_list = cal->cal_last = cal->cal_curr = AH_NULL; 193 return AH_TRUE; 194 } 195 #endif 196 197 198 /* 199 * AGC calibration for the AR5416, AR9130, AR9160, AR9280. 200 */ 201 HAL_BOOL 202 ar5416InitCalHardware(struct ath_hal *ah, const struct ieee80211_channel *chan) 203 { 204 205 if (AR_SREV_MERLIN_10_OR_LATER(ah)) { 206 /* Disable ADC */ 207 OS_REG_CLR_BIT(ah, AR_PHY_ADC_CTL, 208 AR_PHY_ADC_CTL_OFF_PWDADC); 209 210 /* Enable Rx Filter Cal */ 211 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, 212 AR_PHY_AGC_CONTROL_FLTR_CAL); 213 } 214 215 /* Calibrate the AGC */ 216 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL); 217 218 /* Poll for offset calibration complete */ 219 if (!ath_hal_wait(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL, 0)) { 220 HALDEBUG(ah, HAL_DEBUG_ANY, 221 "%s: offset calibration did not complete in 1ms; " 222 "noisy environment?\n", __func__); 223 return AH_FALSE; 224 } 225 226 if (AR_SREV_MERLIN_10_OR_LATER(ah)) { 227 /* Enable ADC */ 228 OS_REG_SET_BIT(ah, AR_PHY_ADC_CTL, 229 AR_PHY_ADC_CTL_OFF_PWDADC); 230 231 /* Disable Rx Filter Cal */ 232 OS_REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL, 233 AR_PHY_AGC_CONTROL_FLTR_CAL); 234 } 235 236 return AH_TRUE; 237 } 238 239 /* 240 * Initialize Calibration infrastructure. 241 */ 242 #define MAX_CAL_CHECK 32 243 HAL_BOOL 244 ar5416InitCal(struct ath_hal *ah, const struct ieee80211_channel *chan) 245 { 246 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 247 HAL_CHANNEL_INTERNAL *ichan; 248 249 ichan = ath_hal_checkchannel(ah, chan); 250 HALASSERT(ichan != AH_NULL); 251 252 /* Do initial chipset-specific calibration */ 253 if (! AH5416(ah)->ah_cal_initcal(ah, chan)) { 254 HALDEBUG(ah, HAL_DEBUG_ANY, 255 "%s: initial chipset calibration did " 256 "not complete in time; noisy environment?\n", __func__); 257 return AH_FALSE; 258 } 259 260 /* If there's PA Cal, do it */ 261 if (AH5416(ah)->ah_cal_pacal) 262 AH5416(ah)->ah_cal_pacal(ah, AH_TRUE); 263 264 /* 265 * Do NF calibration after DC offset and other CALs. 266 * Per system engineers, noise floor value can sometimes be 20 dB 267 * higher than normal value if DC offset and noise floor cal are 268 * triggered at the same time. 269 */ 270 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF); 271 272 /* 273 * This may take a while to run; make sure subsequent 274 * calibration routines check that this has completed 275 * before reading the value and triggering a subsequent 276 * calibration. 277 */ 278 279 /* Initialize list pointers */ 280 cal->cal_list = cal->cal_last = cal->cal_curr = AH_NULL; 281 282 /* 283 * Enable IQ, ADC Gain, ADC DC Offset Cals 284 */ 285 if (AR_SREV_HOWL(ah) || AR_SREV_SOWL_10_OR_LATER(ah)) { 286 /* Setup all non-periodic, init time only calibrations */ 287 /* XXX: Init DC Offset not working yet */ 288 #if 0 289 if (ar5416IsCalSupp(ah, chan, ADC_DC_INIT_CAL)) { 290 INIT_CAL(&cal->adcDcCalInitData); 291 INSERT_CAL(cal, &cal->adcDcCalInitData); 292 } 293 /* Initialize current pointer to first element in list */ 294 cal->cal_curr = cal->cal_list; 295 296 if (cal->ah_cal_curr != AH_NULL && !ar5416RunInitCals(ah, 0)) 297 return AH_FALSE; 298 #endif 299 } 300 301 /* If Cals are supported, add them to list via INIT/INSERT_CAL */ 302 if (ar5416IsCalSupp(ah, chan, ADC_GAIN_CAL)) { 303 INIT_CAL(&cal->adcGainCalData); 304 INSERT_CAL(cal, &cal->adcGainCalData); 305 HALDEBUG(ah, HAL_DEBUG_PERCAL, 306 "%s: enable ADC Gain Calibration.\n", __func__); 307 } 308 if (ar5416IsCalSupp(ah, chan, ADC_DC_CAL)) { 309 INIT_CAL(&cal->adcDcCalData); 310 INSERT_CAL(cal, &cal->adcDcCalData); 311 HALDEBUG(ah, HAL_DEBUG_PERCAL, 312 "%s: enable ADC DC Calibration.\n", __func__); 313 } 314 if (ar5416IsCalSupp(ah, chan, IQ_MISMATCH_CAL)) { 315 INIT_CAL(&cal->iqCalData); 316 INSERT_CAL(cal, &cal->iqCalData); 317 HALDEBUG(ah, HAL_DEBUG_PERCAL, 318 "%s: enable IQ Calibration.\n", __func__); 319 } 320 /* Initialize current pointer to first element in list */ 321 cal->cal_curr = cal->cal_list; 322 323 /* Kick off measurements for the first cal */ 324 if (cal->cal_curr != AH_NULL) 325 ar5416ResetMeasurement(ah, cal->cal_curr); 326 327 /* Mark all calibrations on this channel as being invalid */ 328 ichan->calValid = 0; 329 330 return AH_TRUE; 331 #undef MAX_CAL_CHECK 332 } 333 334 /* 335 * Entry point for upper layers to restart current cal. 336 * Reset the calibration valid bit in channel. 337 */ 338 HAL_BOOL 339 ar5416ResetCalValid(struct ath_hal *ah, const struct ieee80211_channel *chan) 340 { 341 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 342 HAL_CHANNEL_INTERNAL *ichan = ath_hal_checkchannel(ah, chan); 343 HAL_CAL_LIST *currCal = cal->cal_curr; 344 345 if (!AR_SREV_SOWL_10_OR_LATER(ah)) 346 return AH_FALSE; 347 if (currCal == AH_NULL) 348 return AH_FALSE; 349 if (ichan == AH_NULL) { 350 HALDEBUG(ah, HAL_DEBUG_ANY, 351 "%s: invalid channel %u/0x%x; no mapping\n", 352 __func__, chan->ic_freq, chan->ic_flags); 353 return AH_FALSE; 354 } 355 /* 356 * Expected that this calibration has run before, post-reset. 357 * Current state should be done 358 */ 359 if (currCal->calState != CAL_DONE) { 360 HALDEBUG(ah, HAL_DEBUG_ANY, 361 "%s: Calibration state incorrect, %d\n", 362 __func__, currCal->calState); 363 return AH_FALSE; 364 } 365 366 /* Verify Cal is supported on this channel */ 367 if (!ar5416IsCalSupp(ah, chan, currCal->calData->calType)) 368 return AH_FALSE; 369 370 HALDEBUG(ah, HAL_DEBUG_PERCAL, 371 "%s: Resetting Cal %d state for channel %u/0x%x\n", 372 __func__, currCal->calData->calType, chan->ic_freq, 373 chan->ic_flags); 374 375 /* Disable cal validity in channel */ 376 ichan->calValid &= ~currCal->calData->calType; 377 currCal->calState = CAL_WAITING; 378 379 return AH_TRUE; 380 } 381 382 /* 383 * Recalibrate the lower PHY chips to account for temperature/environment 384 * changes. 385 */ 386 static void 387 ar5416DoCalibration(struct ath_hal *ah, HAL_CHANNEL_INTERNAL *ichan, 388 uint8_t rxchainmask, HAL_CAL_LIST *currCal, HAL_BOOL *isCalDone) 389 { 390 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 391 392 /* Cal is assumed not done until explicitly set below */ 393 *isCalDone = AH_FALSE; 394 395 HALDEBUG(ah, HAL_DEBUG_PERCAL, 396 "%s: %s Calibration, state %d, calValid 0x%x\n", 397 __func__, currCal->calData->calName, currCal->calState, 398 ichan->calValid); 399 400 /* Calibration in progress. */ 401 if (currCal->calState == CAL_RUNNING) { 402 /* Check to see if it has finished. */ 403 if (!(OS_REG_READ(ah, AR_PHY_TIMING_CTRL4) & AR_PHY_TIMING_CTRL4_DO_CAL)) { 404 HALDEBUG(ah, HAL_DEBUG_PERCAL, 405 "%s: sample %d of %d finished\n", 406 __func__, cal->calSamples, 407 currCal->calData->calNumSamples); 408 /* 409 * Collect measurements for active chains. 410 */ 411 currCal->calData->calCollect(ah); 412 if (++cal->calSamples >= currCal->calData->calNumSamples) { 413 int i, numChains = 0; 414 for (i = 0; i < AR5416_MAX_CHAINS; i++) { 415 if (rxchainmask & (1 << i)) 416 numChains++; 417 } 418 /* 419 * Process accumulated data 420 */ 421 currCal->calData->calPostProc(ah, numChains); 422 423 /* Calibration has finished. */ 424 ichan->calValid |= currCal->calData->calType; 425 currCal->calState = CAL_DONE; 426 *isCalDone = AH_TRUE; 427 } else { 428 /* 429 * Set-up to collect of another sub-sample. 430 */ 431 ar5416SetupMeasurement(ah, currCal); 432 } 433 } 434 } else if (!(ichan->calValid & currCal->calData->calType)) { 435 /* If current cal is marked invalid in channel, kick it off */ 436 ar5416ResetMeasurement(ah, currCal); 437 } 438 } 439 440 /* 441 * Internal interface to schedule periodic calibration work. 442 */ 443 HAL_BOOL 444 ar5416PerCalibrationN(struct ath_hal *ah, struct ieee80211_channel *chan, 445 u_int rxchainmask, HAL_BOOL longcal, HAL_BOOL *isCalDone) 446 { 447 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 448 HAL_CAL_LIST *currCal = cal->cal_curr; 449 HAL_CHANNEL_INTERNAL *ichan; 450 int r; 451 452 OS_MARK(ah, AH_MARK_PERCAL, chan->ic_freq); 453 454 *isCalDone = AH_TRUE; 455 456 /* 457 * Since ath_hal calls the PerCal method with rxchainmask=0x1; 458 * override it with the current chainmask. The upper levels currently 459 * doesn't know about the chainmask. 460 */ 461 rxchainmask = AH5416(ah)->ah_rx_chainmask; 462 463 /* Invalid channel check */ 464 ichan = ath_hal_checkchannel(ah, chan); 465 if (ichan == AH_NULL) { 466 HALDEBUG(ah, HAL_DEBUG_ANY, 467 "%s: invalid channel %u/0x%x; no mapping\n", 468 __func__, chan->ic_freq, chan->ic_flags); 469 return AH_FALSE; 470 } 471 472 /* 473 * For given calibration: 474 * 1. Call generic cal routine 475 * 2. When this cal is done (isCalDone) if we have more cals waiting 476 * (eg after reset), mask this to upper layers by not propagating 477 * isCalDone if it is set to TRUE. 478 * Instead, change isCalDone to FALSE and setup the waiting cal(s) 479 * to be run. 480 */ 481 if (currCal != AH_NULL && 482 (currCal->calState == CAL_RUNNING || 483 currCal->calState == CAL_WAITING)) { 484 ar5416DoCalibration(ah, ichan, rxchainmask, currCal, isCalDone); 485 if (*isCalDone == AH_TRUE) { 486 cal->cal_curr = currCal = currCal->calNext; 487 if (currCal->calState == CAL_WAITING) { 488 *isCalDone = AH_FALSE; 489 ar5416ResetMeasurement(ah, currCal); 490 } 491 } 492 } 493 494 /* Do NF cal only at longer intervals */ 495 if (longcal) { 496 /* Do PA calibration if the chipset supports */ 497 if (AH5416(ah)->ah_cal_pacal) 498 AH5416(ah)->ah_cal_pacal(ah, AH_FALSE); 499 500 /* Do open-loop temperature compensation if the chipset needs it */ 501 if (ath_hal_eepromGetFlag(ah, AR_EEP_OL_PWRCTRL)) 502 AH5416(ah)->ah_olcTempCompensation(ah); 503 504 /* 505 * Get the value from the previous NF cal 506 * and update the history buffer. 507 */ 508 r = ar5416GetNf(ah, chan); 509 if (r == 0 || r == -1) { 510 /* NF calibration result isn't valid */ 511 HALDEBUG(ah, HAL_DEBUG_UNMASKABLE, "%s: NF calibration" 512 " didn't finish; delaying CCA\n", __func__); 513 } else { 514 /* 515 * NF calibration result is valid. 516 * 517 * Load the NF from history buffer of the current channel. 518 * NF is slow time-variant, so it is OK to use a 519 * historical value. 520 */ 521 ar5416LoadNF(ah, AH_PRIVATE(ah)->ah_curchan); 522 523 /* start NF calibration, without updating BB NF register*/ 524 ar5416StartNFCal(ah); 525 } 526 } 527 return AH_TRUE; 528 } 529 530 /* 531 * Recalibrate the lower PHY chips to account for temperature/environment 532 * changes. 533 */ 534 HAL_BOOL 535 ar5416PerCalibration(struct ath_hal *ah, struct ieee80211_channel *chan, 536 HAL_BOOL *isIQdone) 537 { 538 struct ath_hal_5416 *ahp = AH5416(ah); 539 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 540 HAL_CAL_LIST *curCal = cal->cal_curr; 541 542 if (curCal != AH_NULL && curCal->calData->calType == IQ_MISMATCH_CAL) { 543 return ar5416PerCalibrationN(ah, chan, ahp->ah_rx_chainmask, 544 AH_TRUE, isIQdone); 545 } else { 546 HAL_BOOL isCalDone; 547 548 *isIQdone = AH_FALSE; 549 return ar5416PerCalibrationN(ah, chan, ahp->ah_rx_chainmask, 550 AH_TRUE, &isCalDone); 551 } 552 } 553 554 static HAL_BOOL 555 ar5416GetEepromNoiseFloorThresh(struct ath_hal *ah, 556 const struct ieee80211_channel *chan, int16_t *nft) 557 { 558 if (IEEE80211_IS_CHAN_5GHZ(chan)) { 559 ath_hal_eepromGet(ah, AR_EEP_NFTHRESH_5, nft); 560 return AH_TRUE; 561 } 562 if (IEEE80211_IS_CHAN_2GHZ(chan)) { 563 ath_hal_eepromGet(ah, AR_EEP_NFTHRESH_2, nft); 564 return AH_TRUE; 565 } 566 HALDEBUG(ah, HAL_DEBUG_ANY, "%s: invalid channel flags 0x%x\n", 567 __func__, chan->ic_flags); 568 return AH_FALSE; 569 } 570 571 static void 572 ar5416StartNFCal(struct ath_hal *ah) 573 { 574 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_ENABLE_NF); 575 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NO_UPDATE_NF); 576 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF); 577 } 578 579 static void 580 ar5416LoadNF(struct ath_hal *ah, const struct ieee80211_channel *chan) 581 { 582 static const uint32_t ar5416_cca_regs[] = { 583 AR_PHY_CCA, 584 AR_PHY_CH1_CCA, 585 AR_PHY_CH2_CCA, 586 AR_PHY_EXT_CCA, 587 AR_PHY_CH1_EXT_CCA, 588 AR_PHY_CH2_EXT_CCA 589 }; 590 struct ar5212NfCalHist *h; 591 int i; 592 int32_t val; 593 uint8_t chainmask; 594 int16_t default_nf = ar5416GetDefaultNF(ah, chan); 595 596 /* 597 * Force NF calibration for all chains. 598 */ 599 if (AR_SREV_KITE(ah)) { 600 /* Kite has only one chain */ 601 chainmask = 0x9; 602 } else if (AR_SREV_MERLIN(ah) || AR_SREV_KIWI(ah)) { 603 /* Merlin/Kiwi has only two chains */ 604 chainmask = 0x1B; 605 } else { 606 chainmask = 0x3F; 607 } 608 609 /* 610 * Write filtered NF values into maxCCApwr register parameter 611 * so we can load below. 612 */ 613 h = AH5416(ah)->ah_cal.nfCalHist; 614 HALDEBUG(ah, HAL_DEBUG_NFCAL, "CCA: "); 615 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) { 616 617 /* Don't write to EXT radio CCA registers unless in HT/40 mode */ 618 /* XXX this check should really be cleaner! */ 619 if (i > 2 && !IEEE80211_IS_CHAN_HT40(chan)) 620 continue; 621 622 if (chainmask & (1 << i)) { 623 int16_t nf_val; 624 625 if (h) 626 nf_val = h[i].privNF; 627 else 628 nf_val = default_nf; 629 630 val = OS_REG_READ(ah, ar5416_cca_regs[i]); 631 val &= 0xFFFFFE00; 632 val |= (((uint32_t) nf_val << 1) & 0x1ff); 633 HALDEBUG(ah, HAL_DEBUG_NFCAL, "[%d: %d]", i, nf_val); 634 OS_REG_WRITE(ah, ar5416_cca_regs[i], val); 635 } 636 } 637 HALDEBUG(ah, HAL_DEBUG_NFCAL, "\n"); 638 639 /* Load software filtered NF value into baseband internal minCCApwr variable. */ 640 OS_REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_ENABLE_NF); 641 OS_REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NO_UPDATE_NF); 642 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF); 643 644 /* Wait for load to complete, should be fast, a few 10s of us. */ 645 if (! ar5212WaitNFCalComplete(ah, 1000)) { 646 /* 647 * We timed out waiting for the noisefloor to load, probably due to an 648 * in-progress rx. Simply return here and allow the load plenty of time 649 * to complete before the next calibration interval. We need to avoid 650 * trying to load -50 (which happens below) while the previous load is 651 * still in progress as this can cause rx deafness. Instead by returning 652 * here, the baseband nf cal will just be capped by our present 653 * noisefloor until the next calibration timer. 654 */ 655 HALDEBUG(ah, HAL_DEBUG_UNMASKABLE, "Timeout while waiting for " 656 "nf to load: AR_PHY_AGC_CONTROL=0x%x\n", 657 OS_REG_READ(ah, AR_PHY_AGC_CONTROL)); 658 return; 659 } 660 661 /* 662 * Restore maxCCAPower register parameter again so that we're not capped 663 * by the median we just loaded. This will be initial (and max) value 664 * of next noise floor calibration the baseband does. 665 */ 666 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) { 667 668 /* Don't write to EXT radio CCA registers unless in HT/40 mode */ 669 /* XXX this check should really be cleaner! */ 670 if (i > 2 && !IEEE80211_IS_CHAN_HT40(chan)) 671 continue; 672 673 if (chainmask & (1 << i)) { 674 val = OS_REG_READ(ah, ar5416_cca_regs[i]); 675 val &= 0xFFFFFE00; 676 val |= (((uint32_t)(-50) << 1) & 0x1ff); 677 OS_REG_WRITE(ah, ar5416_cca_regs[i], val); 678 } 679 } 680 } 681 682 /* 683 * This just initialises the "good" values for AR5416 which 684 * may not be right; it'lll be overridden by ar5416SanitizeNF() 685 * to nominal values. 686 */ 687 void 688 ar5416InitNfHistBuff(struct ar5212NfCalHist *h) 689 { 690 int i, j; 691 692 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) { 693 h[i].currIndex = 0; 694 h[i].privNF = AR5416_CCA_MAX_GOOD_VALUE; 695 h[i].invalidNFcount = AR512_NF_CAL_HIST_MAX; 696 for (j = 0; j < AR512_NF_CAL_HIST_MAX; j ++) 697 h[i].nfCalBuffer[j] = AR5416_CCA_MAX_GOOD_VALUE; 698 } 699 } 700 701 /* 702 * Update the noise floor buffer as a ring buffer 703 */ 704 static void 705 ar5416UpdateNFHistBuff(struct ath_hal *ah, struct ar5212NfCalHist *h, 706 int16_t *nfarray) 707 { 708 int i; 709 710 /* XXX TODO: don't record nfarray[] entries for inactive chains */ 711 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) { 712 h[i].nfCalBuffer[h[i].currIndex] = nfarray[i]; 713 714 if (++h[i].currIndex >= AR512_NF_CAL_HIST_MAX) 715 h[i].currIndex = 0; 716 if (h[i].invalidNFcount > 0) { 717 if (nfarray[i] < AR5416_CCA_MIN_BAD_VALUE || 718 nfarray[i] > AR5416_CCA_MAX_HIGH_VALUE) { 719 h[i].invalidNFcount = AR512_NF_CAL_HIST_MAX; 720 } else { 721 h[i].invalidNFcount--; 722 h[i].privNF = nfarray[i]; 723 } 724 } else { 725 h[i].privNF = ar5212GetNfHistMid(h[i].nfCalBuffer); 726 } 727 } 728 } 729 730 static uint16_t 731 ar5416GetDefaultNF(struct ath_hal *ah, const struct ieee80211_channel *chan) 732 { 733 struct ar5416NfLimits *limit; 734 735 if (!chan || IEEE80211_IS_CHAN_2GHZ(chan)) 736 limit = &AH5416(ah)->nf_2g; 737 else 738 limit = &AH5416(ah)->nf_5g; 739 740 return limit->nominal; 741 } 742 743 static void 744 ar5416SanitizeNF(struct ath_hal *ah, int16_t *nf) 745 { 746 747 struct ar5416NfLimits *limit; 748 int i; 749 750 if (IEEE80211_IS_CHAN_2GHZ(AH_PRIVATE(ah)->ah_curchan)) 751 limit = &AH5416(ah)->nf_2g; 752 else 753 limit = &AH5416(ah)->nf_5g; 754 755 for (i = 0; i < AR5416_NUM_NF_READINGS; i++) { 756 if (!nf[i]) 757 continue; 758 759 if (nf[i] > limit->max) { 760 HALDEBUG(ah, HAL_DEBUG_NFCAL, 761 "NF[%d] (%d) > MAX (%d), correcting to MAX\n", 762 i, nf[i], limit->max); 763 nf[i] = limit->max; 764 } else if (nf[i] < limit->min) { 765 HALDEBUG(ah, HAL_DEBUG_NFCAL, 766 "NF[%d] (%d) < MIN (%d), correcting to NOM\n", 767 i, nf[i], limit->min); 768 nf[i] = limit->nominal; 769 } 770 } 771 } 772 773 774 /* 775 * Read the NF and check it against the noise floor threshold 776 * 777 * Return 0 if the NF calibration hadn't finished, 0 if it was 778 * invalid, or > 0 for a valid NF reading. 779 */ 780 static int16_t 781 ar5416GetNf(struct ath_hal *ah, struct ieee80211_channel *chan) 782 { 783 int16_t nf, nfThresh; 784 int i; 785 int retval = 0; 786 787 if (ar5212IsNFCalInProgress(ah)) { 788 HALDEBUG(ah, HAL_DEBUG_ANY, 789 "%s: NF didn't complete in calibration window\n", __func__); 790 nf = 0; 791 retval = -1; /* NF didn't finish */ 792 } else { 793 /* Finished NF cal, check against threshold */ 794 int16_t nfarray[NUM_NOISEFLOOR_READINGS] = { 0 }; 795 HAL_CHANNEL_INTERNAL *ichan = ath_hal_checkchannel(ah, chan); 796 797 /* TODO - enhance for multiple chains and ext ch */ 798 ath_hal_getNoiseFloor(ah, nfarray); 799 nf = nfarray[0]; 800 ar5416SanitizeNF(ah, nfarray); 801 if (ar5416GetEepromNoiseFloorThresh(ah, chan, &nfThresh)) { 802 if (nf > nfThresh) { 803 HALDEBUG(ah, HAL_DEBUG_UNMASKABLE, 804 "%s: noise floor failed detected; " 805 "detected %d, threshold %d\n", __func__, 806 nf, nfThresh); 807 /* 808 * NB: Don't discriminate 2.4 vs 5Ghz, if this 809 * happens it indicates a problem regardless 810 * of the band. 811 */ 812 chan->ic_state |= IEEE80211_CHANSTATE_CWINT; 813 nf = 0; 814 retval = 0; 815 } 816 } else { 817 nf = 0; 818 retval = 0; 819 } 820 /* Update MIMO channel statistics, regardless of validity or not (for now) */ 821 for (i = 0; i < 3; i++) { 822 ichan->noiseFloorCtl[i] = nfarray[i]; 823 ichan->noiseFloorExt[i] = nfarray[i + 3]; 824 } 825 ichan->privFlags |= CHANNEL_MIMO_NF_VALID; 826 827 ar5416UpdateNFHistBuff(ah, AH5416(ah)->ah_cal.nfCalHist, nfarray); 828 ichan->rawNoiseFloor = nf; 829 retval = nf; 830 } 831 return retval; 832 } 833