rt2870_rf.c

   1
   2 /*-
   3  * Copyright (c) 2009-2010 Alexander Egorenkov <egorenar@gmail.com>
   4  * Copyright (c) 2009 Damien Bergamini <damien.bergamini@free.fr>
   5  *
   6  * Permission to use, copy, modify, and distribute this software for any
   7  * purpose with or without fee is hereby granted, provided that the above
   8  * copyright notice and this permission notice appear in all copies.
   9  *
  10  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  11  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  12  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  13  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  14  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  15  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  16  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  17  */
  18
  19 #include "rt2870_rf.h"
  20 #include "rt2870_reg.h"
  21 #include "rt2870_eeprom.h"
  22 #include "rt2870_io.h"
  23 #include "rt2870_debug.h"
  24
  25 /*
  26  * Static variables
  27  */
  28
  29 static const struct rt2870_rf_prog
  30 {
  31         uint8_t chan;
  32         uint32_t r1, r2, r3, r4;
  33 } rt2870_rf_2850[] =
  34 {
  35         {   1, 0x98402ecc, 0x984c0786, 0x9816b455, 0x9800510b },
  36         {   2, 0x98402ecc, 0x984c0786, 0x98168a55, 0x9800519f },
  37         {   3, 0x98402ecc, 0x984c078a, 0x98168a55, 0x9800518b },
  38         {   4, 0x98402ecc, 0x984c078a, 0x98168a55, 0x9800519f },
  39         {   5, 0x98402ecc, 0x984c078e, 0x98168a55, 0x9800518b },
  40         {   6, 0x98402ecc, 0x984c078e, 0x98168a55, 0x9800519f },
  41         {   7, 0x98402ecc, 0x984c0792, 0x98168a55, 0x9800518b },
  42         {   8, 0x98402ecc, 0x984c0792, 0x98168a55, 0x9800519f },
  43         {   9, 0x98402ecc, 0x984c0796, 0x98168a55, 0x9800518b },
  44         {  10, 0x98402ecc, 0x984c0796, 0x98168a55, 0x9800519f },
  45         {  11, 0x98402ecc, 0x984c079a, 0x98168a55, 0x9800518b },
  46         {  12, 0x98402ecc, 0x984c079a, 0x98168a55, 0x9800519f },
  47         {  13, 0x98402ecc, 0x984c079e, 0x98168a55, 0x9800518b },
  48         {  14, 0x98402ecc, 0x984c07a2, 0x98168a55, 0x98005193 },
  49         {  36, 0x98402ecc, 0x984c099a, 0x98158a55, 0x980ed1a3 },
  50         {  38, 0x98402ecc, 0x984c099e, 0x98158a55, 0x980ed193 },
  51         {  40, 0x98402ec8, 0x984c0682, 0x98158a55, 0x980ed183 },
  52         {  44, 0x98402ec8, 0x984c0682, 0x98158a55, 0x980ed1a3 },
  53         {  46, 0x98402ec8, 0x984c0686, 0x98158a55, 0x980ed18b },
  54         {  48, 0x98402ec8, 0x984c0686, 0x98158a55, 0x980ed19b },
  55         {  52, 0x98402ec8, 0x984c068a, 0x98158a55, 0x980ed193 },
  56         {  54, 0x98402ec8, 0x984c068a, 0x98158a55, 0x980ed1a3 },
  57         {  56, 0x98402ec8, 0x984c068e, 0x98158a55, 0x980ed18b },
  58         {  60, 0x98402ec8, 0x984c0692, 0x98158a55, 0x980ed183 },
  59         {  62, 0x98402ec8, 0x984c0692, 0x98158a55, 0x980ed193 },
  60         {  64, 0x98402ec8, 0x984c0692, 0x98158a55, 0x980ed1a3 },
  61         { 100, 0x98402ec8, 0x984c06b2, 0x98178a55, 0x980ed783 },
  62         { 102, 0x98402ec8, 0x985c06b2, 0x98578a55, 0x980ed793 },
  63         { 104, 0x98402ec8, 0x985c06b2, 0x98578a55, 0x980ed1a3 },
  64         { 108, 0x98402ecc, 0x985c0a32, 0x98578a55, 0x980ed193 },
  65         { 110, 0x98402ecc, 0x984c0a36, 0x98178a55, 0x980ed183 },
  66         { 112, 0x98402ecc, 0x984c0a36, 0x98178a55, 0x980ed19b },
  67         { 116, 0x98402ecc, 0x984c0a3a, 0x98178a55, 0x980ed1a3 },
  68         { 118, 0x98402ecc, 0x984c0a3e, 0x98178a55, 0x980ed193 },
  69         { 120, 0x98402ec4, 0x984c0382, 0x98178a55, 0x980ed183 },
  70         { 124, 0x98402ec4, 0x984c0382, 0x98178a55, 0x980ed193 },
  71         { 126, 0x98402ec4, 0x984c0382, 0x98178a55, 0x980ed15b },
  72         { 128, 0x98402ec4, 0x984c0382, 0x98178a55, 0x980ed1a3 },
  73         { 132, 0x98402ec4, 0x984c0386, 0x98178a55, 0x980ed18b },
  74         { 134, 0x98402ec4, 0x984c0386, 0x98178a55, 0x980ed193 },
  75         { 136, 0x98402ec4, 0x984c0386, 0x98178a55, 0x980ed19b },
  76         { 140, 0x98402ec4, 0x984c038a, 0x98178a55, 0x980ed183 },
  77         { 149, 0x98402ec4, 0x984c038a, 0x98178a55, 0x980ed1a7 },
  78         { 151, 0x98402ec4, 0x984c038e, 0x98178a55, 0x980ed187 },
  79         { 153, 0x98402ec4, 0x984c038e, 0x98178a55, 0x980ed18f },
  80         { 157, 0x98402ec4, 0x984c038e, 0x98178a55, 0x980ed19f },
  81         { 159, 0x98402ec4, 0x984c038e, 0x98178a55, 0x980ed1a7 },
  82         { 161, 0x98402ec4, 0x984c0392, 0x98178a55, 0x980ed187 },
  83         { 165, 0x98402ec4, 0x984c0392, 0x98178a55, 0x980ed197 },
  84         { 184, 0x95002ccc, 0x9500491e, 0x9509be55, 0x950c0a0b },
  85         { 188, 0x95002ccc, 0x95004922, 0x9509be55, 0x950c0a13 },
  86         { 192, 0x95002ccc, 0x95004926, 0x9509be55, 0x950c0a1b },
  87         { 196, 0x95002ccc, 0x9500492a, 0x9509be55, 0x950c0a23 },
  88         { 208, 0x95002ccc, 0x9500493a, 0x9509be55, 0x950c0a13 },
  89         { 212, 0x95002ccc, 0x9500493e, 0x9509be55, 0x950c0a1b },
  90         { 216, 0x95002ccc, 0x95004982, 0x9509be55, 0x950c0a23 },
  91 };
  92
  93 /*
  94  * rt2870_rf_name
  95  */
  96 const char *rt2870_rf_name(int rf_rev)
  97 {
  98         switch (rf_rev)
  99         {
 100                 case RT2870_EEPROM_RF_2820:
 101                         return "RT2820";
 102
 103                 case RT2870_EEPROM_RF_2850:
 104                         return "RT2850";
 105
 106                 case RT2870_EEPROM_RF_2720:
 107                         return "RT2720";
 108
 109                 case RT2870_EEPROM_RF_2750:
 110                         return "RT2750";
 111
 112                 case RT2870_EEPROM_RF_3020:
 113                         return "RT3020";
 114
 115                 case RT2870_EEPROM_RF_2020:
 116                         return "RT2020";
 117
 118                 default:
 119                         return "unknown";
 120         }
 121 }
 122
 123 /*
 124  * rt2870_rf_select_chan_group
 125  */
 126 void rt2870_rf_select_chan_group(struct rt2870_softc *sc,
 127         struct ieee80211_channel *c)
 128 {
 129         struct ieee80211com *ic;
 130         int chan, group;
 131         uint32_t tmp;
 132
 133         ic = &sc->ic;
 134
 135         chan = ieee80211_chan2ieee(ic, c);
 136         if (chan == 0 || chan == IEEE80211_CHAN_ANY)
 137                 return;
 138
 139         if (chan <= 14)
 140                 group = 0;
 141         else if (chan <= 64)
 142                 group = 1;
 143         else if (chan <= 128)
 144                 group = 2;
 145         else
 146                 group = 3;
 147
 148         rt2870_io_bbp_write(sc, 62, 0x37 - sc->lna_gain[group]);
 149         rt2870_io_bbp_write(sc, 63, 0x37 - sc->lna_gain[group]);
 150         rt2870_io_bbp_write(sc, 64, 0x37 - sc->lna_gain[group]);
 151         rt2870_io_bbp_write(sc, 86, 0x00);
 152
 153         if (group == 0)
 154         {
 155                 if (sc->ext_lna_2ghz)
 156                 {
 157                         rt2870_io_bbp_write(sc, 82, 0x62);
 158                         rt2870_io_bbp_write(sc, 75, 0x46);
 159                 }
 160                 else
 161                 {
 162                         rt2870_io_bbp_write(sc, 82, 0x84);
 163                         rt2870_io_bbp_write(sc, 75, 0x50);
 164                 }
 165         }
 166         else
 167         {
 168                 rt2870_io_bbp_write(sc, 82, 0xf2);
 169
 170                 if (sc->ext_lna_5ghz)
 171                         rt2870_io_bbp_write(sc, 75, 0x46);
 172                 else
 173                         rt2870_io_bbp_write(sc, 75, 0x50);
 174         }
 175
 176         if (group == 0)
 177         {
 178                 tmp = 0x2e + sc->lna_gain[group];
 179         }
 180         else
 181         {
 182                 if ((ic->ic_flags & IEEE80211_F_SCAN) || !IEEE80211_IS_CHAN_HT40(c))
 183                         tmp = 0x32 + sc->lna_gain[group] * 5 / 3;
 184                 else
 185                         tmp = 0x3a + sc->lna_gain[group] * 5 / 3;
 186         }
 187
 188         rt2870_io_bbp_write(sc, 66, tmp);
 189
 190         tmp = RT2870_REG_RFTR_ENABLE |
 191                 RT2870_REG_TRSW_ENABLE |
 192                 RT2870_REG_LNA_PE_G1_ENABLE |
 193                 RT2870_REG_LNA_PE_A1_ENABLE |
 194                 RT2870_REG_LNA_PE_G0_ENABLE |
 195                 RT2870_REG_LNA_PE_A0_ENABLE;
 196
 197         if (group == 0)
 198                 tmp |= RT2870_REG_PA_PE_G1_ENABLE |
 199                         RT2870_REG_PA_PE_G0_ENABLE;
 200         else
 201                 tmp |= RT2870_REG_PA_PE_A1_ENABLE |
 202                         RT2870_REG_PA_PE_A0_ENABLE;
 203
 204         if (sc->ntxpath == 1)
 205                 tmp &= ~(RT2870_REG_PA_PE_G1_ENABLE | RT2870_REG_PA_PE_A1_ENABLE);
 206
 207         if (sc->nrxpath == 1)
 208                 tmp &= ~(RT2870_REG_LNA_PE_G1_ENABLE | RT2870_REG_LNA_PE_A1_ENABLE);
 209
 210         rt2870_io_mac_write(sc, RT2870_REG_TX_PIN_CFG, tmp);
 211
 212         tmp = rt2870_io_mac_read(sc, RT2870_REG_TX_BAND_CFG);
 213
 214         tmp &= ~(RT2870_REG_TX_BAND_BG | RT2870_REG_TX_BAND_A | RT2870_REG_TX_BAND_HT40_ABOVE);
 215
 216         if (group == 0)
 217                 tmp |= RT2870_REG_TX_BAND_BG;
 218         else
 219                 tmp |= RT2870_REG_TX_BAND_A;
 220
 221         /* set central channel position */
 222
 223         if (IEEE80211_IS_CHAN_HT40U(c))
 224                 tmp |= RT2870_REG_TX_BAND_HT40_BELOW;
 225         else if (IEEE80211_IS_CHAN_HT40D(c))
 226                 tmp |= RT2870_REG_TX_BAND_HT40_ABOVE;
 227         else
 228                 tmp |= RT2870_REG_TX_BAND_HT40_BELOW;
 229
 230         rt2870_io_mac_write(sc, RT2870_REG_TX_BAND_CFG, tmp);
 231
 232         /* set bandwidth (20MHz or 40MHz) */
 233
 234         tmp = rt2870_io_bbp_read(sc, 4);
 235
 236         tmp &= ~0x18;
 237
 238         if (IEEE80211_IS_CHAN_HT40(c))
 239                 tmp |= 0x10;
 240
 241         rt2870_io_bbp_write(sc, 4, tmp);
 242
 243         /* set central channel position */
 244
 245         tmp = rt2870_io_bbp_read(sc, 3);
 246
 247         tmp &= ~0x20;
 248
 249         if (IEEE80211_IS_CHAN_HT40D(c))
 250                 tmp |= 0x20;
 251
 252         rt2870_io_bbp_write(sc, 3, tmp);
 253
 254         if (sc->mac_rev == 0x28600100)
 255         {
 256                 if (!IEEE80211_IS_CHAN_HT40(c))
 257                 {
 258                         rt2870_io_bbp_write(sc, 69, 0x16);
 259                         rt2870_io_bbp_write(sc, 70, 0x08);
 260                         rt2870_io_bbp_write(sc, 73, 0x12);
 261                 }
 262                 else
 263                 {
 264                         rt2870_io_bbp_write(sc, 69, 0x1a);
 265                         rt2870_io_bbp_write(sc, 70, 0x0a);
 266                         rt2870_io_bbp_write(sc, 73, 0x16);
 267                 }
 268         }
 269 }
 270
 271 /*
 272  * rt2870_rf_set_chan
 273  */
 274 void rt2870_rf_set_chan(struct rt2870_softc *sc,
 275         struct ieee80211_channel *c)
 276 {
 277         struct ieee80211com *ic;
 278         const struct rt2870_rf_prog *prog;
 279         uint32_t r1, r2, r3, r4;
 280         int8_t txpow1, txpow2;
 281         int i, chan;
 282
 283         ic = &sc->ic;
 284         prog = rt2870_rf_2850;
 285
 286         /* get central channel position */
 287
 288         chan = ieee80211_chan2ieee(ic, c);
 289
 290         if (IEEE80211_IS_CHAN_HT40U(c))
 291                 chan += 2;
 292         else if (IEEE80211_IS_CHAN_HT40D(c))
 293                 chan -= 2;
 294
 295         RT2870_DPRINTF(sc, RT2870_DEBUG_CHAN,
 296                 "%s: RF set channel: channel=%u, HT%s%s\n",
 297                 device_get_nameunit(sc->dev),
 298                 ieee80211_chan2ieee(ic, c),
 299                 !IEEE80211_IS_CHAN_HT(c) ? " disabled" :
 300                         IEEE80211_IS_CHAN_HT20(c) ? "20":
 301                                 IEEE80211_IS_CHAN_HT40U(c) ? "40U" : "40D",
 302                 (ic->ic_flags & IEEE80211_F_SCAN) ? ", scanning" : "");
 303
 304         if (chan == 0 || chan == IEEE80211_CHAN_ANY)
 305                 return;
 306
 307         for (i = 0; prog[i].chan != chan; i++);
 308
 309         r1 = prog[i].r1;
 310         r2 = prog[i].r2;
 311         r3 = prog[i].r3;
 312         r4 = prog[i].r4;
 313
 314         txpow1 = sc->txpow1[i];
 315         txpow2 = sc->txpow2[i];
 316
 317         if (sc->ntxpath == 1)
 318                 r2 |= (1 << 14);
 319
 320         if (sc->nrxpath == 2)
 321                 r2 |= (1 << 6);
 322         else if (sc->nrxpath == 1)
 323                 r2 |= (1 << 17) | (1 << 6);
 324
 325         if (IEEE80211_IS_CHAN_2GHZ(c))
 326         {
 327                 r3 = (r3 & 0xffffc1ff) | (txpow1 << 9);
 328                 r4 = (r4 & ~0x001f87c0) | (sc->rf_freq_off << 15) | (txpow2 << 6);
 329         }
 330         else
 331         {
 332                 r3 = r3 & 0xffffc1ff;
 333                 r4 = (r4 & ~0x001f87c0) | (sc->rf_freq_off << 15);
 334
 335                 if (txpow1 >= RT2870_EEPROM_TXPOW_5GHZ_MIN && txpow1 < 0)
 336                 {
 337                         txpow1 = (-RT2870_EEPROM_TXPOW_5GHZ_MIN + txpow1);
 338                         if (txpow1 > RT2870_EEPROM_TXPOW_5GHZ_MAX)
 339                                 txpow1 = RT2870_EEPROM_TXPOW_5GHZ_MAX;
 340
 341                         r3 |= (txpow1 << 10);
 342                 }
 343                 else
 344                 {
 345                         if (txpow1 > RT2870_EEPROM_TXPOW_5GHZ_MAX)
 346                                 txpow1 = RT2870_EEPROM_TXPOW_5GHZ_MAX;
 347
 348                         r3 |= (txpow1 << 10) | (1 << 9);
 349                 }
 350
 351                 if (txpow2 >= RT2870_EEPROM_TXPOW_5GHZ_MIN && txpow2 < 0)
 352                 {
 353                         txpow2 = (-RT2870_EEPROM_TXPOW_5GHZ_MIN + txpow2);
 354                         if (txpow2 > RT2870_EEPROM_TXPOW_5GHZ_MAX)
 355                                 txpow2 = RT2870_EEPROM_TXPOW_5GHZ_MAX;
 356
 357                         r4 |= (txpow2 << 7);
 358                 }
 359                 else
 360                 {
 361                         if (txpow2 > RT2870_EEPROM_TXPOW_5GHZ_MAX)
 362                                 txpow2 = RT2870_EEPROM_TXPOW_5GHZ_MAX;
 363
 364                         r4 |= (txpow2 << 7) | (1 << 6);
 365                 }
 366         }
 367
 368         if (!(ic->ic_flags & IEEE80211_F_SCAN) && IEEE80211_IS_CHAN_HT40(c))
 369                 r4 |= (1 << 21);
 370
 371         rt2870_io_rf_write(sc, RT2870_REG_RF_R1, r1);
 372         rt2870_io_rf_write(sc, RT2870_REG_RF_R2, r2);
 373         rt2870_io_rf_write(sc, RT2870_REG_RF_R3, r3 & ~(1 << 2));
 374         rt2870_io_rf_write(sc, RT2870_REG_RF_R4, r4);
 375
 376         DELAY(200);
 377
 378         rt2870_io_rf_write(sc, RT2870_REG_RF_R1, r1);
 379         rt2870_io_rf_write(sc, RT2870_REG_RF_R2, r2);
 380         rt2870_io_rf_write(sc, RT2870_REG_RF_R3, r3 | (1 << 2));
 381         rt2870_io_rf_write(sc, RT2870_REG_RF_R4, r4);
 382
 383         DELAY(200);
 384
 385         rt2870_io_rf_write(sc, RT2870_REG_RF_R1, r1);
 386         rt2870_io_rf_write(sc, RT2870_REG_RF_R2, r2);
 387         rt2870_io_rf_write(sc, RT2870_REG_RF_R3, r3 & ~(1 << 2));
 388         rt2870_io_rf_write(sc, RT2870_REG_RF_R4, r4);
 389
 390         sc->sifs = IEEE80211_IS_CHAN_5GHZ(c) ? 16 : 10;
 391
 392         rt2870_rf_select_chan_group(sc, c);
 393
 394         DELAY(1000);
 395 }