drivers/net/wireless/ath/ath9k/ani.c

   1 /*
   2  * Copyright (c) 2008-2011 Atheros Communications Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include "hw.h"
  19 #include "hw-ops.h"
  20
  21 struct ani_ofdm_level_entry {
  22         int spur_immunity_level;
  23         int fir_step_level;
  24         int ofdm_weak_signal_on;
  25 };
  26
  27 /* values here are relative to the INI */
  28
  29 /*
  30  * Legend:
  31  *
  32  * SI: Spur immunity
  33  * FS: FIR Step
  34  * WS: OFDM / CCK Weak Signal detection
  35  * MRC-CCK: Maximal Ratio Combining for CCK
  36  */
  37
  38 static const struct ani_ofdm_level_entry ofdm_level_table[] = {
  39         /* SI  FS  WS */
  40         {  0,  0,  1  }, /* lvl 0 */
  41         {  1,  1,  1  }, /* lvl 1 */
  42         {  2,  2,  1  }, /* lvl 2 */
  43         {  3,  2,  1  }, /* lvl 3  (default) */
  44         {  4,  3,  1  }, /* lvl 4 */
  45         {  5,  4,  1  }, /* lvl 5 */
  46         {  6,  5,  1  }, /* lvl 6 */
  47         {  7,  6,  1  }, /* lvl 7 */
  48         {  7,  7,  1  }, /* lvl 8 */
  49         {  7,  8,  0  }  /* lvl 9 */
  50 };
  51 #define ATH9K_ANI_OFDM_NUM_LEVEL \
  52         ARRAY_SIZE(ofdm_level_table)
  53 #define ATH9K_ANI_OFDM_MAX_LEVEL \
  54         (ATH9K_ANI_OFDM_NUM_LEVEL-1)
  55 #define ATH9K_ANI_OFDM_DEF_LEVEL \
  56         3 /* default level - matches the INI settings */
  57
  58 /*
  59  * MRC (Maximal Ratio Combining) has always been used with multi-antenna ofdm.
  60  * With OFDM for single stream you just add up all antenna inputs, you're
  61  * only interested in what you get after FFT. Signal aligment is also not
  62  * required for OFDM because any phase difference adds up in the frequency
  63  * domain.
  64  *
  65  * MRC requires extra work for use with CCK. You need to align the antenna
  66  * signals from the different antenna before you can add the signals together.
  67  * You need aligment of signals as CCK is in time domain, so addition can cancel
  68  * your signal completely if phase is 180 degrees (think of adding sine waves).
  69  * You also need to remove noise before the addition and this is where ANI
  70  * MRC CCK comes into play. One of the antenna inputs may be stronger but
  71  * lower SNR, so just adding after alignment can be dangerous.
  72  *
  73  * Regardless of alignment in time, the antenna signals add constructively after
  74  * FFT and improve your reception. For more information:
  75  *
  76  * http://en.wikipedia.org/wiki/Maximal-ratio_combining
  77  */
  78
  79 struct ani_cck_level_entry {
  80         int fir_step_level;
  81         int mrc_cck_on;
  82 };
  83
  84 static const struct ani_cck_level_entry cck_level_table[] = {
  85         /* FS  MRC-CCK  */
  86         {  0,  1  }, /* lvl 0 */
  87         {  1,  1  }, /* lvl 1 */
  88         {  2,  1  }, /* lvl 2  (default) */
  89         {  3,  1  }, /* lvl 3 */
  90         {  4,  0  }, /* lvl 4 */
  91         {  5,  0  }, /* lvl 5 */
  92         {  6,  0  }, /* lvl 6 */
  93         {  7,  0  }, /* lvl 7 (only for high rssi) */
  94         {  8,  0  }  /* lvl 8 (only for high rssi) */
  95 };
  96
  97 #define ATH9K_ANI_CCK_NUM_LEVEL \
  98         ARRAY_SIZE(cck_level_table)
  99 #define ATH9K_ANI_CCK_MAX_LEVEL \
 100         (ATH9K_ANI_CCK_NUM_LEVEL-1)
 101 #define ATH9K_ANI_CCK_MAX_LEVEL_LOW_RSSI \
 102         (ATH9K_ANI_CCK_NUM_LEVEL-3)
 103 #define ATH9K_ANI_CCK_DEF_LEVEL \
 104         2 /* default level - matches the INI settings */
 105
 106 static bool use_new_ani(struct ath_hw *ah)
 107 {
 108         return AR_SREV_9300_20_OR_LATER(ah) || modparam_force_new_ani;
 109 }
 110
 111 static void ath9k_hw_update_mibstats(struct ath_hw *ah,
 112                                      struct ath9k_mib_stats *stats)
 113 {
 114         stats->ackrcv_bad += REG_READ(ah, AR_ACK_FAIL);
 115         stats->rts_bad += REG_READ(ah, AR_RTS_FAIL);
 116         stats->fcs_bad += REG_READ(ah, AR_FCS_FAIL);
 117         stats->rts_good += REG_READ(ah, AR_RTS_OK);
 118         stats->beacons += REG_READ(ah, AR_BEACON_CNT);
 119 }
 120
 121 static void ath9k_ani_restart(struct ath_hw *ah)
 122 {
 123         struct ar5416AniState *aniState;
 124         struct ath_common *common = ath9k_hw_common(ah);
 125         u32 ofdm_base = 0, cck_base = 0;
 126
 127         if (!DO_ANI(ah))
 128                 return;
 129
 130         aniState = &ah->curchan->ani;
 131         aniState->listenTime = 0;
 132
 133         if (!use_new_ani(ah)) {
 134                 ofdm_base = AR_PHY_COUNTMAX - ah->config.ofdm_trig_high;
 135                 cck_base = AR_PHY_COUNTMAX - ah->config.cck_trig_high;
 136         }
 137
 138         ath_dbg(common, ATH_DBG_ANI,
 139                 "Writing ofdmbase=%u   cckbase=%u\n", ofdm_base, cck_base);
 140
 141         ENABLE_REGWRITE_BUFFER(ah);
 142
 143         REG_WRITE(ah, AR_PHY_ERR_1, ofdm_base);
 144         REG_WRITE(ah, AR_PHY_ERR_2, cck_base);
 145         REG_WRITE(ah, AR_PHY_ERR_MASK_1, AR_PHY_ERR_OFDM_TIMING);
 146         REG_WRITE(ah, AR_PHY_ERR_MASK_2, AR_PHY_ERR_CCK_TIMING);
 147
 148         REGWRITE_BUFFER_FLUSH(ah);
 149
 150         ath9k_hw_update_mibstats(ah, &ah->ah_mibStats);
 151
 152         aniState->ofdmPhyErrCount = 0;
 153         aniState->cckPhyErrCount = 0;
 154 }
 155
 156 static void ath9k_hw_ani_ofdm_err_trigger_old(struct ath_hw *ah)
 157 {
 158         struct ieee80211_conf *conf = &ath9k_hw_common(ah)->hw->conf;
 159         struct ar5416AniState *aniState;
 160         int32_t rssi;
 161
 162         aniState = &ah->curchan->ani;
 163
 164         if (aniState->noiseImmunityLevel < HAL_NOISE_IMMUNE_MAX) {
 165                 if (ath9k_hw_ani_control(ah, ATH9K_ANI_NOISE_IMMUNITY_LEVEL,
 166                                          aniState->noiseImmunityLevel + 1)) {
 167                         return;
 168                 }
 169         }
 170
 171         if (aniState->spurImmunityLevel < HAL_SPUR_IMMUNE_MAX) {
 172                 if (ath9k_hw_ani_control(ah, ATH9K_ANI_SPUR_IMMUNITY_LEVEL,
 173                                          aniState->spurImmunityLevel + 1)) {
 174                         return;
 175                 }
 176         }
 177
 178         if (ah->opmode == NL80211_IFTYPE_AP) {
 179                 if (aniState->firstepLevel < HAL_FIRST_STEP_MAX) {
 180                         ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL,
 181                                              aniState->firstepLevel + 1);
 182                 }
 183                 return;
 184         }
 185         rssi = BEACON_RSSI(ah);
 186         if (rssi > aniState->rssiThrHigh) {
 187                 if (!aniState->ofdmWeakSigDetectOff) {
 188                         if (ath9k_hw_ani_control(ah,
 189                                          ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 190                                          false)) {
 191                                 ath9k_hw_ani_control(ah,
 192                                         ATH9K_ANI_SPUR_IMMUNITY_LEVEL, 0);
 193                                 return;
 194                         }
 195                 }
 196                 if (aniState->firstepLevel < HAL_FIRST_STEP_MAX) {
 197                         ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL,
 198                                              aniState->firstepLevel + 1);
 199                         return;
 200                 }
 201         } else if (rssi > aniState->rssiThrLow) {
 202                 if (aniState->ofdmWeakSigDetectOff)
 203                         ath9k_hw_ani_control(ah,
 204                                      ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 205                                      true);
 206                 if (aniState->firstepLevel < HAL_FIRST_STEP_MAX)
 207                         ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL,
 208                                              aniState->firstepLevel + 1);
 209                 return;
 210         } else {
 211                 if ((conf->channel->band == IEEE80211_BAND_2GHZ) &&
 212                     !conf_is_ht(conf)) {
 213                         if (!aniState->ofdmWeakSigDetectOff)
 214                                 ath9k_hw_ani_control(ah,
 215                                      ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 216                                      false);
 217                         if (aniState->firstepLevel > 0)
 218                                 ath9k_hw_ani_control(ah,
 219                                              ATH9K_ANI_FIRSTEP_LEVEL, 0);
 220                         return;
 221                 }
 222         }
 223 }
 224
 225 static void ath9k_hw_ani_cck_err_trigger_old(struct ath_hw *ah)
 226 {
 227         struct ieee80211_conf *conf = &ath9k_hw_common(ah)->hw->conf;
 228         struct ar5416AniState *aniState;
 229         int32_t rssi;
 230
 231         aniState = &ah->curchan->ani;
 232         if (aniState->noiseImmunityLevel < HAL_NOISE_IMMUNE_MAX) {
 233                 if (ath9k_hw_ani_control(ah, ATH9K_ANI_NOISE_IMMUNITY_LEVEL,
 234                                          aniState->noiseImmunityLevel + 1)) {
 235                         return;
 236                 }
 237         }
 238         if (ah->opmode == NL80211_IFTYPE_AP) {
 239                 if (aniState->firstepLevel < HAL_FIRST_STEP_MAX) {
 240                         ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL,
 241                                              aniState->firstepLevel + 1);
 242                 }
 243                 return;
 244         }
 245         rssi = BEACON_RSSI(ah);
 246         if (rssi > aniState->rssiThrLow) {
 247                 if (aniState->firstepLevel < HAL_FIRST_STEP_MAX)
 248                         ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL,
 249                                              aniState->firstepLevel + 1);
 250         } else {
 251                 if ((conf->channel->band == IEEE80211_BAND_2GHZ) &&
 252                     !conf_is_ht(conf)) {
 253                         if (aniState->firstepLevel > 0)
 254                                 ath9k_hw_ani_control(ah,
 255                                              ATH9K_ANI_FIRSTEP_LEVEL, 0);
 256                 }
 257         }
 258 }
 259
 260 /* Adjust the OFDM Noise Immunity Level */
 261 static void ath9k_hw_set_ofdm_nil(struct ath_hw *ah, u8 immunityLevel)
 262 {
 263         struct ar5416AniState *aniState = &ah->curchan->ani;
 264         struct ath_common *common = ath9k_hw_common(ah);
 265         const struct ani_ofdm_level_entry *entry_ofdm;
 266         const struct ani_cck_level_entry *entry_cck;
 267
 268         aniState->noiseFloor = BEACON_RSSI(ah);
 269
 270         ath_dbg(common, ATH_DBG_ANI,
 271                 "**** ofdmlevel %d=>%d, rssi=%d[lo=%d hi=%d]\n",
 272                 aniState->ofdmNoiseImmunityLevel,
 273                 immunityLevel, aniState->noiseFloor,
 274                 aniState->rssiThrLow, aniState->rssiThrHigh);
 275
 276         if (aniState->update_ani)
 277                 aniState->ofdmNoiseImmunityLevel = immunityLevel;
 278
 279         entry_ofdm = &ofdm_level_table[aniState->ofdmNoiseImmunityLevel];
 280         entry_cck = &cck_level_table[aniState->cckNoiseImmunityLevel];
 281
 282         if (aniState->spurImmunityLevel != entry_ofdm->spur_immunity_level)
 283                 ath9k_hw_ani_control(ah,
 284                                      ATH9K_ANI_SPUR_IMMUNITY_LEVEL,
 285                                      entry_ofdm->spur_immunity_level);
 286
 287         if (aniState->firstepLevel != entry_ofdm->fir_step_level &&
 288             entry_ofdm->fir_step_level >= entry_cck->fir_step_level)
 289                 ath9k_hw_ani_control(ah,
 290                                      ATH9K_ANI_FIRSTEP_LEVEL,
 291                                      entry_ofdm->fir_step_level);
 292
 293         if ((ah->opmode != NL80211_IFTYPE_STATION &&
 294              ah->opmode != NL80211_IFTYPE_ADHOC) ||
 295             aniState->noiseFloor <= aniState->rssiThrHigh) {
 296                 if (aniState->ofdmWeakSigDetectOff)
 297                         /* force on ofdm weak sig detect */
 298                         ath9k_hw_ani_control(ah,
 299                                 ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 300                                              true);
 301                 else if (aniState->ofdmWeakSigDetectOff ==
 302                          entry_ofdm->ofdm_weak_signal_on)
 303                         ath9k_hw_ani_control(ah,
 304                                 ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 305                                 entry_ofdm->ofdm_weak_signal_on);
 306         }
 307 }
 308
 309 static void ath9k_hw_ani_ofdm_err_trigger(struct ath_hw *ah)
 310 {
 311         struct ar5416AniState *aniState;
 312
 313         if (!DO_ANI(ah))
 314                 return;
 315
 316         if (!use_new_ani(ah)) {
 317                 ath9k_hw_ani_ofdm_err_trigger_old(ah);
 318                 return;
 319         }
 320
 321         aniState = &ah->curchan->ani;
 322
 323         if (aniState->ofdmNoiseImmunityLevel < ATH9K_ANI_OFDM_MAX_LEVEL)
 324                 ath9k_hw_set_ofdm_nil(ah, aniState->ofdmNoiseImmunityLevel + 1);
 325 }
 326
 327 /*
 328  * Set the ANI settings to match an CCK level.
 329  */
 330 static void ath9k_hw_set_cck_nil(struct ath_hw *ah, u_int8_t immunityLevel)
 331 {
 332         struct ar5416AniState *aniState = &ah->curchan->ani;
 333         struct ath_common *common = ath9k_hw_common(ah);
 334         const struct ani_ofdm_level_entry *entry_ofdm;
 335         const struct ani_cck_level_entry *entry_cck;
 336
 337         aniState->noiseFloor = BEACON_RSSI(ah);
 338         ath_dbg(common, ATH_DBG_ANI,
 339                 "**** ccklevel %d=>%d, rssi=%d[lo=%d hi=%d]\n",
 340                 aniState->cckNoiseImmunityLevel, immunityLevel,
 341                 aniState->noiseFloor, aniState->rssiThrLow,
 342                 aniState->rssiThrHigh);
 343
 344         if ((ah->opmode == NL80211_IFTYPE_STATION ||
 345              ah->opmode == NL80211_IFTYPE_ADHOC) &&
 346             aniState->noiseFloor <= aniState->rssiThrLow &&
 347             immunityLevel > ATH9K_ANI_CCK_MAX_LEVEL_LOW_RSSI)
 348                 immunityLevel = ATH9K_ANI_CCK_MAX_LEVEL_LOW_RSSI;
 349
 350         if (aniState->update_ani)
 351                 aniState->cckNoiseImmunityLevel = immunityLevel;
 352
 353         entry_ofdm = &ofdm_level_table[aniState->ofdmNoiseImmunityLevel];
 354         entry_cck = &cck_level_table[aniState->cckNoiseImmunityLevel];
 355
 356         if (aniState->firstepLevel != entry_cck->fir_step_level &&
 357             entry_cck->fir_step_level >= entry_ofdm->fir_step_level)
 358                 ath9k_hw_ani_control(ah,
 359                                      ATH9K_ANI_FIRSTEP_LEVEL,
 360                                      entry_cck->fir_step_level);
 361
 362         /* Skip MRC CCK for pre AR9003 families */
 363         if (!AR_SREV_9300_20_OR_LATER(ah) || AR_SREV_9485(ah))
 364                 return;
 365
 366         if (aniState->mrcCCKOff == entry_cck->mrc_cck_on)
 367                 ath9k_hw_ani_control(ah,
 368                                      ATH9K_ANI_MRC_CCK,
 369                                      entry_cck->mrc_cck_on);
 370 }
 371
 372 static void ath9k_hw_ani_cck_err_trigger(struct ath_hw *ah)
 373 {
 374         struct ar5416AniState *aniState;
 375
 376         if (!DO_ANI(ah))
 377                 return;
 378
 379         if (!use_new_ani(ah)) {
 380                 ath9k_hw_ani_cck_err_trigger_old(ah);
 381                 return;
 382         }
 383
 384         aniState = &ah->curchan->ani;
 385
 386         if (aniState->cckNoiseImmunityLevel < ATH9K_ANI_CCK_MAX_LEVEL)
 387                 ath9k_hw_set_cck_nil(ah, aniState->cckNoiseImmunityLevel + 1);
 388 }
 389
 390 static void ath9k_hw_ani_lower_immunity_old(struct ath_hw *ah)
 391 {
 392         struct ar5416AniState *aniState;
 393         int32_t rssi;
 394
 395         aniState = &ah->curchan->ani;
 396
 397         if (ah->opmode == NL80211_IFTYPE_AP) {
 398                 if (aniState->firstepLevel > 0) {
 399                         if (ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL,
 400                                                  aniState->firstepLevel - 1))
 401                                 return;
 402                 }
 403         } else {
 404                 rssi = BEACON_RSSI(ah);
 405                 if (rssi > aniState->rssiThrHigh) {
 406                         /* XXX: Handle me */
 407                 } else if (rssi > aniState->rssiThrLow) {
 408                         if (aniState->ofdmWeakSigDetectOff) {
 409                                 if (ath9k_hw_ani_control(ah,
 410                                          ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 411                                          true) == true)
 412                                         return;
 413                         }
 414                         if (aniState->firstepLevel > 0) {
 415                                 if (ath9k_hw_ani_control(ah,
 416                                          ATH9K_ANI_FIRSTEP_LEVEL,
 417                                          aniState->firstepLevel - 1) == true)
 418                                         return;
 419                         }
 420                 } else {
 421                         if (aniState->firstepLevel > 0) {
 422                                 if (ath9k_hw_ani_control(ah,
 423                                          ATH9K_ANI_FIRSTEP_LEVEL,
 424                                          aniState->firstepLevel - 1) == true)
 425                                         return;
 426                         }
 427                 }
 428         }
 429
 430         if (aniState->spurImmunityLevel > 0) {
 431                 if (ath9k_hw_ani_control(ah, ATH9K_ANI_SPUR_IMMUNITY_LEVEL,
 432                                          aniState->spurImmunityLevel - 1))
 433                         return;
 434         }
 435
 436         if (aniState->noiseImmunityLevel > 0) {
 437                 ath9k_hw_ani_control(ah, ATH9K_ANI_NOISE_IMMUNITY_LEVEL,
 438                                      aniState->noiseImmunityLevel - 1);
 439                 return;
 440         }
 441 }
 442
 443 /*
 444  * only lower either OFDM or CCK errors per turn
 445  * we lower the other one next time
 446  */
 447 static void ath9k_hw_ani_lower_immunity(struct ath_hw *ah)
 448 {
 449         struct ar5416AniState *aniState;
 450
 451         aniState = &ah->curchan->ani;
 452
 453         if (!use_new_ani(ah)) {
 454                 ath9k_hw_ani_lower_immunity_old(ah);
 455                 return;
 456         }
 457
 458         /* lower OFDM noise immunity */
 459         if (aniState->ofdmNoiseImmunityLevel > 0 &&
 460             (aniState->ofdmsTurn || aniState->cckNoiseImmunityLevel == 0)) {
 461                 ath9k_hw_set_ofdm_nil(ah, aniState->ofdmNoiseImmunityLevel - 1);
 462                 return;
 463         }
 464
 465         /* lower CCK noise immunity */
 466         if (aniState->cckNoiseImmunityLevel > 0)
 467                 ath9k_hw_set_cck_nil(ah, aniState->cckNoiseImmunityLevel - 1);
 468 }
 469
 470 static void ath9k_ani_reset_old(struct ath_hw *ah, bool is_scanning)
 471 {
 472         struct ar5416AniState *aniState;
 473         struct ath9k_channel *chan = ah->curchan;
 474         struct ath_common *common = ath9k_hw_common(ah);
 475
 476         if (!DO_ANI(ah))
 477                 return;
 478
 479         aniState = &ah->curchan->ani;
 480
 481         if (ah->opmode != NL80211_IFTYPE_STATION
 482             && ah->opmode != NL80211_IFTYPE_ADHOC) {
 483                 ath_dbg(common, ATH_DBG_ANI,
 484                         "Reset ANI state opmode %u\n", ah->opmode);
 485                 ah->stats.ast_ani_reset++;
 486
 487                 if (ah->opmode == NL80211_IFTYPE_AP) {
 488                         /*
 489                          * ath9k_hw_ani_control() will only process items set on
 490                          * ah->ani_function
 491                          */
 492                         if (IS_CHAN_2GHZ(chan))
 493                                 ah->ani_function = (ATH9K_ANI_SPUR_IMMUNITY_LEVEL |
 494                                                     ATH9K_ANI_FIRSTEP_LEVEL);
 495                         else
 496                                 ah->ani_function = 0;
 497                 }
 498
 499                 ath9k_hw_ani_control(ah, ATH9K_ANI_NOISE_IMMUNITY_LEVEL, 0);
 500                 ath9k_hw_ani_control(ah, ATH9K_ANI_SPUR_IMMUNITY_LEVEL, 0);
 501                 ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL, 0);
 502                 ath9k_hw_ani_control(ah, ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 503                                      !ATH9K_ANI_USE_OFDM_WEAK_SIG);
 504                 ath9k_hw_ani_control(ah, ATH9K_ANI_CCK_WEAK_SIGNAL_THR,
 505                                      ATH9K_ANI_CCK_WEAK_SIG_THR);
 506
 507                 ath9k_ani_restart(ah);
 508                 return;
 509         }
 510
 511         if (aniState->noiseImmunityLevel != 0)
 512                 ath9k_hw_ani_control(ah, ATH9K_ANI_NOISE_IMMUNITY_LEVEL,
 513                                      aniState->noiseImmunityLevel);
 514         if (aniState->spurImmunityLevel != 0)
 515                 ath9k_hw_ani_control(ah, ATH9K_ANI_SPUR_IMMUNITY_LEVEL,
 516                                      aniState->spurImmunityLevel);
 517         if (aniState->ofdmWeakSigDetectOff)
 518                 ath9k_hw_ani_control(ah, ATH9K_ANI_OFDM_WEAK_SIGNAL_DETECTION,
 519                                      !aniState->ofdmWeakSigDetectOff);
 520         if (aniState->cckWeakSigThreshold)
 521                 ath9k_hw_ani_control(ah, ATH9K_ANI_CCK_WEAK_SIGNAL_THR,
 522                                      aniState->cckWeakSigThreshold);
 523         if (aniState->firstepLevel != 0)
 524                 ath9k_hw_ani_control(ah, ATH9K_ANI_FIRSTEP_LEVEL,
 525                                      aniState->firstepLevel);
 526
 527         ath9k_ani_restart(ah);
 528
 529         ENABLE_REGWRITE_BUFFER(ah);
 530
 531         REG_WRITE(ah, AR_PHY_ERR_MASK_1, AR_PHY_ERR_OFDM_TIMING);
 532         REG_WRITE(ah, AR_PHY_ERR_MASK_2, AR_PHY_ERR_CCK_TIMING);
 533
 534         REGWRITE_BUFFER_FLUSH(ah);
 535 }
 536
 537 /*
 538  * Restore the ANI parameters in the HAL and reset the statistics.
 539  * This routine should be called for every hardware reset and for
 540  * every channel change.
 541  */
 542 void ath9k_ani_reset(struct ath_hw *ah, bool is_scanning)
 543 {
 544         struct ar5416AniState *aniState = &ah->curchan->ani;
 545         struct ath9k_channel *chan = ah->curchan;
 546         struct ath_common *common = ath9k_hw_common(ah);
 547
 548         if (!DO_ANI(ah))
 549                 return;
 550
 551         if (!use_new_ani(ah))
 552                 return ath9k_ani_reset_old(ah, is_scanning);
 553
 554         BUG_ON(aniState == NULL);
 555         ah->stats.ast_ani_reset++;
 556
 557         /* only allow a subset of functions in AP mode */
 558         if (ah->opmode == NL80211_IFTYPE_AP) {
 559                 if (IS_CHAN_2GHZ(chan)) {
 560                         ah->ani_function = (ATH9K_ANI_SPUR_IMMUNITY_LEVEL |
 561                                             ATH9K_ANI_FIRSTEP_LEVEL);
 562                         if (AR_SREV_9300_20_OR_LATER(ah))
 563                                 ah->ani_function |= ATH9K_ANI_MRC_CCK;
 564                 } else
 565                         ah->ani_function = 0;
 566         }
 567
 568         /* always allow mode (on/off) to be controlled */
 569         ah->ani_function |= ATH9K_ANI_MODE;
 570
 571         if (is_scanning ||
 572             (ah->opmode != NL80211_IFTYPE_STATION &&
 573              ah->opmode != NL80211_IFTYPE_ADHOC)) {
 574                 /*
 575                  * If we're scanning or in AP mode, the defaults (ini)
 576                  * should be in place. For an AP we assume the historical
 577                  * levels for this channel are probably outdated so start
 578                  * from defaults instead.
 579                  */
 580                 if (aniState->ofdmNoiseImmunityLevel !=
 581                     ATH9K_ANI_OFDM_DEF_LEVEL ||
 582                     aniState->cckNoiseImmunityLevel !=
 583                     ATH9K_ANI_CCK_DEF_LEVEL) {
 584                         ath_dbg(common, ATH_DBG_ANI,
 585                                 "Restore defaults: opmode %u chan %d Mhz/0x%x is_scanning=%d ofdm:%d cck:%d\n",
 586                                 ah->opmode,
 587                                 chan->channel,
 588                                 chan->channelFlags,
 589                                 is_scanning,
 590                                 aniState->ofdmNoiseImmunityLevel,
 591                                 aniState->cckNoiseImmunityLevel);
 592
 593                         aniState->update_ani = false;
 594                         ath9k_hw_set_ofdm_nil(ah, ATH9K_ANI_OFDM_DEF_LEVEL);
 595                         ath9k_hw_set_cck_nil(ah, ATH9K_ANI_CCK_DEF_LEVEL);
 596                 }
 597         } else {
 598                 /*
 599                  * restore historical levels for this channel
 600                  */
 601                 ath_dbg(common, ATH_DBG_ANI,
 602                         "Restore history: opmode %u chan %d Mhz/0x%x is_scanning=%d ofdm:%d cck:%d\n",
 603                         ah->opmode,
 604                         chan->channel,
 605                         chan->channelFlags,
 606                         is_scanning,
 607                         aniState->ofdmNoiseImmunityLevel,
 608                         aniState->cckNoiseImmunityLevel);
 609
 610                         aniState->update_ani = true;
 611                         ath9k_hw_set_ofdm_nil(ah,
 612                                               aniState->ofdmNoiseImmunityLevel);
 613                         ath9k_hw_set_cck_nil(ah,
 614                                              aniState->cckNoiseImmunityLevel);
 615         }
 616
 617         /*
 618          * enable phy counters if hw supports or if not, enable phy
 619          * interrupts (so we can count each one)
 620          */
 621         ath9k_ani_restart(ah);
 622
 623         ENABLE_REGWRITE_BUFFER(ah);
 624
 625         REG_WRITE(ah, AR_PHY_ERR_MASK_1, AR_PHY_ERR_OFDM_TIMING);
 626         REG_WRITE(ah, AR_PHY_ERR_MASK_2, AR_PHY_ERR_CCK_TIMING);
 627
 628         REGWRITE_BUFFER_FLUSH(ah);
 629 }
 630
 631 static bool ath9k_hw_ani_read_counters(struct ath_hw *ah)
 632 {
 633         struct ath_common *common = ath9k_hw_common(ah);
 634         struct ar5416AniState *aniState = &ah->curchan->ani;
 635         u32 ofdm_base = 0;
 636         u32 cck_base = 0;
 637         u32 ofdmPhyErrCnt, cckPhyErrCnt;
 638         u32 phyCnt1, phyCnt2;
 639         int32_t listenTime;
 640
 641         ath_hw_cycle_counters_update(common);
 642         listenTime = ath_hw_get_listen_time(common);
 643
 644         if (listenTime <= 0) {
 645                 ah->stats.ast_ani_lneg_or_lzero++;
 646                 ath9k_ani_restart(ah);
 647                 return false;
 648         }
 649
 650         if (!use_new_ani(ah)) {
 651                 ofdm_base = AR_PHY_COUNTMAX - ah->config.ofdm_trig_high;
 652                 cck_base = AR_PHY_COUNTMAX - ah->config.cck_trig_high;
 653         }
 654
 655         aniState->listenTime += listenTime;
 656
 657         ath9k_hw_update_mibstats(ah, &ah->ah_mibStats);
 658
 659         phyCnt1 = REG_READ(ah, AR_PHY_ERR_1);
 660         phyCnt2 = REG_READ(ah, AR_PHY_ERR_2);
 661
 662         if (!use_new_ani(ah) && (phyCnt1 < ofdm_base || phyCnt2 < cck_base)) {
 663                 if (phyCnt1 < ofdm_base) {
 664                         ath_dbg(common, ATH_DBG_ANI,
 665                                 "phyCnt1 0x%x, resetting counter value to 0x%x\n",
 666                                 phyCnt1, ofdm_base);
 667                         REG_WRITE(ah, AR_PHY_ERR_1, ofdm_base);
 668                         REG_WRITE(ah, AR_PHY_ERR_MASK_1,
 669                                   AR_PHY_ERR_OFDM_TIMING);
 670                 }
 671                 if (phyCnt2 < cck_base) {
 672                         ath_dbg(common, ATH_DBG_ANI,
 673                                 "phyCnt2 0x%x, resetting counter value to 0x%x\n",
 674                                 phyCnt2, cck_base);
 675                         REG_WRITE(ah, AR_PHY_ERR_2, cck_base);
 676                         REG_WRITE(ah, AR_PHY_ERR_MASK_2,
 677                                   AR_PHY_ERR_CCK_TIMING);
 678                 }
 679                 return false;
 680         }
 681
 682         ofdmPhyErrCnt = phyCnt1 - ofdm_base;
 683         ah->stats.ast_ani_ofdmerrs +=
 684                 ofdmPhyErrCnt - aniState->ofdmPhyErrCount;
 685         aniState->ofdmPhyErrCount = ofdmPhyErrCnt;
 686
 687         cckPhyErrCnt = phyCnt2 - cck_base;
 688         ah->stats.ast_ani_cckerrs +=
 689                 cckPhyErrCnt - aniState->cckPhyErrCount;
 690         aniState->cckPhyErrCount = cckPhyErrCnt;
 691         return true;
 692 }
 693
 694 void ath9k_hw_ani_monitor(struct ath_hw *ah, struct ath9k_channel *chan)
 695 {
 696         struct ar5416AniState *aniState;
 697         struct ath_common *common = ath9k_hw_common(ah);
 698         u32 ofdmPhyErrRate, cckPhyErrRate;
 699
 700         if (!DO_ANI(ah))
 701                 return;
 702
 703         aniState = &ah->curchan->ani;
 704         if (WARN_ON(!aniState))
 705                 return;
 706
 707         if (!ath9k_hw_ani_read_counters(ah))
 708                 return;
 709
 710         ofdmPhyErrRate = aniState->ofdmPhyErrCount * 1000 /
 711                          aniState->listenTime;
 712         cckPhyErrRate =  aniState->cckPhyErrCount * 1000 /
 713                          aniState->listenTime;
 714
 715         ath_dbg(common, ATH_DBG_ANI,
 716                 "listenTime=%d OFDM:%d errs=%d/s CCK:%d errs=%d/s ofdm_turn=%d\n",
 717                 aniState->listenTime,
 718                 aniState->ofdmNoiseImmunityLevel,
 719                 ofdmPhyErrRate, aniState->cckNoiseImmunityLevel,
 720                 cckPhyErrRate, aniState->ofdmsTurn);
 721
 722         if (aniState->listenTime > 5 * ah->aniperiod) {
 723                 if (ofdmPhyErrRate <= ah->config.ofdm_trig_low &&
 724                     cckPhyErrRate <= ah->config.cck_trig_low) {
 725                         ath9k_hw_ani_lower_immunity(ah);
 726                         aniState->ofdmsTurn = !aniState->ofdmsTurn;
 727                 }
 728                 ath9k_ani_restart(ah);
 729         } else if (aniState->listenTime > ah->aniperiod) {
 730                 /* check to see if need to raise immunity */
 731                 if (ofdmPhyErrRate > ah->config.ofdm_trig_high &&
 732                     (cckPhyErrRate <= ah->config.cck_trig_high ||
 733                      aniState->ofdmsTurn)) {
 734                         ath9k_hw_ani_ofdm_err_trigger(ah);
 735                         ath9k_ani_restart(ah);
 736                         aniState->ofdmsTurn = false;
 737                 } else if (cckPhyErrRate > ah->config.cck_trig_high) {
 738                         ath9k_hw_ani_cck_err_trigger(ah);
 739                         ath9k_ani_restart(ah);
 740                         aniState->ofdmsTurn = true;
 741                 }
 742         }
 743 }
 744 EXPORT_SYMBOL(ath9k_hw_ani_monitor);
 745
 746 void ath9k_enable_mib_counters(struct ath_hw *ah)
 747 {
 748         struct ath_common *common = ath9k_hw_common(ah);
 749
 750         ath_dbg(common, ATH_DBG_ANI, "Enable MIB counters\n");
 751
 752         ath9k_hw_update_mibstats(ah, &ah->ah_mibStats);
 753
 754         ENABLE_REGWRITE_BUFFER(ah);
 755
 756         REG_WRITE(ah, AR_FILT_OFDM, 0);
 757         REG_WRITE(ah, AR_FILT_CCK, 0);
 758         REG_WRITE(ah, AR_MIBC,
 759                   ~(AR_MIBC_COW | AR_MIBC_FMC | AR_MIBC_CMC | AR_MIBC_MCS)
 760                   & 0x0f);
 761         REG_WRITE(ah, AR_PHY_ERR_MASK_1, AR_PHY_ERR_OFDM_TIMING);
 762         REG_WRITE(ah, AR_PHY_ERR_MASK_2, AR_PHY_ERR_CCK_TIMING);
 763
 764         REGWRITE_BUFFER_FLUSH(ah);
 765 }
 766
 767 /* Freeze the MIB counters, get the stats and then clear them */
 768 void ath9k_hw_disable_mib_counters(struct ath_hw *ah)
 769 {
 770         struct ath_common *common = ath9k_hw_common(ah);
 771
 772         ath_dbg(common, ATH_DBG_ANI, "Disable MIB counters\n");
 773
 774         REG_WRITE(ah, AR_MIBC, AR_MIBC_FMC);
 775         ath9k_hw_update_mibstats(ah, &ah->ah_mibStats);
 776         REG_WRITE(ah, AR_MIBC, AR_MIBC_CMC);
 777         REG_WRITE(ah, AR_FILT_OFDM, 0);
 778         REG_WRITE(ah, AR_FILT_CCK, 0);
 779 }
 780 EXPORT_SYMBOL(ath9k_hw_disable_mib_counters);
 781
 782 /*
 783  * Process a MIB interrupt.  We may potentially be invoked because
 784  * any of the MIB counters overflow/trigger so don't assume we're
 785  * here because a PHY error counter triggered.
 786  */
 787 void ath9k_hw_proc_mib_event(struct ath_hw *ah)
 788 {
 789         u32 phyCnt1, phyCnt2;
 790
 791         /* Reset these counters regardless */
 792         REG_WRITE(ah, AR_FILT_OFDM, 0);
 793         REG_WRITE(ah, AR_FILT_CCK, 0);
 794         if (!(REG_READ(ah, AR_SLP_MIB_CTRL) & AR_SLP_MIB_PENDING))
 795                 REG_WRITE(ah, AR_SLP_MIB_CTRL, AR_SLP_MIB_CLEAR);
 796
 797         /* Clear the mib counters and save them in the stats */
 798         ath9k_hw_update_mibstats(ah, &ah->ah_mibStats);
 799
 800         if (!DO_ANI(ah)) {
 801                 /*
 802                  * We must always clear the interrupt cause by
 803                  * resetting the phy error regs.
 804                  */
 805                 REG_WRITE(ah, AR_PHY_ERR_1, 0);
 806                 REG_WRITE(ah, AR_PHY_ERR_2, 0);
 807                 return;
 808         }
 809
 810         /* NB: these are not reset-on-read */
 811         phyCnt1 = REG_READ(ah, AR_PHY_ERR_1);
 812         phyCnt2 = REG_READ(ah, AR_PHY_ERR_2);
 813         if (((phyCnt1 & AR_MIBCNT_INTRMASK) == AR_MIBCNT_INTRMASK) ||
 814             ((phyCnt2 & AR_MIBCNT_INTRMASK) == AR_MIBCNT_INTRMASK)) {
 815
 816                 if (!use_new_ani(ah))
 817                         ath9k_hw_ani_read_counters(ah);
 818
 819                 /* NB: always restart to insure the h/w counters are reset */
 820                 ath9k_ani_restart(ah);
 821         }
 822 }
 823 EXPORT_SYMBOL(ath9k_hw_proc_mib_event);
 824
 825 void ath9k_hw_ani_setup(struct ath_hw *ah)
 826 {
 827         int i;
 828
 829         static const int totalSizeDesired[] = { -55, -55, -55, -55, -62 };
 830         static const int coarseHigh[] = { -14, -14, -14, -14, -12 };
 831         static const int coarseLow[] = { -64, -64, -64, -64, -70 };
 832         static const int firpwr[] = { -78, -78, -78, -78, -80 };
 833
 834         for (i = 0; i < 5; i++) {
 835                 ah->totalSizeDesired[i] = totalSizeDesired[i];
 836                 ah->coarse_high[i] = coarseHigh[i];
 837                 ah->coarse_low[i] = coarseLow[i];
 838                 ah->firpwr[i] = firpwr[i];
 839         }
 840 }
 841
 842 void ath9k_hw_ani_init(struct ath_hw *ah)
 843 {
 844         struct ath_common *common = ath9k_hw_common(ah);
 845         int i;
 846
 847         ath_dbg(common, ATH_DBG_ANI, "Initialize ANI\n");
 848
 849         if (use_new_ani(ah)) {
 850                 ah->config.ofdm_trig_high = ATH9K_ANI_OFDM_TRIG_HIGH_NEW;
 851                 ah->config.ofdm_trig_low = ATH9K_ANI_OFDM_TRIG_LOW_NEW;
 852
 853                 ah->config.cck_trig_high = ATH9K_ANI_CCK_TRIG_HIGH_NEW;
 854                 ah->config.cck_trig_low = ATH9K_ANI_CCK_TRIG_LOW_NEW;
 855         } else {
 856                 ah->config.ofdm_trig_high = ATH9K_ANI_OFDM_TRIG_HIGH_OLD;
 857                 ah->config.ofdm_trig_low = ATH9K_ANI_OFDM_TRIG_LOW_OLD;
 858
 859                 ah->config.cck_trig_high = ATH9K_ANI_CCK_TRIG_HIGH_OLD;
 860                 ah->config.cck_trig_low = ATH9K_ANI_CCK_TRIG_LOW_OLD;
 861         }
 862
 863         for (i = 0; i < ARRAY_SIZE(ah->channels); i++) {
 864                 struct ath9k_channel *chan = &ah->channels[i];
 865                 struct ar5416AniState *ani = &chan->ani;
 866
 867                 if (use_new_ani(ah)) {
 868                         ani->spurImmunityLevel =
 869                                 ATH9K_ANI_SPUR_IMMUNE_LVL_NEW;
 870
 871                         ani->firstepLevel = ATH9K_ANI_FIRSTEP_LVL_NEW;
 872
 873                         if (AR_SREV_9300_20_OR_LATER(ah))
 874                                 ani->mrcCCKOff =
 875                                         !ATH9K_ANI_ENABLE_MRC_CCK;
 876                         else
 877                                 ani->mrcCCKOff = true;
 878
 879                         ani->ofdmsTurn = true;
 880                 } else {
 881                         ani->spurImmunityLevel =
 882                                 ATH9K_ANI_SPUR_IMMUNE_LVL_OLD;
 883                         ani->firstepLevel = ATH9K_ANI_FIRSTEP_LVL_OLD;
 884
 885                         ani->cckWeakSigThreshold =
 886                                 ATH9K_ANI_CCK_WEAK_SIG_THR;
 887                 }
 888
 889                 ani->rssiThrHigh = ATH9K_ANI_RSSI_THR_HIGH;
 890                 ani->rssiThrLow = ATH9K_ANI_RSSI_THR_LOW;
 891                 ani->ofdmWeakSigDetectOff =
 892                         !ATH9K_ANI_USE_OFDM_WEAK_SIG;
 893                 ani->cckNoiseImmunityLevel = ATH9K_ANI_CCK_DEF_LEVEL;
 894                 ani->ofdmNoiseImmunityLevel = ATH9K_ANI_OFDM_DEF_LEVEL;
 895                 ani->update_ani = false;
 896         }
 897
 898         /*
 899          * since we expect some ongoing maintenance on the tables, let's sanity
 900          * check here default level should not modify INI setting.
 901          */
 902         if (use_new_ani(ah)) {
 903                 ah->aniperiod = ATH9K_ANI_PERIOD_NEW;
 904                 ah->config.ani_poll_interval = ATH9K_ANI_POLLINTERVAL_NEW;
 905         } else {
 906                 ah->aniperiod = ATH9K_ANI_PERIOD_OLD;
 907                 ah->config.ani_poll_interval = ATH9K_ANI_POLLINTERVAL_OLD;
 908         }
 909
 910         if (ah->config.enable_ani)
 911                 ah->proc_phyerr |= HAL_PROCESS_ANI;
 912
 913         ath9k_ani_restart(ah);
 914         ath9k_enable_mib_counters(ah);
 915 }