drivers/net/wireless/b43/nphy.c

   1 /*
   2
   3   Broadcom B43 wireless driver
   4   IEEE 802.11n PHY support
   5
   6   Copyright (c) 2008 Michael Buesch <mb@bu3sch.de>
   7
   8   This program is free software; you can redistribute it and/or modify
   9   it under the terms of the GNU General Public License as published by
  10   the Free Software Foundation; either version 2 of the License, or
  11   (at your option) any later version.
  12
  13   This program is distributed in the hope that it will be useful,
  14   but WITHOUT ANY WARRANTY; without even the implied warranty of
  15   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16   GNU General Public License for more details.
  17
  18   You should have received a copy of the GNU General Public License
  19   along with this program; see the file COPYING.  If not, write to
  20   the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
  21   Boston, MA 02110-1301, USA.
  22
  23 */
  24
  25 #include "b43.h"
  26 #include "nphy.h"
  27 #include "tables_nphy.h"
  28
  29
  30 void b43_nphy_set_rxantenna(struct b43_wldev *dev, int antenna)
  31 {//TODO
  32 }
  33
  34 void b43_nphy_xmitpower(struct b43_wldev *dev)
  35 {//TODO
  36 }
  37
  38 static void b43_chantab_radio_upload(struct b43_wldev *dev,
  39                                      const struct b43_nphy_channeltab_entry *e)
  40 {
  41         b43_radio_write16(dev, B2055_PLL_REF, e->radio_pll_ref);
  42         b43_radio_write16(dev, B2055_RF_PLLMOD0, e->radio_rf_pllmod0);
  43         b43_radio_write16(dev, B2055_RF_PLLMOD1, e->radio_rf_pllmod1);
  44         b43_radio_write16(dev, B2055_VCO_CAPTAIL, e->radio_vco_captail);
  45         b43_radio_write16(dev, B2055_VCO_CAL1, e->radio_vco_cal1);
  46         b43_radio_write16(dev, B2055_VCO_CAL2, e->radio_vco_cal2);
  47         b43_radio_write16(dev, B2055_PLL_LFC1, e->radio_pll_lfc1);
  48         b43_radio_write16(dev, B2055_PLL_LFR1, e->radio_pll_lfr1);
  49         b43_radio_write16(dev, B2055_PLL_LFC2, e->radio_pll_lfc2);
  50         b43_radio_write16(dev, B2055_LGBUF_CENBUF, e->radio_lgbuf_cenbuf);
  51         b43_radio_write16(dev, B2055_LGEN_TUNE1, e->radio_lgen_tune1);
  52         b43_radio_write16(dev, B2055_LGEN_TUNE2, e->radio_lgen_tune2);
  53         b43_radio_write16(dev, B2055_C1_LGBUF_ATUNE, e->radio_c1_lgbuf_atune);
  54         b43_radio_write16(dev, B2055_C1_LGBUF_GTUNE, e->radio_c1_lgbuf_gtune);
  55         b43_radio_write16(dev, B2055_C1_RX_RFR1, e->radio_c1_rx_rfr1);
  56         b43_radio_write16(dev, B2055_C1_TX_PGAPADTN, e->radio_c1_tx_pgapadtn);
  57         b43_radio_write16(dev, B2055_C1_TX_MXBGTRIM, e->radio_c1_tx_mxbgtrim);
  58         b43_radio_write16(dev, B2055_C2_LGBUF_ATUNE, e->radio_c2_lgbuf_atune);
  59         b43_radio_write16(dev, B2055_C2_LGBUF_GTUNE, e->radio_c2_lgbuf_gtune);
  60         b43_radio_write16(dev, B2055_C2_RX_RFR1, e->radio_c2_rx_rfr1);
  61         b43_radio_write16(dev, B2055_C2_TX_PGAPADTN, e->radio_c2_tx_pgapadtn);
  62         b43_radio_write16(dev, B2055_C2_TX_MXBGTRIM, e->radio_c2_tx_mxbgtrim);
  63 }
  64
  65 static void b43_chantab_phy_upload(struct b43_wldev *dev,
  66                                    const struct b43_nphy_channeltab_entry *e)
  67 {
  68         b43_phy_write(dev, B43_NPHY_BW1A, e->phy_bw1a);
  69         b43_phy_write(dev, B43_NPHY_BW2, e->phy_bw2);
  70         b43_phy_write(dev, B43_NPHY_BW3, e->phy_bw3);
  71         b43_phy_write(dev, B43_NPHY_BW4, e->phy_bw4);
  72         b43_phy_write(dev, B43_NPHY_BW5, e->phy_bw5);
  73         b43_phy_write(dev, B43_NPHY_BW6, e->phy_bw6);
  74 }
  75
  76 static void b43_nphy_tx_power_fix(struct b43_wldev *dev)
  77 {
  78         //TODO
  79 }
  80
  81 /* Tune the hardware to a new channel. Don't call this directly.
  82  * Use b43_radio_selectchannel() */
  83 int b43_nphy_selectchannel(struct b43_wldev *dev, u8 channel)
  84 {
  85         const struct b43_nphy_channeltab_entry *tabent;
  86
  87         tabent = b43_nphy_get_chantabent(dev, channel);
  88         if (!tabent)
  89                 return -ESRCH;
  90
  91         //FIXME enable/disable band select upper20 in RXCTL
  92         if (0 /*FIXME 5Ghz*/)
  93                 b43_radio_maskset(dev, B2055_MASTER1, 0xFF8F, 0x20);
  94         else
  95                 b43_radio_maskset(dev, B2055_MASTER1, 0xFF8F, 0x50);
  96         b43_chantab_radio_upload(dev, tabent);
  97         udelay(50);
  98         b43_radio_write16(dev, B2055_VCO_CAL10, 5);
  99         b43_radio_write16(dev, B2055_VCO_CAL10, 45);
 100         b43_radio_write16(dev, B2055_VCO_CAL10, 65);
 101         udelay(300);
 102         if (0 /*FIXME 5Ghz*/)
 103                 b43_phy_set(dev, B43_NPHY_BANDCTL, B43_NPHY_BANDCTL_5GHZ);
 104         else
 105                 b43_phy_mask(dev, B43_NPHY_BANDCTL, ~B43_NPHY_BANDCTL_5GHZ);
 106         b43_chantab_phy_upload(dev, tabent);
 107         b43_nphy_tx_power_fix(dev);
 108
 109         return 0;
 110 }
 111
 112 static void b43_radio_init2055_pre(struct b43_wldev *dev)
 113 {
 114         b43_phy_mask(dev, B43_NPHY_RFCTL_CMD,
 115                      ~B43_NPHY_RFCTL_CMD_PORFORCE);
 116         b43_phy_set(dev, B43_NPHY_RFCTL_CMD,
 117                     B43_NPHY_RFCTL_CMD_CHIP0PU |
 118                     B43_NPHY_RFCTL_CMD_OEPORFORCE);
 119         b43_phy_set(dev, B43_NPHY_RFCTL_CMD,
 120                     B43_NPHY_RFCTL_CMD_PORFORCE);
 121 }
 122
 123 static void b43_radio_init2055_post(struct b43_wldev *dev)
 124 {
 125         struct ssb_sprom *sprom = &(dev->dev->bus->sprom);
 126         struct ssb_boardinfo *binfo = &(dev->dev->bus->boardinfo);
 127         int i;
 128         u16 val;
 129
 130         b43_radio_mask(dev, B2055_MASTER1, 0xFFF3);
 131         msleep(1);
 132         if ((sprom->revision != 4) || !(sprom->boardflags_hi & 0x0002)) {
 133                 if ((binfo->vendor != PCI_VENDOR_ID_BROADCOM) ||
 134                     (binfo->type != 0x46D) ||
 135                     (binfo->rev < 0x41)) {
 136                         b43_radio_mask(dev, B2055_C1_RX_BB_REG, 0x7F);
 137                         b43_radio_mask(dev, B2055_C1_RX_BB_REG, 0x7F);
 138                         msleep(1);
 139                 }
 140         }
 141         b43_radio_maskset(dev, B2055_RRCCAL_NOPTSEL, 0x3F, 0x2C);
 142         msleep(1);
 143         b43_radio_write16(dev, B2055_CAL_MISC, 0x3C);
 144         msleep(1);
 145         b43_radio_mask(dev, B2055_CAL_MISC, 0xFFBE);
 146         msleep(1);
 147         b43_radio_set(dev, B2055_CAL_LPOCTL, 0x80);
 148         msleep(1);
 149         b43_radio_set(dev, B2055_CAL_MISC, 0x1);
 150         msleep(1);
 151         b43_radio_set(dev, B2055_CAL_MISC, 0x40);
 152         msleep(1);
 153         for (i = 0; i < 100; i++) {
 154                 val = b43_radio_read16(dev, B2055_CAL_COUT2);
 155                 if (val & 0x80)
 156                         break;
 157                 udelay(10);
 158         }
 159         msleep(1);
 160         b43_radio_mask(dev, B2055_CAL_LPOCTL, 0xFF7F);
 161         msleep(1);
 162         b43_radio_selectchannel(dev, dev->phy.channel, 0);
 163         b43_radio_write16(dev, B2055_C1_RX_BB_LPF, 0x9);
 164         b43_radio_write16(dev, B2055_C2_RX_BB_LPF, 0x9);
 165         b43_radio_write16(dev, B2055_C1_RX_BB_MIDACHP, 0x83);
 166         b43_radio_write16(dev, B2055_C2_RX_BB_MIDACHP, 0x83);
 167 }
 168
 169 /* Initialize a Broadcom 2055 N-radio */
 170 static void b43_radio_init2055(struct b43_wldev *dev)
 171 {
 172         b43_radio_init2055_pre(dev);
 173         if (b43_status(dev) < B43_STAT_INITIALIZED)
 174                 b2055_upload_inittab(dev, 0, 1);
 175         else
 176                 b2055_upload_inittab(dev, 0/*FIXME on 5ghz band*/, 0);
 177         b43_radio_init2055_post(dev);
 178 }
 179
 180 void b43_nphy_radio_turn_on(struct b43_wldev *dev)
 181 {
 182         b43_radio_init2055(dev);
 183 }
 184
 185 void b43_nphy_radio_turn_off(struct b43_wldev *dev)
 186 {
 187         b43_phy_mask(dev, B43_NPHY_RFCTL_CMD,
 188                      ~B43_NPHY_RFCTL_CMD_EN);
 189 }
 190
 191 int b43_phy_initn(struct b43_wldev *dev)
 192 {
 193         b43err(dev->wl, "IEEE 802.11n devices are not supported, yet.\n");
 194
 195         return 0;
 196 }