[PATCH] libertas: fix error handling of card initialization
[powerpc.git] / drivers / net / wireless / libertas / main.c
index cd10736..5c58c50 100644 (file)
@@ -4,6 +4,7 @@
   * thread etc..
   */
 
+#include <linux/moduleparam.h>
 #include <linux/delay.h>
 #include <linux/freezer.h>
 #include <linux/etherdevice.h>
@@ -29,6 +30,13 @@ const char libertas_driver_version[] = "COMM-USB8388-" DRIVER_RELEASE_VERSION
 #endif
     "";
 
+
+/* Module parameters */
+unsigned int libertas_debug = 0;
+module_param(libertas_debug, int, 0644);
+
+
+
 #define WLAN_TX_PWR_DEFAULT            20      /*100mW */
 #define WLAN_TX_PWR_US_DEFAULT         20      /*100mW */
 #define WLAN_TX_PWR_JP_DEFAULT         16      /*50mW */
@@ -161,10 +169,6 @@ u8 libertas_adhoc_rates_g[G_SUPPORTED_RATES] =
  */
 u8 libertas_adhoc_rates_b[4] = { 0x82, 0x84, 0x8b, 0x96 };
 
-#define MAX_DEVS 5
-static struct net_device *libertas_devs[MAX_DEVS];
-static int libertas_found = 0;
-
 /**
  * the table to keep region code
  */
@@ -200,7 +204,6 @@ static ssize_t libertas_mpp_set(struct device * dev,
                struct device_attribute *attr, const char * buf, size_t count) {
        struct cmd_ds_mesh_access mesh_access;
 
-
        memset(&mesh_access, 0, sizeof(mesh_access));
        sscanf(buf, "%d", &(mesh_access.data[0]));
        libertas_prepare_and_send_command((to_net_dev(dev))->priv,
@@ -263,8 +266,11 @@ static int wlan_dev_open(struct net_device *dev)
 
        if (adapter->connect_status == libertas_connected) {
                netif_carrier_on(priv->wlan_dev.netdev);
-       } else
+               netif_carrier_on(priv->mesh_dev);
+       } else {
                netif_carrier_off(priv->wlan_dev.netdev);
+               netif_carrier_off(priv->mesh_dev);
+       }
 
        lbs_deb_leave(LBS_DEB_NET);
        return 0;
@@ -279,10 +285,10 @@ static int mesh_open(struct net_device *dev)
 {
        wlan_private *priv = (wlan_private *) dev->priv ;
 
-       if(pre_open_check(dev) == -1)
+       if (pre_open_check(dev) == -1)
                return -1;
        priv->mesh_open = 1 ;
-       netif_start_queue(priv->mesh_dev);
+       netif_wake_queue(priv->mesh_dev);
        if (priv->infra_open == 0)
                return wlan_dev_open(priv->wlan_dev.netdev) ;
        return 0;
@@ -314,6 +320,7 @@ static int wlan_dev_close(struct net_device *dev)
        lbs_deb_enter(LBS_DEB_NET);
 
        netif_carrier_off(priv->wlan_dev.netdev);
+       netif_carrier_off(priv->mesh_dev);
        priv->open = 0;
 
        lbs_deb_leave(LBS_DEB_NET);
@@ -344,7 +351,8 @@ static int mesh_close(struct net_device *dev)
  *  @param dev     A pointer to net_device structure
  *  @return       0
  */
-static int wlan_close(struct net_device *dev) {
+static int wlan_close(struct net_device *dev)
+{
        wlan_private *priv = (wlan_private *) dev->priv;
 
        netif_stop_queue(priv->wlan_dev.netdev);
@@ -369,6 +377,7 @@ static int wlan_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
        }
 
        netif_stop_queue(priv->wlan_dev.netdev);
+       netif_stop_queue(priv->mesh_dev);
 
        if (libertas_process_tx(priv, skb) == 0)
                dev->trans_start = jiffies;
@@ -431,8 +440,10 @@ static void wlan_tx_timeout(struct net_device *dev)
                        libertas_send_tx_feedback(priv);
                } else
                        wake_up_interruptible(&priv->mainthread.waitq);
-       } else if (priv->adapter->connect_status == libertas_connected)
+       } else if (priv->adapter->connect_status == libertas_connected) {
                netif_wake_queue(priv->wlan_dev.netdev);
+               netif_wake_queue(priv->mesh_dev);
+       }
 
        lbs_deb_leave(LBS_DEB_TX);
 }
