rt2x00: Fix vgc_level_reg handling

Currently vgc_level_reg and vgc_level are equal to eachother,
while the purpose of vgc_level_reg is the value last written
to the register and is remembered through link tuning resets.
The vgc_level is the currently active level, which is
reset during link tuning resets.

The usage of these variables depends on the drivers, some drivers
need both, while others need only one of the two.

Signed-off-by: Ivo van Doorn <IvDoorn@gmail.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

diff --git a/drivers/net/wireless/rt2x00/rt2400pci.c b/drivers/net/wireless/rt2x00/rt2400pci.c
index d5f1fabe9faf453aa30184295af4772bd71d3eb6..25e9dcf65c4e2ba591c6697feb6c67c5fc3b0624 100644 (file)
--- a/drivers/net/wireless/rt2x00/rt2400pci.c
+++ b/drivers/net/wireless/rt2x00/rt2400pci.c
@@ -586,9 +586,11 @@ static void rt2400pci_link_stats(struct rt2x00_dev *rt2x00dev,
 static inline void rt2400pci_set_vgc(struct rt2x00_dev *rt2x00dev,
                                     struct link_qual *qual, u8 vgc_level)
 {
-       rt2400pci_bbp_write(rt2x00dev, 13, vgc_level);
-       qual->vgc_level = vgc_level;
-       qual->vgc_level_reg = vgc_level;
+       if (qual->vgc_level_reg != vgc_level) {
+               rt2400pci_bbp_write(rt2x00dev, 13, vgc_level);
+               qual->vgc_level = vgc_level;
+               qual->vgc_level_reg = vgc_level;
+       }
 }
 
 static void rt2400pci_reset_tuner(struct rt2x00_dev *rt2x00dev,

diff --git a/drivers/net/wireless/rt2x00/rt2500pci.c b/drivers/net/wireless/rt2x00/rt2500pci.c
index 096d6dbc83052bb520e3cafc4aeacec93dbd0ffb..faa804cf181a2091a4b88d81c6230f81074ba7a4 100644 (file)
--- a/drivers/net/wireless/rt2x00/rt2500pci.c
+++ b/drivers/net/wireless/rt2x00/rt2500pci.c
@@ -626,6 +626,7 @@ static inline void rt2500pci_set_vgc(struct rt2x00_dev *rt2x00dev,
 {
        if (qual->vgc_level_reg != vgc_level) {
                rt2500pci_bbp_write(rt2x00dev, 17, vgc_level);
+               qual->vgc_level = vgc_level;
                qual->vgc_level_reg = vgc_level;
        }
 }
@@ -700,13 +701,10 @@ dynamic_cca_tune:
         * R17 is inside the dynamic tuning range,
         * start tuning the link based on the false cca counter.
         */
-       if (qual->false_cca > 512 && qual->vgc_level_reg < 0x40) {
+       if (qual->false_cca > 512 && qual->vgc_level_reg < 0x40)
                rt2500pci_set_vgc(rt2x00dev, qual, ++qual->vgc_level_reg);
-               qual->vgc_level = qual->vgc_level_reg;
-       } else if (qual->false_cca < 100 && qual->vgc_level_reg > 0x32) {
+       else if (qual->false_cca < 100 && qual->vgc_level_reg > 0x32)
                rt2500pci_set_vgc(rt2x00dev, qual, --qual->vgc_level_reg);
-               qual->vgc_level = qual->vgc_level_reg;
-       }
 }
 
 /*

diff --git a/drivers/net/wireless/rt2x00/rt2x00link.c b/drivers/net/wireless/rt2x00/rt2x00link.c
index 14f1d51262892d66e377e3484e8617989052ea01..9acfc5c70389af87aa3cd2d333b0df5ebc7c3aab 100644 (file)
--- a/drivers/net/wireless/rt2x00/rt2x00link.c
+++ b/drivers/net/wireless/rt2x00/rt2x00link.c
@@ -302,6 +302,7 @@ void rt2x00link_stop_tuner(struct rt2x00_dev *rt2x00dev)
 void rt2x00link_reset_tuner(struct rt2x00_dev *rt2x00dev, bool antenna)
 {
        struct link_qual *qual = &rt2x00dev->link.qual;
+       u8 vgc_level = qual->vgc_level_reg;
 
        if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags))
                return;
@@ -317,6 +318,13 @@ void rt2x00link_reset_tuner(struct rt2x00_dev *rt2x00dev, bool antenna)
        rt2x00dev->link.count = 0;
        memset(qual, 0, sizeof(*qual));
 
+       /*
+        * Restore the VGC level as stored in the registers,
+        * the driver can use this to determine if the register
+        * must be updated during reset or not.
+        */
+       qual->vgc_level_reg = vgc_level;
+
        /*
         * Reset the link tuner.
         */