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.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 "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, HAL_CHANNEL_INTERNAL *); 38 static int16_t ar5416GetNf(struct ath_hal *, HAL_CHANNEL_INTERNAL *); 39 40 /* 41 * Determine if calibration is supported by device and channel flags 42 */ 43 static OS_INLINE HAL_BOOL 44 ar5416IsCalSupp(struct ath_hal *ah, HAL_CHANNEL *chan, HAL_CAL_TYPE calType) 45 { 46 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 47 48 switch (calType & cal->suppCals) { 49 case IQ_MISMATCH_CAL: 50 /* Run IQ Mismatch for non-CCK only */ 51 return !IS_CHAN_B(chan); 52 case ADC_GAIN_CAL: 53 case ADC_DC_CAL: 54 /* Run ADC Gain Cal for non-CCK & non 2GHz-HT20 only */ 55 return !IS_CHAN_B(chan) && 56 !(IS_CHAN_2GHZ(chan) && IS_CHAN_HT20(chan)); 57 } 58 return AH_FALSE; 59 } 60 61 /* 62 * Setup HW to collect samples used for current cal 63 */ 64 static void 65 ar5416SetupMeasurement(struct ath_hal *ah, HAL_CAL_LIST *currCal) 66 { 67 /* Start calibration w/ 2^(INIT_IQCAL_LOG_COUNT_MAX+1) samples */ 68 OS_REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4, 69 AR_PHY_TIMING_CTRL4_IQCAL_LOG_COUNT_MAX, 70 currCal->calData->calCountMax); 71 72 /* Select calibration to run */ 73 switch (currCal->calData->calType) { 74 case IQ_MISMATCH_CAL: 75 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_IQ); 76 HALDEBUG(ah, HAL_DEBUG_PERCAL, 77 "%s: start IQ Mismatch calibration\n", __func__); 78 break; 79 case ADC_GAIN_CAL: 80 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_GAIN); 81 HALDEBUG(ah, HAL_DEBUG_PERCAL, 82 "%s: start ADC Gain calibration\n", __func__); 83 break; 84 case ADC_DC_CAL: 85 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_DC_PER); 86 HALDEBUG(ah, HAL_DEBUG_PERCAL, 87 "%s: start ADC DC calibration\n", __func__); 88 break; 89 case ADC_DC_INIT_CAL: 90 OS_REG_WRITE(ah, AR_PHY_CALMODE, AR_PHY_CALMODE_ADC_DC_INIT); 91 HALDEBUG(ah, HAL_DEBUG_PERCAL, 92 "%s: start Init ADC DC calibration\n", __func__); 93 break; 94 } 95 /* Kick-off cal */ 96 OS_REG_SET_BIT(ah, AR_PHY_TIMING_CTRL4, AR_PHY_TIMING_CTRL4_DO_CAL); 97 } 98 99 /* 100 * Initialize shared data structures and prepare a cal to be run. 101 */ 102 static void 103 ar5416ResetMeasurement(struct ath_hal *ah, HAL_CAL_LIST *currCal) 104 { 105 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 106 107 /* Reset data structures shared between different calibrations */ 108 OS_MEMZERO(cal->caldata, sizeof(cal->caldata)); 109 cal->calSamples = 0; 110 111 /* Setup HW for new calibration */ 112 ar5416SetupMeasurement(ah, currCal); 113 114 /* Change SW state to RUNNING for this calibration */ 115 currCal->calState = CAL_RUNNING; 116 } 117 118 #if 0 119 /* 120 * Run non-periodic calibrations. 121 */ 122 static HAL_BOOL 123 ar5416RunInitCals(struct ath_hal *ah, int init_cal_count) 124 { 125 struct ath_hal_5416 *ahp = AH5416(ah); 126 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 127 HAL_CHANNEL_INTERNAL ichan; /* XXX bogus */ 128 HAL_CAL_LIST *curCal = ahp->ah_cal_curr; 129 HAL_BOOL isCalDone; 130 int i; 131 132 if (curCal == AH_NULL) 133 return AH_FALSE; 134 135 ichan.calValid = 0; 136 for (i = 0; i < init_cal_count; i++) { 137 /* Reset this Cal */ 138 ar5416ResetMeasurement(ah, curCal); 139 /* Poll for offset calibration complete */ 140 if (!ath_hal_wait(ah, AR_PHY_TIMING_CTRL4, AR_PHY_TIMING_CTRL4_DO_CAL, 0)) { 141 HALDEBUG(ah, HAL_DEBUG_ANY, 142 "%s: Cal %d failed to finish in 100ms.\n", 143 __func__, curCal->calData->calType); 144 /* Re-initialize list pointers for periodic cals */ 145 cal->cal_list = cal->cal_last = cal->cal_curr = AH_NULL; 146 return AH_FALSE; 147 } 148 /* Run this cal */ 149 ar5416DoCalibration(ah, &ichan, ahp->ah_rxchainmask, 150 curCal, &isCalDone); 151 if (!isCalDone) 152 HALDEBUG(ah, HAL_DEBUG_ANY, 153 "%s: init cal %d did not complete.\n", 154 __func__, curCal->calData->calType); 155 if (curCal->calNext != AH_NULL) 156 curCal = curCal->calNext; 157 } 158 159 /* Re-initialize list pointers for periodic cals */ 160 cal->cal_list = cal->cal_last = cal->cal_curr = AH_NULL; 161 return AH_TRUE; 162 } 163 #endif 164 165 /* 166 * Initialize Calibration infrastructure. 167 */ 168 HAL_BOOL 169 ar5416InitCal(struct ath_hal *ah, HAL_CHANNEL *chan) 170 { 171 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 172 HAL_CHANNEL_INTERNAL *ichan; 173 174 ichan = ath_hal_checkchannel(ah, chan); 175 HALASSERT(ichan != AH_NULL); 176 177 if (AR_SREV_MERLIN_10_OR_LATER(ah)) { 178 /* Enable Rx Filter Cal */ 179 OS_REG_CLR_BIT(ah, AR_PHY_ADC_CTL, AR_PHY_ADC_CTL_OFF_PWDADC); 180 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, 181 AR_PHY_AGC_CONTROL_FLTR_CAL); 182 183 /* Clear the carrier leak cal bit */ 184 OS_REG_CLR_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_CL_CAL_ENABLE); 185 186 /* kick off the cal */ 187 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL); 188 189 /* Poll for offset calibration complete */ 190 if (!ath_hal_wait(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL, 0)) { 191 HALDEBUG(ah, HAL_DEBUG_ANY, 192 "%s: offset calibration failed to complete in 1ms; " 193 "noisy environment?\n", __func__); 194 return AH_FALSE; 195 } 196 197 /* Set the cl cal bit and rerun the cal a 2nd time */ 198 /* Enable Rx Filter Cal */ 199 OS_REG_CLR_BIT(ah, AR_PHY_ADC_CTL, AR_PHY_ADC_CTL_OFF_PWDADC); 200 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, 201 AR_PHY_AGC_CONTROL_FLTR_CAL); 202 203 OS_REG_SET_BIT(ah, AR_PHY_CL_CAL_CTL, AR_PHY_CL_CAL_ENABLE); 204 } 205 206 /* Calibrate the AGC */ 207 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL); 208 209 /* Poll for offset calibration complete */ 210 if (!ath_hal_wait(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_CAL, 0)) { 211 HALDEBUG(ah, HAL_DEBUG_ANY, 212 "%s: offset calibration did not complete in 1ms; " 213 "noisy environment?\n", __func__); 214 return AH_FALSE; 215 } 216 217 /* 218 * Do NF calibration after DC offset and other CALs. 219 * Per system engineers, noise floor value can sometimes be 20 dB 220 * higher than normal value if DC offset and noise floor cal are 221 * triggered at the same time. 222 */ 223 /* XXX this actually kicks off a NF calibration -adrian */ 224 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF); 225 /* 226 * Try to make sure the above NF cal completes, just so 227 * it doesn't clash with subsequent percals - adrian 228 */ 229 if (!ar5212WaitNFCalComplete(ah, 10000)) { 230 HALDEBUG(ah, HAL_DEBUG_ANY, "%s: initial NF calibration did " 231 "not complete in time; noisy environment?\n", __func__); 232 return AH_FALSE; 233 } 234 235 /* Initialize list pointers */ 236 cal->cal_list = cal->cal_last = cal->cal_curr = AH_NULL; 237 238 /* 239 * Enable IQ, ADC Gain, ADC DC Offset Cals 240 */ 241 if (AR_SREV_SOWL_10_OR_LATER(ah)) { 242 /* Setup all non-periodic, init time only calibrations */ 243 /* XXX: Init DC Offset not working yet */ 244 #if 0 245 if (ar5416IsCalSupp(ah, chan, ADC_DC_INIT_CAL)) { 246 INIT_CAL(&cal->adcDcCalInitData); 247 INSERT_CAL(cal, &cal->adcDcCalInitData); 248 } 249 /* Initialize current pointer to first element in list */ 250 cal->cal_curr = cal->cal_list; 251 252 if (cal->ah_cal_curr != AH_NULL && !ar5416RunInitCals(ah, 0)) 253 return AH_FALSE; 254 #endif 255 } 256 257 /* If Cals are supported, add them to list via INIT/INSERT_CAL */ 258 if (ar5416IsCalSupp(ah, chan, ADC_GAIN_CAL)) { 259 INIT_CAL(&cal->adcGainCalData); 260 INSERT_CAL(cal, &cal->adcGainCalData); 261 HALDEBUG(ah, HAL_DEBUG_PERCAL, 262 "%s: enable ADC Gain Calibration.\n", __func__); 263 } 264 if (ar5416IsCalSupp(ah, chan, ADC_DC_CAL)) { 265 INIT_CAL(&cal->adcDcCalData); 266 INSERT_CAL(cal, &cal->adcDcCalData); 267 HALDEBUG(ah, HAL_DEBUG_PERCAL, 268 "%s: enable ADC DC Calibration.\n", __func__); 269 } 270 if (ar5416IsCalSupp(ah, chan, IQ_MISMATCH_CAL)) { 271 INIT_CAL(&cal->iqCalData); 272 INSERT_CAL(cal, &cal->iqCalData); 273 HALDEBUG(ah, HAL_DEBUG_PERCAL, 274 "%s: enable IQ Calibration.\n", __func__); 275 } 276 /* Initialize current pointer to first element in list */ 277 cal->cal_curr = cal->cal_list; 278 279 /* Kick off measurements for the first cal */ 280 if (cal->cal_curr != AH_NULL) 281 ar5416ResetMeasurement(ah, cal->cal_curr); 282 283 /* Mark all calibrations on this channel as being invalid */ 284 ichan->calValid = 0; 285 286 return AH_TRUE; 287 } 288 289 /* 290 * Entry point for upper layers to restart current cal. 291 * Reset the calibration valid bit in channel. 292 */ 293 HAL_BOOL 294 ar5416ResetCalValid(struct ath_hal *ah, HAL_CHANNEL *chan) 295 { 296 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 297 HAL_CHANNEL_INTERNAL *ichan = ath_hal_checkchannel(ah, chan); 298 HAL_CAL_LIST *currCal = cal->cal_curr; 299 300 if (!AR_SREV_SOWL_10_OR_LATER(ah)) 301 return AH_FALSE; 302 if (currCal == AH_NULL) 303 return AH_FALSE; 304 if (ichan == AH_NULL) { 305 HALDEBUG(ah, HAL_DEBUG_ANY, 306 "%s: invalid channel %u/0x%x; no mapping\n", 307 __func__, chan->channel, chan->channelFlags); 308 return AH_FALSE; 309 } 310 /* 311 * Expected that this calibration has run before, post-reset. 312 * Current state should be done 313 */ 314 if (currCal->calState != CAL_DONE) { 315 HALDEBUG(ah, HAL_DEBUG_ANY, 316 "%s: Calibration state incorrect, %d\n", 317 __func__, currCal->calState); 318 return AH_FALSE; 319 } 320 321 /* Verify Cal is supported on this channel */ 322 if (!ar5416IsCalSupp(ah, chan, currCal->calData->calType)) 323 return AH_FALSE; 324 325 HALDEBUG(ah, HAL_DEBUG_PERCAL, 326 "%s: Resetting Cal %d state for channel %u/0x%x\n", 327 __func__, currCal->calData->calType, chan->channel, 328 chan->channelFlags); 329 330 /* Disable cal validity in channel */ 331 ichan->calValid &= ~currCal->calData->calType; 332 currCal->calState = CAL_WAITING; 333 334 return AH_TRUE; 335 } 336 337 /* 338 * Recalibrate the lower PHY chips to account for temperature/environment 339 * changes. 340 */ 341 static void 342 ar5416DoCalibration(struct ath_hal *ah, HAL_CHANNEL_INTERNAL *ichan, 343 uint8_t rxchainmask, HAL_CAL_LIST *currCal, HAL_BOOL *isCalDone) 344 { 345 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 346 347 /* Cal is assumed not done until explicitly set below */ 348 *isCalDone = AH_FALSE; 349 350 HALDEBUG(ah, HAL_DEBUG_PERCAL, 351 "%s: %s Calibration, state %d, calValid 0x%x\n", 352 __func__, currCal->calData->calName, currCal->calState, 353 ichan->calValid); 354 355 /* Calibration in progress. */ 356 if (currCal->calState == CAL_RUNNING) { 357 /* Check to see if it has finished. */ 358 if (!(OS_REG_READ(ah, AR_PHY_TIMING_CTRL4) & AR_PHY_TIMING_CTRL4_DO_CAL)) { 359 HALDEBUG(ah, HAL_DEBUG_PERCAL, 360 "%s: sample %d of %d finished\n", 361 __func__, cal->calSamples, 362 currCal->calData->calNumSamples); 363 /* 364 * Collect measurements for active chains. 365 */ 366 currCal->calData->calCollect(ah); 367 if (++cal->calSamples >= currCal->calData->calNumSamples) { 368 int i, numChains = 0; 369 for (i = 0; i < AR5416_MAX_CHAINS; i++) { 370 if (rxchainmask & (1 << i)) 371 numChains++; 372 } 373 /* 374 * Process accumulated data 375 */ 376 currCal->calData->calPostProc(ah, numChains); 377 378 /* Calibration has finished. */ 379 ichan->calValid |= currCal->calData->calType; 380 currCal->calState = CAL_DONE; 381 *isCalDone = AH_TRUE; 382 } else { 383 /* 384 * Set-up to collect of another sub-sample. 385 */ 386 ar5416SetupMeasurement(ah, currCal); 387 } 388 } 389 } else if (!(ichan->calValid & currCal->calData->calType)) { 390 /* If current cal is marked invalid in channel, kick it off */ 391 ar5416ResetMeasurement(ah, currCal); 392 } 393 } 394 395 /* 396 * Internal interface to schedule periodic calibration work. 397 */ 398 HAL_BOOL 399 ar5416PerCalibrationN(struct ath_hal *ah, HAL_CHANNEL *chan, 400 u_int rxchainmask, HAL_BOOL longcal, HAL_BOOL *isCalDone) 401 { 402 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 403 HAL_CAL_LIST *currCal = cal->cal_curr; 404 HAL_CHANNEL_INTERNAL *ichan; 405 406 OS_MARK(ah, AH_MARK_PERCAL, chan->channel); 407 408 *isCalDone = AH_TRUE; 409 410 /* 411 * Since ath_hal calls the PerCal method with rxchainmask=0x1; 412 * override it with the current chainmask. The upper levels currently 413 * doesn't know about the chainmask. 414 */ 415 rxchainmask = AH5416(ah)->ah_rx_chainmask; 416 417 /* Invalid channel check */ 418 ichan = ath_hal_checkchannel(ah, chan); 419 if (ichan == AH_NULL) { 420 HALDEBUG(ah, HAL_DEBUG_ANY, 421 "%s: invalid channel %u/0x%x; no mapping\n", 422 __func__, chan->channel, chan->channelFlags); 423 return AH_FALSE; 424 } 425 426 /* 427 * For given calibration: 428 * 1. Call generic cal routine 429 * 2. When this cal is done (isCalDone) if we have more cals waiting 430 * (eg after reset), mask this to upper layers by not propagating 431 * isCalDone if it is set to TRUE. 432 * Instead, change isCalDone to FALSE and setup the waiting cal(s) 433 * to be run. 434 */ 435 if (currCal != AH_NULL && 436 (currCal->calState == CAL_RUNNING || 437 currCal->calState == CAL_WAITING)) { 438 ar5416DoCalibration(ah, ichan, rxchainmask, currCal, isCalDone); 439 if (*isCalDone == AH_TRUE) { 440 cal->cal_curr = currCal = currCal->calNext; 441 if (currCal->calState == CAL_WAITING) { 442 *isCalDone = AH_FALSE; 443 ar5416ResetMeasurement(ah, currCal); 444 } 445 } 446 } 447 448 /* Do NF cal only at longer intervals */ 449 if (longcal) { 450 /* 451 * Get the value from the previous NF cal 452 * and update the history buffer. 453 */ 454 ar5416GetNf(ah, ichan); 455 456 /* 457 * Load the NF from history buffer of the current channel. 458 * NF is slow time-variant, so it is OK to use a 459 * historical value. 460 */ 461 ar5416LoadNF(ah, AH_PRIVATE(ah)->ah_curchan); 462 463 /* start NF calibration, without updating BB NF register*/ 464 ar5416StartNFCal(ah); 465 } 466 return AH_TRUE; 467 } 468 469 /* 470 * Recalibrate the lower PHY chips to account for temperature/environment 471 * changes. 472 */ 473 HAL_BOOL 474 ar5416PerCalibration(struct ath_hal *ah, HAL_CHANNEL *chan, HAL_BOOL *isIQdone) 475 { 476 struct ath_hal_5416 *ahp = AH5416(ah); 477 struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; 478 HAL_CAL_LIST *curCal = cal->cal_curr; 479 480 if (curCal != AH_NULL && curCal->calData->calType == IQ_MISMATCH_CAL) { 481 return ar5416PerCalibrationN(ah, chan, ahp->ah_rx_chainmask, 482 AH_TRUE, isIQdone); 483 } else { 484 HAL_BOOL isCalDone; 485 486 *isIQdone = AH_FALSE; 487 return ar5416PerCalibrationN(ah, chan, ahp->ah_rx_chainmask, 488 AH_TRUE, &isCalDone); 489 } 490 } 491 492 static HAL_BOOL 493 ar5416GetEepromNoiseFloorThresh(struct ath_hal *ah, 494 const HAL_CHANNEL_INTERNAL *chan, int16_t *nft) 495 { 496 switch (chan->channelFlags & CHANNEL_ALL_NOTURBO) { 497 case CHANNEL_A: 498 case CHANNEL_A_HT20: 499 case CHANNEL_A_HT40PLUS: 500 case CHANNEL_A_HT40MINUS: 501 ath_hal_eepromGet(ah, AR_EEP_NFTHRESH_5, nft); 502 break; 503 case CHANNEL_B: 504 case CHANNEL_G: 505 case CHANNEL_G_HT20: 506 case CHANNEL_G_HT40PLUS: 507 case CHANNEL_G_HT40MINUS: 508 ath_hal_eepromGet(ah, AR_EEP_NFTHRESH_2, nft); 509 break; 510 default: 511 HALDEBUG(ah, HAL_DEBUG_ANY, 512 "%s: invalid channel flags 0x%x\n", 513 __func__, chan->channelFlags); 514 return AH_FALSE; 515 } 516 return AH_TRUE; 517 } 518 519 static void 520 ar5416StartNFCal(struct ath_hal *ah) 521 { 522 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_ENABLE_NF); 523 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NO_UPDATE_NF); 524 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF); 525 } 526 527 static void 528 ar5416LoadNF(struct ath_hal *ah, HAL_CHANNEL_INTERNAL *chan) 529 { 530 static const uint32_t ar5416_cca_regs[] = { 531 AR_PHY_CCA, 532 AR_PHY_CH1_CCA, 533 AR_PHY_CH2_CCA, 534 AR_PHY_EXT_CCA, 535 AR_PHY_CH1_EXT_CCA, 536 AR_PHY_CH2_EXT_CCA 537 }; 538 struct ar5212NfCalHist *h; 539 int i; 540 int32_t val; 541 uint8_t chainmask; 542 543 /* 544 * Force NF calibration for all chains. 545 */ 546 if (AR_SREV_KITE(ah)) { 547 /* Kite has only one chain */ 548 chainmask = 0x9; 549 } else if (AR_SREV_MERLIN(ah)) { 550 /* Merlin has only two chains */ 551 chainmask = 0x1B; 552 } else { 553 chainmask = 0x3F; 554 } 555 556 /* 557 * Write filtered NF values into maxCCApwr register parameter 558 * so we can load below. 559 */ 560 h = AH5416(ah)->ah_cal.nfCalHist; 561 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) 562 if (chainmask & (1 << i)) { 563 val = OS_REG_READ(ah, ar5416_cca_regs[i]); 564 val &= 0xFFFFFE00; 565 val |= (((uint32_t)(h[i].privNF) << 1) & 0x1ff); 566 OS_REG_WRITE(ah, ar5416_cca_regs[i], val); 567 } 568 569 /* Load software filtered NF value into baseband internal minCCApwr variable. */ 570 OS_REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_ENABLE_NF); 571 OS_REG_CLR_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NO_UPDATE_NF); 572 OS_REG_SET_BIT(ah, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF); 573 574 /* Wait for load to complete, should be fast, a few 10s of us. */ 575 if (! ar5212WaitNFCalComplete(ah, 10000)) { 576 /* 577 * We timed out waiting for the noisefloor to load, probably due 578 * to an in-progress rx. Simply return here and allow the load 579 * plenty of time to complete before the next calibration 580 * interval. We need to avoid trying to load -50 (which happens 581 * below) while the previous load is still in progress as this 582 * can cause rx deafness. Instead by returning here, the 583 * baseband nf cal will just be capped by our present 584 * noisefloor until the next calibration timer. 585 */ 586 HALDEBUG(ah, HAL_DEBUG_ANY, "Timeout while waiting for nf " 587 "to load: AR_PHY_AGC_CONTROL=0x%x\n", 588 OS_REG_READ(ah, AR_PHY_AGC_CONTROL)); 589 return; 590 } 591 592 /* 593 * Restore maxCCAPower register parameter again so that we're not capped 594 * by the median we just loaded. This will be initial (and max) value 595 * of next noise floor calibration the baseband does. 596 */ 597 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) 598 if (chainmask & (1 << i)) { 599 val = OS_REG_READ(ah, ar5416_cca_regs[i]); 600 val &= 0xFFFFFE00; 601 val |= (((uint32_t)(-50) << 1) & 0x1ff); 602 OS_REG_WRITE(ah, ar5416_cca_regs[i], val); 603 } 604 } 605 606 void 607 ar5416InitNfHistBuff(struct ar5212NfCalHist *h) 608 { 609 int i, j; 610 611 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) { 612 h[i].currIndex = 0; 613 h[i].privNF = AR5416_CCA_MAX_GOOD_VALUE; 614 h[i].invalidNFcount = AR512_NF_CAL_HIST_MAX; 615 for (j = 0; j < AR512_NF_CAL_HIST_MAX; j ++) 616 h[i].nfCalBuffer[j] = AR5416_CCA_MAX_GOOD_VALUE; 617 } 618 } 619 620 /* 621 * Update the noise floor buffer as a ring buffer 622 */ 623 static void 624 ar5416UpdateNFHistBuff(struct ar5212NfCalHist *h, int16_t *nfarray) 625 { 626 int i; 627 628 for (i = 0; i < AR5416_NUM_NF_READINGS; i ++) { 629 h[i].nfCalBuffer[h[i].currIndex] = nfarray[i]; 630 631 if (++h[i].currIndex >= AR512_NF_CAL_HIST_MAX) 632 h[i].currIndex = 0; 633 if (h[i].invalidNFcount > 0) { 634 if (nfarray[i] < AR5416_CCA_MIN_BAD_VALUE || 635 nfarray[i] > AR5416_CCA_MAX_HIGH_VALUE) { 636 h[i].invalidNFcount = AR512_NF_CAL_HIST_MAX; 637 } else { 638 h[i].invalidNFcount--; 639 h[i].privNF = nfarray[i]; 640 } 641 } else { 642 h[i].privNF = ar5212GetNfHistMid(h[i].nfCalBuffer); 643 } 644 } 645 } 646 647 /* 648 * Read the NF and check it against the noise floor threshhold 649 */ 650 static int16_t 651 ar5416GetNf(struct ath_hal *ah, HAL_CHANNEL_INTERNAL *chan) 652 { 653 int16_t nf, nfThresh; 654 655 if (OS_REG_READ(ah, AR_PHY_AGC_CONTROL) & AR_PHY_AGC_CONTROL_NF) { 656 HALDEBUG(ah, HAL_DEBUG_ANY, 657 "%s: NF didn't complete in calibration window\n", __func__); 658 nf = 0; 659 } else { 660 /* Finished NF cal, check against threshold */ 661 int16_t nfarray[NUM_NOISEFLOOR_READINGS] = { 0 }; 662 663 /* TODO - enhance for multiple chains and ext ch */ 664 ath_hal_getNoiseFloor(ah, nfarray); 665 nf = nfarray[0]; 666 if (ar5416GetEepromNoiseFloorThresh(ah, chan, &nfThresh)) { 667 if (nf > nfThresh) { 668 HALDEBUG(ah, HAL_DEBUG_ANY, 669 "%s: noise floor failed detected; " 670 "detected %d, threshold %d\n", __func__, 671 nf, nfThresh); 672 /* 673 * NB: Don't discriminate 2.4 vs 5Ghz, if this 674 * happens it indicates a problem regardless 675 * of the band. 676 */ 677 chan->channelFlags |= CHANNEL_CW_INT; 678 nf = 0; 679 } 680 } else { 681 nf = 0; 682 } 683 ar5416UpdateNFHistBuff(AH5416(ah)->ah_cal.nfCalHist, nfarray); 684 chan->rawNoiseFloor = nf; 685 } 686 return nf; 687 } 688
Indexes created Sun Sep 21 16:09:51 GMT 2025