@@ -479,7 +490,8 @@ static int wlan_set_mac_address(struct net_device *dev, void *addr)
 
        lbs_dbg_hex("adapter->macaddr:", adapter->current_addr, ETH_ALEN);
        memcpy(dev->dev_addr, adapter->current_addr, ETH_ALEN);
-       memcpy(((wlan_private *) dev->priv)->mesh_dev->dev_addr, adapter->current_addr, ETH_ALEN);
+       if (priv->mesh_dev)
+               memcpy(priv->mesh_dev->dev_addr, adapter->current_addr, ETH_ALEN);
 
 done:
        lbs_deb_leave_args(LBS_DEB_NET, "ret %d", ret);
@@ -759,7 +771,6 @@ static int wlan_service_main_thread(void *data)
 wlan_private *wlan_add_card(void *card)
 {
        struct net_device *dev = NULL;
-       struct net_device *mesh_dev = NULL;
        wlan_private *priv = NULL;
 
        lbs_deb_enter(LBS_DEB_NET);
@@ -769,35 +780,20 @@ wlan_private *wlan_add_card(void *card)
                lbs_pr_err("init ethX device failed\n");
                return NULL;
        }
-
        priv = dev->priv;
 
        /* allocate buffer for wlan_adapter */
-       if (!(priv->adapter = kmalloc(sizeof(wlan_adapter), GFP_KERNEL))) {
+       if (!(priv->adapter = kzalloc(sizeof(wlan_adapter), GFP_KERNEL))) {
                lbs_pr_err("allocate buffer for wlan_adapter failed\n");
-               goto err_kmalloc;
+               goto err_kzalloc;
        }
 
-       /* Allocate a virtual mesh device */
-       if (!(mesh_dev = alloc_netdev(0, "msh%d", ether_setup))) {
-               lbs_deb_mesh("init mshX device failed\n");
-               return NULL;
-       }
-
-       /* Both intervaces share the priv structure */
-       mesh_dev->priv = priv;
-
-       /* init wlan_adapter */
-       memset(priv->adapter, 0, sizeof(wlan_adapter));
-
        priv->wlan_dev.netdev = dev;
        priv->wlan_dev.card = card;
        priv->mesh_open = 0;
        priv->infra_open = 0;
-       priv->mesh_dev = mesh_dev;
 
        SET_MODULE_OWNER(dev);
-       SET_MODULE_OWNER(mesh_dev);
 
        /* Setup the OS Interface to our functions */
        dev->open = wlan_open;
@@ -805,25 +801,12 @@ wlan_private *wlan_add_card(void *card)
        dev->stop = wlan_close;
        dev->do_ioctl = libertas_do_ioctl;
        dev->set_mac_address = wlan_set_mac_address;
-       mesh_dev->open = mesh_open;
-       mesh_dev->hard_start_xmit = mesh_pre_start_xmit;
-       mesh_dev->stop = mesh_close;
-       mesh_dev->do_ioctl = libertas_do_ioctl;
-       memcpy(mesh_dev->dev_addr, priv->wlan_dev.netdev->dev_addr,
-                       sizeof(priv->wlan_dev.netdev->dev_addr));
-
-#define        WLAN_WATCHDOG_TIMEOUT   (5 * HZ)
-
        dev->tx_timeout = wlan_tx_timeout;
        dev->get_stats = wlan_get_stats;
-       dev->watchdog_timeo = WLAN_WATCHDOG_TIMEOUT;
+       dev->watchdog_timeo = 5 * HZ;
        dev->ethtool_ops = &libertas_ethtool_ops;
-       mesh_dev->get_stats = wlan_get_stats;
-       mesh_dev->ethtool_ops = &libertas_ethtool_ops;
-
 #ifdef WIRELESS_EXT
        dev->wireless_handlers = (struct iw_handler_def *)&libertas_handler_def;
-       mesh_dev->wireless_handlers = (struct iw_handler_def *)&libertas_handler_def;
 #endif
 #define NETIF_F_DYNALLOC 16
        dev->features |= NETIF_F_DYNALLOC;
@@ -836,6 +819,22 @@ wlan_private *wlan_add_card(void *card)
        spin_lock_init(&priv->adapter->driver_lock);
        init_waitqueue_head(&priv->adapter->cmd_pending);
        priv->adapter->nr_cmd_pending = 0;
+       goto done;
+
+err_kzalloc:
+       free_netdev(dev);
+       priv = NULL;
+done:
+       lbs_deb_leave_args(LBS_DEB_NET, "priv %p", priv);
+       return priv;
+}
+
+int libertas_activate_card(wlan_private *priv)
+{
+       struct net_device *dev = priv->wlan_dev.netdev;
+       int ret = -1;
+
+       lbs_deb_enter(LBS_DEB_MAIN);
 
        lbs_deb_thread("Starting kthread...\n");
        priv->mainthread.priv = priv;
@@ -867,28 +866,13 @@ wlan_private *wlan_add_card(void *card)
                goto err_init_fw;
        }
 
