6 files changed, 204 insertions, 39 deletions

diff --git a/drivers/net/wireless/rt2x00/rt2800.h b/drivers/net/wireless/rt2x00/rt2800.h
index 2571a2fa3d09..06acabd02984 100644
--- a/drivers/net/wireless/rt2x00/rt2800.h
+++ b/drivers/net/wireless/rt2x00/rt2800.h
@@ -1796,6 +1796,14 @@ struct mac_iveiv_entry {
 #define RFCSR2_RESCAL_EN                FIELD8(0x80)
 
 /*
+ * RFCSR 3:
+ */
+#define RFCSR3_K                        FIELD8(0x0f)
+/* Bits [7-4] for RF3320 (RT3370/RT3390), on other chipsets reserved */
+#define RFCSR3_PA1_BIAS_CCK             FIELD8(0x70);
+#define RFCSR3_PA2_CASCODE_BIAS_CCKK    FIELD8(0x80);
+
+/*
  * FRCSR 5:
  */
 #define RFCSR5_R1                       FIELD8(0x0c)
@@ -1811,10 +1819,12 @@ struct mac_iveiv_entry {
  * RFCSR 7:
  */
 #define RFCSR7_RF_TUNING                FIELD8(0x01)
-#define RFCSR7_R02                              FIELD8(0x07)
-#define RFCSR7_R3                               FIELD8(0x08)
-#define RFCSR7_R45                              FIELD8(0x30)
-#define RFCSR7_R67                              FIELD8(0xc0)
+#define RFCSR7_BIT1                     FIELD8(0x02)
+#define RFCSR7_BIT2                     FIELD8(0x04)
+#define RFCSR7_BIT3                     FIELD8(0x08)
+#define RFCSR7_BIT4                     FIELD8(0x10)
+#define RFCSR7_BIT5                     FIELD8(0x20)
+#define RFCSR7_BITS67                   FIELD8(0xc0)
 
 /*
  * RFCSR 11:
@@ -1839,6 +1849,11 @@ struct mac_iveiv_entry {
 #define RFCSR15_TX_LO2_EN               FIELD8(0x08)
 
 /*
+ * RFCSR 16:
+ */
+#define RFCSR16_TXMIXER_GAIN            FIELD8(0x07)
+
+/*
  * RFCSR 17:
  */
 #define RFCSR17_TXMIXER_GAIN            FIELD8(0x07)
@@ -1867,6 +1882,13 @@ struct mac_iveiv_entry {
 #define RFCSR23_FREQ_OFFSET             FIELD8(0x7f)
 
 /*
+ * RFCSR 24:
+ */
+#define RFCSR24_TX_AGC_FC               FIELD8(0x1f)
+#define RFCSR24_TX_H20M                 FIELD8(0x20)
+#define RFCSR24_TX_CALIB                FIELD8(0x7f)
+
+/*
  * RFCSR 27:
  */
 #define RFCSR27_R1                      FIELD8(0x03)
@@ -1887,6 +1909,7 @@ struct mac_iveiv_entry {
  */
 #define RFCSR31_RX_AGC_FC               FIELD8(0x1f)
 #define RFCSR31_RX_H20M                 FIELD8(0x20)
+#define RFCSR31_RX_CALIB                FIELD8(0x7f)
 
 /*
  * RFCSR 38:
@@ -2093,6 +2116,12 @@ struct mac_iveiv_entry {
 #define EEPROM_RSSI_A2_LNA_A2           FIELD16(0xff00)
 
 /*
+ * EEPROM TXMIXER GAIN A offset (note overlaps with EEPROM RSSI A2).
+ */
+#define EEPROM_TXMIXER_GAIN_A           0x0026
+#define EEPROM_TXMIXER_GAIN_A_VAL       FIELD16(0x0007)
+
+/*
  * EEPROM EIRP Maximum TX power values(unit: dbm)
  */
 #define EEPROM_EIRP_MAX_TX_POWER        0x0027
@@ -2422,4 +2451,16 @@ struct mac_iveiv_entry {
  */
 #define EIRP_MAX_TX_POWER_LIMIT 0x50
 
+/*
+ * RT2800 driver data structure
+ */
+struct rt2800_drv_data {
+        u8 calibration_bw20;
+        u8 calibration_bw40;
+        u8 bbp25;
+        u8 bbp26;
+        u8 txmixer_gain_24g;
+        u8 txmixer_gain_5g;
+};
+
 #endif /* RT2800_H */
diff --git a/drivers/net/wireless/rt2x00/rt2800lib.c b/drivers/net/wireless/rt2x00/rt2800lib.c
index dbe7ece862f2..772d4aec303a 100644
--- a/drivers/net/wireless/rt2x00/rt2800lib.c
+++ b/drivers/net/wireless/rt2x00/rt2800lib.c
@@ -1645,10 +1645,14 @@ static void rt2800_config_channel_rf3xxx(struct rt2x00_dev *rt2x00dev,
                                          struct rf_channel *rf,
                                          struct channel_info *info)
 {
-        u8 rfcsr;
+        struct rt2800_drv_data *drv_data = rt2x00dev->drv_data;
+        u8 rfcsr, calib_tx, calib_rx;
 
         rt2800_rfcsr_write(rt2x00dev, 2, rf->rf1);
-        rt2800_rfcsr_write(rt2x00dev, 3, rf->rf3);
+
+        rt2800_rfcsr_read(rt2x00dev, 3, &rfcsr);
+        rt2x00_set_field8(&rfcsr, RFCSR3_K, rf->rf3);
+        rt2800_rfcsr_write(rt2x00dev, 3, rfcsr);
 
         rt2800_rfcsr_read(rt2x00dev, 6, &rfcsr);
         rt2x00_set_field8(&rfcsr, RFCSR6_R1, rf->rf2);
@@ -1662,16 +1666,82 @@ static void rt2800_config_channel_rf3xxx(struct rt2x00_dev *rt2x00dev,
         rt2x00_set_field8(&rfcsr, RFCSR13_TX_POWER, info->default_power2);
         rt2800_rfcsr_write(rt2x00dev, 13, rfcsr);
 
+        rt2800_rfcsr_read(rt2x00dev, 1, &rfcsr);
+        rt2x00_set_field8(&rfcsr, RFCSR1_RX0_PD, 0);
+        rt2x00_set_field8(&rfcsr, RFCSR1_TX0_PD, 0);
+        if (rt2x00_rt(rt2x00dev, RT3390)) {
+                rt2x00_set_field8(&rfcsr, RFCSR1_RX1_PD,
+                                  rt2x00dev->default_ant.rx_chain_num == 1);
+                rt2x00_set_field8(&rfcsr, RFCSR1_TX1_PD,
+                                  rt2x00dev->default_ant.tx_chain_num == 1);
+        } else {
+                rt2x00_set_field8(&rfcsr, RFCSR1_RX1_PD, 0);
+                rt2x00_set_field8(&rfcsr, RFCSR1_TX1_PD, 0);
+                rt2x00_set_field8(&rfcsr, RFCSR1_RX2_PD, 0);
+                rt2x00_set_field8(&rfcsr, RFCSR1_TX2_PD, 0);
+
+                switch (rt2x00dev->default_ant.tx_chain_num) {
+                case 1:
+                        rt2x00_set_field8(&rfcsr, RFCSR1_TX1_PD, 1);
+                        /* fall through */
+                case 2:
+                        rt2x00_set_field8(&rfcsr, RFCSR1_TX2_PD, 1);
+                        break;
+                }
+
+                switch (rt2x00dev->default_ant.rx_chain_num) {
+                case 1:
+                        rt2x00_set_field8(&rfcsr, RFCSR1_RX1_PD, 1);
+                        /* fall through */
+                case 2:
+                        rt2x00_set_field8(&rfcsr, RFCSR1_RX2_PD, 1);
+                        break;
+                }
+        }
+        rt2800_rfcsr_write(rt2x00dev, 1, rfcsr);
+
+        rt2800_rfcsr_read(rt2x00dev, 30, &rfcsr);
+        rt2x00_set_field8(&rfcsr, RFCSR30_RF_CALIBRATION, 1);
+        rt2800_rfcsr_write(rt2x00dev, 30, rfcsr);
+        msleep(1);
+        rt2x00_set_field8(&rfcsr, RFCSR30_RF_CALIBRATION, 0);
+        rt2800_rfcsr_write(rt2x00dev, 30, rfcsr);
+
         rt2800_rfcsr_read(rt2x00dev, 23, &rfcsr);
         rt2x00_set_field8(&rfcsr, RFCSR23_FREQ_OFFSET, rt2x00dev->freq_offset);
         rt2800_rfcsr_write(rt2x00dev, 23, rfcsr);
 
-        rt2800_rfcsr_write(rt2x00dev, 24,
-                              rt2x00dev->calibration[conf_is_ht40(conf)]);
+        if (rt2x00_rt(rt2x00dev, RT3390)) {
+                calib_tx = conf_is_ht40(conf) ? 0x68 : 0x4f;
+                calib_rx = conf_is_ht40(conf) ? 0x6f : 0x4f;
+        } else {
+                if (conf_is_ht40(conf)) {
+                        calib_tx = drv_data->calibration_bw40;
+                        calib_rx = drv_data->calibration_bw40;
+                } else {
+                        calib_tx = drv_data->calibration_bw20;
+                        calib_rx = drv_data->calibration_bw20;
+                }
+        }
+
+        rt2800_rfcsr_read(rt2x00dev, 24, &rfcsr);
+        rt2x00_set_field8(&rfcsr, RFCSR24_TX_CALIB, calib_tx);
+        rt2800_rfcsr_write(rt2x00dev, 24, rfcsr);
+
+        rt2800_rfcsr_read(rt2x00dev, 31, &rfcsr);
+        rt2x00_set_field8(&rfcsr, RFCSR31_RX_CALIB, calib_rx);
+        rt2800_rfcsr_write(rt2x00dev, 31, rfcsr);
 
         rt2800_rfcsr_read(rt2x00dev, 7, &rfcsr);
         rt2x00_set_field8(&rfcsr, RFCSR7_RF_TUNING, 1);
         rt2800_rfcsr_write(rt2x00dev, 7, rfcsr);
+
+        rt2800_rfcsr_read(rt2x00dev, 30, &rfcsr);
+        rt2x00_set_field8(&rfcsr, RFCSR30_RF_CALIBRATION, 1);
+        rt2800_rfcsr_write(rt2x00dev, 30, rfcsr);
+        msleep(1);
+        rt2x00_set_field8(&rfcsr, RFCSR30_RF_CALIBRATION, 0);
+        rt2800_rfcsr_write(rt2x00dev, 30, rfcsr);
 }
 
 static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
@@ -1679,12 +1749,13 @@ static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
                                          struct rf_channel *rf,
                                          struct channel_info *info)
 {
+        struct rt2800_drv_data *drv_data = rt2x00dev->drv_data;
         u8 rfcsr;
         u32 reg;
 
         if (rf->channel <= 14) {
-                rt2800_bbp_write(rt2x00dev, 25, 0x15);
-                rt2800_bbp_write(rt2x00dev, 26, 0x85);
+                rt2800_bbp_write(rt2x00dev, 25, drv_data->bbp25);
+                rt2800_bbp_write(rt2x00dev, 26, drv_data->bbp26);
         } else {
                 rt2800_bbp_write(rt2x00dev, 25, 0x09);
                 rt2800_bbp_write(rt2x00dev, 26, 0xff);
@@ -1712,8 +1783,7 @@ static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
         if (rf->channel <= 14) {
                 rt2x00_set_field8(&rfcsr, RFCSR12_DR0, 3);
                 rt2x00_set_field8(&rfcsr, RFCSR12_TX_POWER,
-                                (info->default_power1 & 0x3) |
-                                ((info->default_power1 & 0xC) << 1));
+                                  info->default_power1);
         } else {
                 rt2x00_set_field8(&rfcsr, RFCSR12_DR0, 7);
                 rt2x00_set_field8(&rfcsr, RFCSR12_TX_POWER,
@@ -1726,8 +1796,7 @@ static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
         if (rf->channel <= 14) {
                 rt2x00_set_field8(&rfcsr, RFCSR13_DR0, 3);
                 rt2x00_set_field8(&rfcsr, RFCSR13_TX_POWER,
-                                (info->default_power2 & 0x3) |
-                                ((info->default_power2 & 0xC) << 1));
+                                  info->default_power2);
         } else {
                 rt2x00_set_field8(&rfcsr, RFCSR13_DR0, 7);
                 rt2x00_set_field8(&rfcsr, RFCSR13_TX_POWER,
@@ -1737,11 +1806,12 @@ static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
         rt2800_rfcsr_write(rt2x00dev, 13, rfcsr);
 
         rt2800_rfcsr_read(rt2x00dev, 1, &rfcsr);
-        rt2x00_set_field8(&rfcsr, RFCSR1_RF_BLOCK_EN, 1);
         rt2x00_set_field8(&rfcsr, RFCSR1_RX0_PD, 0);
         rt2x00_set_field8(&rfcsr, RFCSR1_TX0_PD, 0);
         rt2x00_set_field8(&rfcsr, RFCSR1_RX1_PD, 0);
         rt2x00_set_field8(&rfcsr, RFCSR1_TX1_PD, 0);
+        rt2x00_set_field8(&rfcsr, RFCSR1_RX2_PD, 0);
+        rt2x00_set_field8(&rfcsr, RFCSR1_TX2_PD, 0);
         if (test_bit(CAPABILITY_BT_COEXIST, &rt2x00dev->cap_flags)) {
                 if (rf->channel <= 14) {
                         rt2x00_set_field8(&rfcsr, RFCSR1_RX0_PD, 1);
@@ -1772,10 +1842,13 @@ static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
         rt2x00_set_field8(&rfcsr, RFCSR23_FREQ_OFFSET, rt2x00dev->freq_offset);
         rt2800_rfcsr_write(rt2x00dev, 23, rfcsr);
 
-        rt2800_rfcsr_write(rt2x00dev, 24,
-                              rt2x00dev->calibration[conf_is_ht40(conf)]);
-        rt2800_rfcsr_write(rt2x00dev, 31,
-                              rt2x00dev->calibration[conf_is_ht40(conf)]);
+        if (conf_is_ht40(conf)) {
+                rt2800_rfcsr_write(rt2x00dev, 24, drv_data->calibration_bw40);
+                rt2800_rfcsr_write(rt2x00dev, 31, drv_data->calibration_bw40);
+        } else {
+                rt2800_rfcsr_write(rt2x00dev, 24, drv_data->calibration_bw20);
+                rt2800_rfcsr_write(rt2x00dev, 31, drv_data->calibration_bw20);
+        }
 
         if (rf->channel <= 14) {
                 rt2800_rfcsr_write(rt2x00dev, 7, 0xd8);
@@ -1783,7 +1856,10 @@ static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
                 rt2800_rfcsr_write(rt2x00dev, 10, 0xf1);
                 rt2800_rfcsr_write(rt2x00dev, 11, 0xb9);
                 rt2800_rfcsr_write(rt2x00dev, 15, 0x53);
-                rt2800_rfcsr_write(rt2x00dev, 16, 0x4c);
+                rfcsr = 0x4c;
+                rt2x00_set_field8(&rfcsr, RFCSR16_TXMIXER_GAIN,
+                                  drv_data->txmixer_gain_24g);
+                rt2800_rfcsr_write(rt2x00dev, 16, rfcsr);
                 rt2800_rfcsr_write(rt2x00dev, 17, 0x23);
                 rt2800_rfcsr_write(rt2x00dev, 19, 0x93);
                 rt2800_rfcsr_write(rt2x00dev, 20, 0xb3);
@@ -1792,12 +1868,20 @@ static void rt2800_config_channel_rf3052(struct rt2x00_dev *rt2x00dev,
                 rt2800_rfcsr_write(rt2x00dev, 27, 0x00);
                 rt2800_rfcsr_write(rt2x00dev, 29, 0x9b);
         } else {
-                rt2800_rfcsr_write(rt2x00dev, 7, 0x14);
+                rt2800_rfcsr_read(rt2x00dev, 7, &rfcsr);
+                rt2x00_set_field8(&rfcsr, RFCSR7_BIT2, 1);
+                rt2x00_set_field8(&rfcsr, RFCSR7_BIT3, 0);
+                rt2x00_set_field8(&rfcsr, RFCSR7_BIT4, 1);
+                rt2x00_set_field8(&rfcsr, RFCSR7_BITS67, 0);
+                rt2800_rfcsr_write(rt2x00dev, 7, rfcsr);
                 rt2800_rfcsr_write(rt2x00dev, 9, 0xc0);
                 rt2800_rfcsr_write(rt2x00dev, 10, 0xf1);
                 rt2800_rfcsr_write(rt2x00dev, 11, 0x00);
                 rt2800_rfcsr_write(rt2x00dev, 15, 0x43);
-                rt2800_rfcsr_write(rt2x00dev, 16, 0x7a);
+                rfcsr = 0x7a;
+                rt2x00_set_field8(&rfcsr, RFCSR16_TXMIXER_GAIN,
+                                  drv_data->txmixer_gain_5g);
+                rt2800_rfcsr_write(rt2x00dev, 16, rfcsr);
                 rt2800_rfcsr_write(rt2x00dev, 17, 0x23);
                 if (rf->channel <= 64) {
                         rt2800_rfcsr_write(rt2x00dev, 19, 0xb7);
@@ -3246,6 +3330,7 @@ static u8 rt2800_init_rx_filter(struct rt2x00_dev *rt2x00dev,
 
 static int rt2800_init_rfcsr(struct rt2x00_dev *rt2x00dev)
 {
+        struct rt2800_drv_data *drv_data = rt2x00dev->drv_data;
         u8 rfcsr;
         u8 bbp;
         u32 reg;
@@ -3534,20 +3619,26 @@ static int rt2800_init_rfcsr(struct rt2x00_dev *rt2x00dev)
          * Set RX Filter calibration for 20MHz and 40MHz
          */
         if (rt2x00_rt(rt2x00dev, RT3070)) {
-                rt2x00dev->calibration[0] =
+                drv_data->calibration_bw20 =
                         rt2800_init_rx_filter(rt2x00dev, false, 0x07, 0x16);
-                rt2x00dev->calibration[1] =
+                drv_data->calibration_bw40 =
                         rt2800_init_rx_filter(rt2x00dev, true, 0x27, 0x19);
         } else if (rt2x00_rt(rt2x00dev, RT3071) ||
                    rt2x00_rt(rt2x00dev, RT3090) ||
                    rt2x00_rt(rt2x00dev, RT3390) ||
                    rt2x00_rt(rt2x00dev, RT3572)) {
-                rt2x00dev->calibration[0] =
+                drv_data->calibration_bw20 =
                         rt2800_init_rx_filter(rt2x00dev, false, 0x07, 0x13);
-                rt2x00dev->calibration[1] =
+                drv_data->calibration_bw40 =
                         rt2800_init_rx_filter(rt2x00dev, true, 0x27, 0x15);
         }
 
+        /*
+         * Save BBP 25 & 26 values for later use in channel switching
+         */
+        rt2800_bbp_read(rt2x00dev, 25, &drv_data->bbp25);
+        rt2800_bbp_read(rt2x00dev, 26, &drv_data->bbp26);
+
         if (!rt2x00_rt(rt2x00dev, RT5390)) {
                 /*
                  * Set back to initial state
@@ -3587,11 +3678,8 @@ static int rt2800_init_rfcsr(struct rt2x00_dev *rt2x00dev)
                                       &rt2x00dev->cap_flags))
                                 rt2x00_set_field8(&rfcsr, RFCSR17_R, 1);
                 }
-                rt2x00_eeprom_read(rt2x00dev, EEPROM_TXMIXER_GAIN_BG, &eeprom);
-                if (rt2x00_get_field16(eeprom, EEPROM_TXMIXER_GAIN_BG_VAL) >= 1)
-                        rt2x00_set_field8(&rfcsr, RFCSR17_TXMIXER_GAIN,
-                                        rt2x00_get_field16(eeprom,
-                                                EEPROM_TXMIXER_GAIN_BG_VAL));
+                rt2x00_set_field8(&rfcsr, RFCSR17_TXMIXER_GAIN,
+                                  drv_data->txmixer_gain_24g);
                 rt2800_rfcsr_write(rt2x00dev, 17, rfcsr);
         }
 
@@ -3799,6 +3887,7 @@ EXPORT_SYMBOL_GPL(rt2800_read_eeprom_efuse);
 
 int rt2800_validate_eeprom(struct rt2x00_dev *rt2x00dev)
 {
+        struct rt2800_drv_data *drv_data = rt2x00dev->drv_data;
         u16 word;
         u8 *mac;
         u8 default_lna_gain;
@@ -3882,6 +3971,14 @@ int rt2800_validate_eeprom(struct rt2x00_dev *rt2x00dev)
                 rt2x00_set_field16(&word, EEPROM_RSSI_BG_OFFSET1, 0);
         rt2x00_eeprom_write(rt2x00dev, EEPROM_RSSI_BG, word);
 
+        rt2x00_eeprom_read(rt2x00dev, EEPROM_TXMIXER_GAIN_BG, &word);
+        if ((word & 0x00ff) != 0x00ff) {
+                drv_data->txmixer_gain_24g =
+                        rt2x00_get_field16(word, EEPROM_TXMIXER_GAIN_BG_VAL);
+        } else {
+                drv_data->txmixer_gain_24g = 0;
+        }
+
         rt2x00_eeprom_read(rt2x00dev, EEPROM_RSSI_BG2, &word);
         if (abs(rt2x00_get_field16(word, EEPROM_RSSI_BG2_OFFSET2)) > 10)
                 rt2x00_set_field16(&word, EEPROM_RSSI_BG2_OFFSET2, 0);
@@ -3891,6 +3988,14 @@ int rt2800_validate_eeprom(struct rt2x00_dev *rt2x00dev)
                                    default_lna_gain);
         rt2x00_eeprom_write(rt2x00dev, EEPROM_RSSI_BG2, word);
 
+        rt2x00_eeprom_read(rt2x00dev, EEPROM_TXMIXER_GAIN_A, &word);
+        if ((word & 0x00ff) != 0x00ff) {
+                drv_data->txmixer_gain_5g =
+                        rt2x00_get_field16(word, EEPROM_TXMIXER_GAIN_A_VAL);
+        } else {
+                drv_data->txmixer_gain_5g = 0;
+        }
+
         rt2x00_eeprom_read(rt2x00dev, EEPROM_RSSI_A, &word);
         if (abs(rt2x00_get_field16(word, EEPROM_RSSI_A_OFFSET0)) > 10)
                 rt2x00_set_field16(&word, EEPROM_RSSI_A_OFFSET0, 0);
diff --git a/drivers/net/wireless/rt2x00/rt2800pci.c b/drivers/net/wireless/rt2x00/rt2800pci.c
index 4e985026985c..6ad692914ee9 100644
--- a/drivers/net/wireless/rt2x00/rt2800pci.c
+++ b/drivers/net/wireless/rt2x00/rt2800pci.c
@@ -1093,6 +1093,7 @@ static const struct data_queue_desc rt2800pci_queue_bcn = {
 
 static const struct rt2x00_ops rt2800pci_ops = {
         .name                   = KBUILD_MODNAME,
+        .drv_data_size          = sizeof(struct rt2800_drv_data),
         .max_sta_intf           = 1,
         .max_ap_intf            = 8,
         .eeprom_size            = EEPROM_SIZE,
diff --git a/drivers/net/wireless/rt2x00/rt2800usb.c b/drivers/net/wireless/rt2x00/rt2800usb.c
index f0074bcee7c9..d009b6b794bb 100644
--- a/drivers/net/wireless/rt2x00/rt2800usb.c
+++ b/drivers/net/wireless/rt2x00/rt2800usb.c
@@ -827,6 +827,7 @@ static const struct data_queue_desc rt2800usb_queue_bcn = {
 
 static const struct rt2x00_ops rt2800usb_ops = {
         .name                   = KBUILD_MODNAME,
+        .drv_data_size          = sizeof(struct rt2800_drv_data),
         .max_sta_intf           = 1,
         .max_ap_intf            = 8,
         .eeprom_size            = EEPROM_SIZE,
diff --git a/drivers/net/wireless/rt2x00/rt2x00.h b/drivers/net/wireless/rt2x00/rt2x00.h
index b03b22c47b18..ed2ae6efcaa3 100644
--- a/drivers/net/wireless/rt2x00/rt2x00.h
+++ b/drivers/net/wireless/rt2x00/rt2x00.h
@@ -647,6 +647,7 @@ struct rt2x00lib_ops {
  */
 struct rt2x00_ops {
         const char *name;
+        const unsigned int drv_data_size;
         const unsigned int max_sta_intf;
         const unsigned int max_ap_intf;
         const unsigned int eeprom_size;
@@ -742,6 +743,11 @@ struct rt2x00_dev {
         const struct rt2x00_ops *ops;
 
         /*
+         * Driver data.
+         */
+        void *drv_data;
+
+        /*
          * IEEE80211 control structure.
          */
         struct ieee80211_hw *hw;
@@ -886,18 +892,11 @@ struct rt2x00_dev {
         u8 rssi_offset;
 
         /*
-         * Frequency offset (for rt61pci & rt73usb).
+         * Frequency offset.
          */
         u8 freq_offset;
 
         /*
-         * Calibration information (for rt2800usb & rt2800pci).
-         * [0] -> BW20
-         * [1] -> BW40
-         */
-        u8 calibration[2];
-
-        /*
          * Association id.
          */
         u16 aid;
diff --git a/drivers/net/wireless/rt2x00/rt2x00dev.c b/drivers/net/wireless/rt2x00/rt2x00dev.c
index c3e1aa7c1a80..bae5b01299ea 100644
--- a/drivers/net/wireless/rt2x00/rt2x00dev.c
+++ b/drivers/net/wireless/rt2x00/rt2x00dev.c
@@ -1121,6 +1121,18 @@ int rt2x00lib_probe_dev(struct rt2x00_dev *rt2x00dev)
 {
         int retval = -ENOMEM;
 
+        /*
+         * Allocate the driver data memory, if necessary.
+         */
+        if (rt2x00dev->ops->drv_data_size > 0) {
+                rt2x00dev->drv_data = kzalloc(rt2x00dev->ops->drv_data_size,
+                                              GFP_KERNEL);
+                if (!rt2x00dev->drv_data) {
+                        retval = -ENOMEM;
+                        goto exit;
+                }
+        }
+
         spin_lock_init(&rt2x00dev->irqmask_lock);
         mutex_init(&rt2x00dev->csr_mutex);
 
@@ -1261,6 +1273,12 @@ void rt2x00lib_remove_dev(struct rt2x00_dev *rt2x00dev)
          * Free queue structures.
          */
         rt2x00queue_free(rt2x00dev);
+
+        /*
+         * Free the driver data.
+         */
+        if (rt2x00dev->drv_data)
+                kfree(rt2x00dev->drv_data);
 }
 EXPORT_SYMBOL_GPL(rt2x00lib_remove_dev);