rt2x00: Move start() and stop() handlers into rt2x00lib.c

suspend & resume was broken since it called rt2x00mac_start()
and rt2x00mac_stop() which would fail to execute because the
DEVICE_PRESENT flag was not set.

Move the start and stop handlers into rt2x00lib.c which are called
from rt2x00mac_start() and rt2x00mac_stop() after they have checked
the DEVICE_PRESENT flag, while suspend and resume handlers can
directly call those functions.

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

1 files changed, 61 insertions, 5 deletions

diff --git a/drivers/net/wireless/rt2x00/rt2x00dev.c b/drivers/net/wireless/rt2x00/rt2x00dev.c
index 9b2bd9176467..cea2bd91ff5f 100644
--- a/drivers/net/wireless/rt2x00/rt2x00dev.c
+++ b/drivers/net/wireless/rt2x00/rt2x00dev.c
@@ -1046,7 +1046,7 @@ static void rt2x00lib_free_ring_entries(struct rt2x00_dev *rt2x00dev)
         }
 }
 
-void rt2x00lib_uninitialize(struct rt2x00_dev *rt2x00dev)
+static void rt2x00lib_uninitialize(struct rt2x00_dev *rt2x00dev)
 {
         if (!__test_and_clear_bit(DEVICE_INITIALIZED, &rt2x00dev->flags))
                 return;
@@ -1067,7 +1067,7 @@ void rt2x00lib_uninitialize(struct rt2x00_dev *rt2x00dev)
         rt2x00lib_free_ring_entries(rt2x00dev);
 }
 
-int rt2x00lib_initialize(struct rt2x00_dev *rt2x00dev)
+static int rt2x00lib_initialize(struct rt2x00_dev *rt2x00dev)
 {
         int status;
 
@@ -1110,6 +1110,58 @@ exit:
         return status;
 }
 
+int rt2x00lib_start(struct rt2x00_dev *rt2x00dev)
+{
+        int retval;
+
+        if (test_bit(DEVICE_STARTED, &rt2x00dev->flags))
+                return 0;
+
+        /*
+         * If this is the first interface which is added,
+         * we should load the firmware now.
+         */
+        if (test_bit(DRIVER_REQUIRE_FIRMWARE, &rt2x00dev->flags)) {
+                retval = rt2x00lib_load_firmware(rt2x00dev);
+                if (retval)
+                        return retval;
+        }
+
+        /*
+         * Initialize the device.
+         */
+        retval = rt2x00lib_initialize(rt2x00dev);
+        if (retval)
+                return retval;
+
+        /*
+         * Enable radio.
+         */
+        retval = rt2x00lib_enable_radio(rt2x00dev);
+        if (retval) {
+                rt2x00lib_uninitialize(rt2x00dev);
+                return retval;
+        }
+
+        __set_bit(DEVICE_STARTED, &rt2x00dev->flags);
+
+        return 0;
+}
+
+void rt2x00lib_stop(struct rt2x00_dev *rt2x00dev)
+{
+        if (!test_bit(DEVICE_STARTED, &rt2x00dev->flags))
+                return;
+
+        /*
+         * Perhaps we can add something smarter here,
+         * but for now just disabling the radio should do.
+         */
+        rt2x00lib_disable_radio(rt2x00dev);
+
+        __clear_bit(DEVICE_STARTED, &rt2x00dev->flags);
+}
+
 /*
  * driver allocation handlers.
  */
@@ -1295,7 +1347,7 @@ int rt2x00lib_suspend(struct rt2x00_dev *rt2x00dev, pm_message_t state)
          * Disable radio and unitialize all items
          * that must be recreated on resume.
          */
-        rt2x00mac_stop(rt2x00dev->hw);
+        rt2x00lib_stop(rt2x00dev);
         rt2x00lib_uninitialize(rt2x00dev);
         rt2x00debug_deregister(rt2x00dev);
 
@@ -1317,7 +1369,6 @@ int rt2x00lib_resume(struct rt2x00_dev *rt2x00dev)
         int retval;
 
         NOTICE(rt2x00dev, "Waking up.\n");
-        __set_bit(DEVICE_PRESENT, &rt2x00dev->flags);
 
         /*
          * Open the debugfs entry.
@@ -1333,7 +1384,7 @@ int rt2x00lib_resume(struct rt2x00_dev *rt2x00dev)
         /*
          * Reinitialize device and all active interfaces.
          */
-        retval = rt2x00mac_start(rt2x00dev->hw);
+        retval = rt2x00lib_start(rt2x00dev);
         if (retval)
                 goto exit;
 
@@ -1349,6 +1400,11 @@ int rt2x00lib_resume(struct rt2x00_dev *rt2x00dev)
         rt2x00lib_config_type(rt2x00dev, intf->type);
 
         /*
+         * We are ready again to receive requests from mac80211.
+         */
+        __set_bit(DEVICE_PRESENT, &rt2x00dev->flags);
+
+        /*
          * It is possible that during that mac80211 has attempted
          * to send frames while we were suspending or resuming.
          * In that case we have disabled the TX queue and should