-       /* Register virtual mesh interface */
-       if (register_netdev(mesh_dev)) {
-               lbs_pr_err("cannot register mshX virtual interface\n");
-               goto err_init_fw;
-       }
-
        lbs_pr_info("%s: Marvell WLAN 802.11 adapter\n", dev->name);
 
        libertas_debugfs_init_one(priv, dev);
 
-       if (libertas_found == MAX_DEVS)
-               goto err_init_fw;
-       libertas_devs[libertas_found] = dev;
-       libertas_found++;
-       if (device_create_file(&(mesh_dev->dev), &dev_attr_libertas_mpp))
-               goto err_create_file;
-
-       lbs_deb_leave_args(LBS_DEB_NET, "priv %p", priv);
-       return priv;
+       ret = 0;
+       goto done;
 
-err_create_file:
-       device_remove_file(&(mesh_dev->dev), &dev_attr_libertas_mpp);
 err_init_fw:
        libertas_sbi_unregister_dev(priv);
 err_registerdev:
@@ -897,12 +881,75 @@ err_registerdev:
        wake_up_interruptible(&priv->mainthread.waitq);
        wlan_terminate_thread(&priv->mainthread);
        kfree(priv->adapter);
-err_kmalloc:
        free_netdev(dev);
+done:
+       lbs_deb_leave_args(LBS_DEB_NET, "ret %d", ret);
+       return ret;
+}
+
+/**
+ * @brief This function adds mshX interface
+ *
+ *  @param priv    A pointer to the wlan_private structure
+ *  @return       0 if successful, -X otherwise
+ */
+int wlan_add_mesh(wlan_private *priv)
+{
+       struct net_device *mesh_dev = NULL;
+       int ret = 0;
+
+       lbs_deb_enter(LBS_DEB_MESH);
+
+       /* Allocate a virtual mesh device */
+       if (!(mesh_dev = alloc_netdev(0, "msh%d", ether_setup))) {
+               lbs_deb_mesh("init mshX device failed\n");
+               ret = -ENOMEM;
+               goto done;
+       }
+       mesh_dev->priv = priv;
+       priv->mesh_dev = mesh_dev;
+
+       SET_MODULE_OWNER(mesh_dev);
+
+       mesh_dev->open = mesh_open;
+       mesh_dev->hard_start_xmit = mesh_pre_start_xmit;
+       mesh_dev->stop = mesh_close;
+       mesh_dev->do_ioctl = libertas_do_ioctl;
+       mesh_dev->get_stats = wlan_get_stats;
+       mesh_dev->ethtool_ops = &libertas_ethtool_ops;
+       memcpy(mesh_dev->dev_addr, priv->wlan_dev.netdev->dev_addr,
+                       sizeof(priv->wlan_dev.netdev->dev_addr));
+
+#ifdef WIRELESS_EXT
+       mesh_dev->wireless_handlers = (struct iw_handler_def *)&libertas_handler_def;
+#endif
+#define NETIF_F_DYNALLOC 16
+
+       /* Register virtual mesh interface */
+       ret = register_netdev(mesh_dev);
+       if (ret) {
+               lbs_pr_err("cannot register mshX virtual interface\n");
+               goto err_free;
+       }
+
+       ret = device_create_file(&(mesh_dev->dev), &dev_attr_libertas_mpp);
+       if (ret)
+               goto err_unregister;
+
+       /* Everything successful */
+       ret = 0;
+       goto done;
+
+
+err_unregister:
+       unregister_netdev(mesh_dev);
+
+err_free:
        free_netdev(mesh_dev);
 
-       lbs_deb_leave_args(LBS_DEB_NET, "priv NULL");
-       return NULL;
+done:
+       lbs_deb_leave_args(LBS_DEB_MESH, "ret %d", ret);
+       return ret;
 }
 
 static void wake_pending_cmdnodes(wlan_private *priv)
@@ -921,14 +968,11 @@ static void wake_pending_cmdnodes(wlan_private *priv)
 }
 
 
-int wlan_remove_card(void *card)
+int wlan_remove_card(wlan_private *priv)
 {
-       wlan_private *priv = libertas_sbi_get_priv(card);
        wlan_adapter *adapter;
        struct net_device *dev;
-       struct net_device *mesh_dev;
        union iwreq_data wrqu;
-       int i;
 
        lbs_deb_enter(LBS_DEB_NET);
 
@@ -941,16 +985,12 @@ int wlan_remove_card(void *card)
                goto out;
 
        dev = priv->wlan_dev.netdev;
-       mesh_dev = priv->mesh_dev;
 
-       netif_stop_queue(mesh_dev);
        netif_stop_queue(priv->wlan_dev.netdev);
        netif_carrier_off(priv->wlan_dev.netdev);
 
        wake_pending_cmdnodes(priv);
 
-       device_remove_file(&(mesh_dev->dev), &dev_attr_libertas_mpp);
-       unregister_netdev(mesh_dev);
        unregister_netdev(dev);
 
        cancel_delayed_work(&priv->assoc_work);
@@ -975,19 +1015,9 @@ int wlan_remove_card(void *card)
        lbs_deb_net("free adapter\n");
        libertas_free_adapter(priv);
 
-       for (i = 0; i<libertas_found; i++) {
-               if (libertas_devs[i]==priv->wlan_dev.netdev) {
-                       libertas_devs[i] = libertas_devs[--libertas_found];
-                       libertas_devs[libertas_found] = NULL ;
-                       break ;
-               }
-       }
-
        lbs_deb_net("unregister finish\n");
 
        priv->wlan_dev.netdev = NULL;
-       priv->mesh_dev = NULL ;
-       free_netdev(mesh_dev);
        free_netdev(dev);
 
 out:
@@ -995,6 +1025,30 @@ out:
        return 0;
 }
 
+void wlan_remove_mesh(wlan_private *priv)
+{
+       struct net_device *mesh_dev;
+
+       lbs_deb_enter(LBS_DEB_NET);
+
+       if (!priv)
+               goto out;
+
+       mesh_dev = priv->mesh_dev;
+
+       netif_stop_queue(mesh_dev);
+       netif_carrier_off(priv->mesh_dev);
+
+       device_remove_file(&(mesh_dev->dev), &dev_attr_libertas_mpp);
+       unregister_netdev(mesh_dev);
+
+       priv->mesh_dev = NULL ;
+       free_netdev(mesh_dev);
+
+out:
+       lbs_deb_leave(LBS_DEB_NET);
+}
+
 /**
  *  @brief This function finds the CFP in
  *  region_cfp_table based on region and band parameter.
@@ -1072,9 +1126,9 @@ void libertas_interrupt(struct net_device *dev)
 {
        wlan_private *priv = dev->priv;
 
-       lbs_deb_enter(LBS_DEB_MAIN);
+       lbs_deb_enter(LBS_DEB_THREAD);
 
-       lbs_deb_main("libertas_interrupt: intcounter=%d\n",
+       lbs_deb_thread("libertas_interrupt: intcounter=%d\n",
               priv->adapter->intcounter);
 
        priv->adapter->intcounter++;
@@ -1082,11 +1136,12 @@ void libertas_interrupt(struct net_device *dev)
        if (priv->adapter->psstate == PS_STATE_SLEEP) {
                priv->adapter->psstate = PS_STATE_AWAKE;
                netif_wake_queue(dev);
+               netif_wake_queue(priv->mesh_dev);
        }
 
        wake_up_interruptible(&priv->mainthread.waitq);
 
-       lbs_deb_leave(LBS_DEB_MAIN);
+       lbs_deb_leave(LBS_DEB_THREAD);
 }
 
 static int wlan_init_module(void)
@@ -1112,15 +1167,8 @@ static int wlan_init_module(void)
 
 static void wlan_cleanup_module(void)
 {
-       int i;
-
        lbs_deb_enter(LBS_DEB_MAIN);
 
-       for (i = 0; i<libertas_found; i++) {
-               wlan_private *priv = libertas_devs[i]->priv;
-               reset_device(priv);
-       }
-
        libertas_sbi_unregister();
        libertas_debugfs_remove();