]> err.no Git - linux-2.6/blobdiff - drivers/net/wireless/libertas/main.c
libertas: set dev_addr on rtap device
[linux-2.6] / drivers / net / wireless / libertas / main.c
index ed02c02c96da0ddb738db62d1a1901d68c948e2f..e9c6b4ffd8e13cbd0c22ac45656f7bce7dc3ed5c 100644 (file)
@@ -256,10 +256,8 @@ void lbs_remove_rtap(struct lbs_private *priv);
 static ssize_t lbs_rtap_get(struct device *dev,
                struct device_attribute *attr, char * buf)
 {
-       struct lbs_private *priv = (struct lbs_private *)
-               (to_net_dev(dev))->priv;
-       struct lbs_adapter *adapter = priv->adapter;
-       return snprintf(buf, 5, "0x%X\n", adapter->monitormode);
+       struct lbs_private *priv = to_net_dev(dev)->priv;
+       return snprintf(buf, 5, "0x%X\n", priv->monitormode);
 }
 
 /**
@@ -269,36 +267,40 @@ static ssize_t lbs_rtap_set(struct device *dev,
                struct device_attribute *attr, const char * buf, size_t count)
 {
        int monitor_mode;
-       struct lbs_private *priv = (struct lbs_private *)
-               (to_net_dev(dev))->priv;
-       struct lbs_adapter *adapter = priv->adapter;
+       struct lbs_private *priv = to_net_dev(dev)->priv;
 
        sscanf(buf, "%x", &monitor_mode);
        if (monitor_mode != LBS_MONITOR_OFF) {
-               if(adapter->monitormode == monitor_mode)
+               if(priv->monitormode == monitor_mode)
                        return strlen(buf);
-               if (adapter->monitormode == LBS_MONITOR_OFF) {
-                       if (adapter->mode == IW_MODE_INFRA)
+               if (priv->monitormode == LBS_MONITOR_OFF) {
+                       if (priv->mode == IW_MODE_INFRA)
                                lbs_send_deauthentication(priv);
-                       else if (adapter->mode == IW_MODE_ADHOC)
+                       else if (priv->mode == IW_MODE_ADHOC)
                                lbs_stop_adhoc_network(priv);
                        lbs_add_rtap(priv);
                }
-               adapter->monitormode = monitor_mode;
+               priv->monitormode = monitor_mode;
        }
 
        else {
-               if (adapter->monitormode == LBS_MONITOR_OFF)
+               if (priv->monitormode == LBS_MONITOR_OFF)
                        return strlen(buf);
-               adapter->monitormode = LBS_MONITOR_OFF;
+               priv->monitormode = LBS_MONITOR_OFF;
                lbs_remove_rtap(priv);
-               netif_wake_queue(priv->dev);
-               netif_wake_queue(priv->mesh_dev);
+
+               if (priv->currenttxskb) {
+                       dev_kfree_skb_any(priv->currenttxskb);
+                       priv->currenttxskb = NULL;
+               }
+
+               /* Wake queues, command thread, etc. */
+               lbs_host_to_card_done(priv);
        }
 
        lbs_prepare_and_send_command(priv,
                        CMD_802_11_MONITOR_MODE, CMD_ACT_SET,
-                       CMD_OPTION_WAITFORRSP, 0, &adapter->monitormode);
+                       CMD_OPTION_WAITFORRSP, 0, &priv->monitormode);
        return strlen(buf);
 }
 
@@ -378,14 +380,13 @@ static struct attribute_group lbs_mesh_attr_group = {
 static int pre_open_check(struct net_device *dev)
 {
        struct lbs_private *priv = (struct lbs_private *) dev->priv;
-       struct lbs_adapter *adapter = priv->adapter;
        int i = 0;
 
-       while (!adapter->fw_ready && i < 20) {
+       while (!priv->fw_ready && i < 20) {
                i++;
                msleep_interruptible(100);
        }
-       if (!adapter->fw_ready) {
+       if (!priv->fw_ready) {
                lbs_pr_err("firmware not ready\n");
                return -1;
        }
@@ -402,19 +403,18 @@ static int pre_open_check(struct net_device *dev)
 static int lbs_dev_open(struct net_device *dev)
 {
        struct lbs_private *priv = (struct lbs_private *) dev->priv;
-       struct lbs_adapter *adapter = priv->adapter;
 
        lbs_deb_enter(LBS_DEB_NET);
 
        priv->open = 1;
 
-       if (adapter->connect_status == LBS_CONNECTED)
+       if (priv->connect_status == LBS_CONNECTED)
                netif_carrier_on(priv->dev);
        else
                netif_carrier_off(priv->dev);
 
        if (priv->mesh_dev) {
-               if (adapter->mesh_connect_status == LBS_CONNECTED)
+               if (priv->mesh_connect_status == LBS_CONNECTED)
                        netif_carrier_on(priv->mesh_dev);
                else
                        netif_carrier_off(priv->mesh_dev);
@@ -438,7 +438,7 @@ static int lbs_mesh_open(struct net_device *dev)
        priv->mesh_open = 1 ;
        netif_wake_queue(priv->mesh_dev);
 
-       priv->adapter->mesh_connect_status = LBS_CONNECTED;
+       priv->mesh_connect_status = LBS_CONNECTED;
 
        netif_carrier_on(priv->mesh_dev);
        netif_wake_queue(priv->mesh_dev);
@@ -515,76 +515,6 @@ static int lbs_close(struct net_device *dev)
                return 0;
 }
 
-
-static int lbs_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
-{
-       int ret = 0;
-       struct lbs_private *priv = dev->priv;
-
-       lbs_deb_enter(LBS_DEB_TX);
-
-       if (priv->dnld_sent || priv->adapter->TxLockFlag) {
-               priv->stats.tx_dropped++;
-               goto done;
-       }
-
-       netif_stop_queue(priv->dev);
-       if (priv->mesh_dev)
-               netif_stop_queue(priv->mesh_dev);
-
-       if (lbs_process_tx(priv, skb) == 0)
-               dev->trans_start = jiffies;
-done:
-       lbs_deb_leave_args(LBS_DEB_TX, "ret %d", ret);
-       return ret;
-}
-
-/**
- * @brief Mark mesh packets and handover them to lbs_hard_start_xmit
- *
- */
-static int lbs_mesh_pre_start_xmit(struct sk_buff *skb,
-               struct net_device *dev)
-{
-       struct lbs_private *priv = dev->priv;
-       int ret;
-
-       lbs_deb_enter(LBS_DEB_MESH);
-       if (priv->adapter->monitormode != LBS_MONITOR_OFF) {
-               netif_stop_queue(dev);
-               return -EOPNOTSUPP;
-       }
-
-       SET_MESH_FRAME(skb);
-
-       ret = lbs_hard_start_xmit(skb, priv->mesh_dev);
-       lbs_deb_leave_args(LBS_DEB_MESH, "ret %d", ret);
-       return ret;
-}
-
-/**
- * @brief Mark non-mesh packets and handover them to lbs_hard_start_xmit
- *
- */
-static int lbs_pre_start_xmit(struct sk_buff *skb, struct net_device *dev)
-{
-       struct lbs_private *priv = dev->priv;
-       int ret;
-
-       lbs_deb_enter(LBS_DEB_TX);
-
-       if (priv->adapter->monitormode != LBS_MONITOR_OFF) {
-               netif_stop_queue(dev);
-               return -EOPNOTSUPP;
-       }
-
-       UNSET_MESH_FRAME(skb);
-
-       ret = lbs_hard_start_xmit(skb, dev);
-       lbs_deb_leave_args(LBS_DEB_TX, "ret %d", ret);
-       return ret;
-}
-
 static void lbs_tx_timeout(struct net_device *dev)
 {
        struct lbs_private *priv = (struct lbs_private *) dev->priv;
@@ -593,44 +523,42 @@ static void lbs_tx_timeout(struct net_device *dev)
 
        lbs_pr_err("tx watch dog timeout\n");
 
-       priv->dnld_sent = DNLD_RES_RECEIVED;
        dev->trans_start = jiffies;
 
-       if (priv->adapter->currenttxskb) {
-               if (priv->adapter->monitormode != LBS_MONITOR_OFF) {
-                       /* If we are here, we have not received feedback from
-                          the previous packet.  Assume TX_FAIL and move on. */
-                       priv->adapter->eventcause = 0x01000000;
-                       lbs_send_tx_feedback(priv);
-               } else
-                       wake_up_interruptible(&priv->waitq);
-       } else if (dev == priv->dev) {
-               if (priv->adapter->connect_status == LBS_CONNECTED)
-                       netif_wake_queue(priv->dev);
-
-       } else if (dev == priv->mesh_dev) {
-               if (priv->adapter->mesh_connect_status == LBS_CONNECTED)
-                       netif_wake_queue(priv->mesh_dev);
+       if (priv->currenttxskb) {
+               priv->eventcause = 0x01000000;
+               lbs_send_tx_feedback(priv);
        }
+       /* XX: Shouldn't we also call into the hw-specific driver
+          to kick it somehow? */
+       lbs_host_to_card_done(priv);
 
        lbs_deb_leave(LBS_DEB_TX);
 }
 
 void lbs_host_to_card_done(struct lbs_private *priv)
 {
-       struct lbs_adapter *adapter = priv->adapter;
+       unsigned long flags;
+
+       spin_lock_irqsave(&priv->driver_lock, flags);
 
        priv->dnld_sent = DNLD_RES_RECEIVED;
 
        /* Wake main thread if commands are pending */
-       if (!adapter->cur_cmd)
+       if (!priv->cur_cmd)
                wake_up_interruptible(&priv->waitq);
 
-       if (priv->dev && adapter->connect_status == LBS_CONNECTED)
-               netif_wake_queue(priv->dev);
+       /* Don't wake netif queues if we're in monitor mode and
+          a TX packet is already pending, or if there are commands
+          queued to be sent. */
+       if (!priv->currenttxskb && list_empty(&priv->cmdpendingq)) {
+               if (priv->dev && priv->connect_status == LBS_CONNECTED)
+                       netif_wake_queue(priv->dev);
 
-       if (priv->mesh_dev && adapter->mesh_connect_status == LBS_CONNECTED)
-               netif_wake_queue(priv->mesh_dev);
+               if (priv->mesh_dev && priv->mesh_connect_status == LBS_CONNECTED)
+                       netif_wake_queue(priv->mesh_dev);
+       }
+       spin_unlock_irqrestore(&priv->driver_lock, flags);
 }
 EXPORT_SYMBOL_GPL(lbs_host_to_card_done);
 
@@ -651,7 +579,6 @@ static int lbs_set_mac_address(struct net_device *dev, void *addr)
 {
        int ret = 0;
        struct lbs_private *priv = (struct lbs_private *) dev->priv;
-       struct lbs_adapter *adapter = priv->adapter;
        struct sockaddr *phwaddr = addr;
 
        lbs_deb_enter(LBS_DEB_NET);
@@ -659,13 +586,13 @@ static int lbs_set_mac_address(struct net_device *dev, void *addr)
        /* In case it was called from the mesh device */
        dev = priv->dev ;
 
-       memset(adapter->current_addr, 0, ETH_ALEN);
+       memset(priv->current_addr, 0, ETH_ALEN);
 
        /* dev->dev_addr is 8 bytes */
        lbs_deb_hex(LBS_DEB_NET, "dev->dev_addr", dev->dev_addr, ETH_ALEN);
 
        lbs_deb_hex(LBS_DEB_NET, "addr", phwaddr->sa_data, ETH_ALEN);
-       memcpy(adapter->current_addr, phwaddr->sa_data, ETH_ALEN);
+       memcpy(priv->current_addr, phwaddr->sa_data, ETH_ALEN);
 
        ret = lbs_prepare_and_send_command(priv, CMD_802_11_MAC_ADDRESS,
                                    CMD_ACT_SET,
@@ -677,24 +604,24 @@ static int lbs_set_mac_address(struct net_device *dev, void *addr)
                goto done;
        }
 
-       lbs_deb_hex(LBS_DEB_NET, "adapter->macaddr", adapter->current_addr, ETH_ALEN);
-       memcpy(dev->dev_addr, adapter->current_addr, ETH_ALEN);
+       lbs_deb_hex(LBS_DEB_NET, "priv->macaddr", priv->current_addr, ETH_ALEN);
+       memcpy(dev->dev_addr, priv->current_addr, ETH_ALEN);
        if (priv->mesh_dev)
-               memcpy(priv->mesh_dev->dev_addr, adapter->current_addr, ETH_ALEN);
+               memcpy(priv->mesh_dev->dev_addr, priv->current_addr, ETH_ALEN);
 
 done:
        lbs_deb_leave_args(LBS_DEB_NET, "ret %d", ret);
        return ret;
 }
 
-static int lbs_copy_multicast_address(struct lbs_adapter *adapter,
+static int lbs_copy_multicast_address(struct lbs_private *priv,
                                     struct net_device *dev)
 {
        int i = 0;
        struct dev_mc_list *mcptr = dev->mc_list;
 
        for (i = 0; i < dev->mc_count; i++) {
-               memcpy(&adapter->multicastlist[i], mcptr->dmi_addr, ETH_ALEN);
+               memcpy(&priv->multicastlist[i], mcptr->dmi_addr, ETH_ALEN);
                mcptr = mcptr->next;
        }
 
@@ -705,50 +632,49 @@ static int lbs_copy_multicast_address(struct lbs_adapter *adapter,
 static void lbs_set_multicast_list(struct net_device *dev)
 {
        struct lbs_private *priv = dev->priv;
-       struct lbs_adapter *adapter = priv->adapter;
        int oldpacketfilter;
        DECLARE_MAC_BUF(mac);
 
        lbs_deb_enter(LBS_DEB_NET);
 
-       oldpacketfilter = adapter->currentpacketfilter;
+       oldpacketfilter = priv->currentpacketfilter;
 
        if (dev->flags & IFF_PROMISC) {
                lbs_deb_net("enable promiscuous mode\n");
-               adapter->currentpacketfilter |=
+               priv->currentpacketfilter |=
                    CMD_ACT_MAC_PROMISCUOUS_ENABLE;
-               adapter->currentpacketfilter &=
+               priv->currentpacketfilter &=
                    ~(CMD_ACT_MAC_ALL_MULTICAST_ENABLE |
                      CMD_ACT_MAC_MULTICAST_ENABLE);
        } else {
                /* Multicast */
-               adapter->currentpacketfilter &=
+               priv->currentpacketfilter &=
                    ~CMD_ACT_MAC_PROMISCUOUS_ENABLE;
 
                if (dev->flags & IFF_ALLMULTI || dev->mc_count >
                    MRVDRV_MAX_MULTICAST_LIST_SIZE) {
                        lbs_deb_net( "enabling all multicast\n");
-                       adapter->currentpacketfilter |=
+                       priv->currentpacketfilter |=
                            CMD_ACT_MAC_ALL_MULTICAST_ENABLE;
-                       adapter->currentpacketfilter &=
+                       priv->currentpacketfilter &=
                            ~CMD_ACT_MAC_MULTICAST_ENABLE;
                } else {
-                       adapter->currentpacketfilter &=
+                       priv->currentpacketfilter &=
                            ~CMD_ACT_MAC_ALL_MULTICAST_ENABLE;
 
                        if (!dev->mc_count) {
                                lbs_deb_net("no multicast addresses, "
                                       "disabling multicast\n");
-                               adapter->currentpacketfilter &=
+                               priv->currentpacketfilter &=
                                    ~CMD_ACT_MAC_MULTICAST_ENABLE;
                        } else {
                                int i;
 
-                               adapter->currentpacketfilter |=
+                               priv->currentpacketfilter |=
                                    CMD_ACT_MAC_MULTICAST_ENABLE;
 
-                               adapter->nr_of_multicastmacaddr =
-                                   lbs_copy_multicast_address(adapter, dev);
+                               priv->nr_of_multicastmacaddr =
+                                   lbs_copy_multicast_address(priv, dev);
 
                                lbs_deb_net("multicast addresses: %d\n",
                                       dev->mc_count);
@@ -756,7 +682,7 @@ static void lbs_set_multicast_list(struct net_device *dev)
                                for (i = 0; i < dev->mc_count; i++) {
                                        lbs_deb_net("Multicast address %d:%s\n",
                                               i, print_mac(mac,
-                                              adapter->multicastlist[i]));
+                                              priv->multicastlist[i]));
                                }
                                /* send multicast addresses to firmware */
                                lbs_prepare_and_send_command(priv,
@@ -767,7 +693,7 @@ static void lbs_set_multicast_list(struct net_device *dev)
                }
        }
 
-       if (adapter->currentpacketfilter != oldpacketfilter) {
+       if (priv->currentpacketfilter != oldpacketfilter) {
                lbs_set_mac_packet_filter(priv);
        }
 
@@ -786,7 +712,6 @@ static int lbs_thread(void *data)
 {
        struct net_device *dev = data;
        struct lbs_private *priv = dev->priv;
-       struct lbs_adapter *adapter = priv->adapter;
        wait_queue_t wait;
        u8 ireg = 0;
 
@@ -795,149 +720,126 @@ static int lbs_thread(void *data)
        init_waitqueue_entry(&wait, current);
 
        set_freezable();
+
        for (;;) {
-               lbs_deb_thread( "main-thread 111: intcounter=%d "
-                      "currenttxskb=%p dnld_sent=%d\n",
-                      adapter->intcounter,
-                      adapter->currenttxskb, priv->dnld_sent);
+               lbs_deb_thread( "main-thread 111: intcounter=%d currenttxskb=%p dnld_sent=%d\n",
+                               priv->intcounter, priv->currenttxskb, priv->dnld_sent);
 
                add_wait_queue(&priv->waitq, &wait);
                set_current_state(TASK_INTERRUPTIBLE);
-               spin_lock_irq(&adapter->driver_lock);
-               if ((adapter->psstate == PS_STATE_SLEEP) ||
-                   (!adapter->intcounter
-                    && (priv->dnld_sent || adapter->cur_cmd ||
-                        list_empty(&adapter->cmdpendingq)))) {
-                       lbs_deb_thread(
-                              "main-thread sleeping... Conn=%d IntC=%d PS_mode=%d PS_State=%d\n",
-                              adapter->connect_status, adapter->intcounter,
-                              adapter->psmode, adapter->psstate);
-                       spin_unlock_irq(&adapter->driver_lock);
+               spin_lock_irq(&priv->driver_lock);
+
+               if ((priv->psstate == PS_STATE_SLEEP) ||
+                   (!priv->intcounter && (priv->dnld_sent || priv->cur_cmd || list_empty(&priv->cmdpendingq)))) {
+                       lbs_deb_thread("main-thread sleeping... Conn=%d IntC=%d PS_mode=%d PS_State=%d\n",
+                                      priv->connect_status, priv->intcounter,
+                                      priv->psmode, priv->psstate);
+                       spin_unlock_irq(&priv->driver_lock);
                        schedule();
                } else
-                       spin_unlock_irq(&adapter->driver_lock);
+                       spin_unlock_irq(&priv->driver_lock);
 
-               lbs_deb_thread(
-                      "main-thread 222 (waking up): intcounter=%d currenttxskb=%p "
-                      "dnld_sent=%d\n", adapter->intcounter,
-                      adapter->currenttxskb, priv->dnld_sent);
+               lbs_deb_thread("main-thread 222 (waking up): intcounter=%d currenttxskb=%p dnld_sent=%d\n",
+                              priv->intcounter, priv->currenttxskb, priv->dnld_sent);
 
                set_current_state(TASK_RUNNING);
                remove_wait_queue(&priv->waitq, &wait);
                try_to_freeze();
 
-               lbs_deb_thread("main-thread 333: intcounter=%d currenttxskb=%p "
-                      "dnld_sent=%d\n",
-                      adapter->intcounter,
-                      adapter->currenttxskb, priv->dnld_sent);
+               lbs_deb_thread("main-thread 333: intcounter=%d currenttxskb=%p dnld_sent=%d\n",
+                              priv->intcounter, priv->currenttxskb, priv->dnld_sent);
 
-               if (kthread_should_stop()
-                   || adapter->surpriseremoved) {
-                       lbs_deb_thread(
-                              "main-thread: break from main thread: surpriseremoved=0x%x\n",
-                              adapter->surpriseremoved);
+               if (kthread_should_stop() || priv->surpriseremoved) {
+                       lbs_deb_thread("main-thread: break from main thread: surpriseremoved=0x%x\n",
+                                      priv->surpriseremoved);
                        break;
                }
 
 
-               spin_lock_irq(&adapter->driver_lock);
-               if (adapter->intcounter) {
+               spin_lock_irq(&priv->driver_lock);
+
+               if (priv->intcounter) {
                        u8 int_status;
-                       adapter->intcounter = 0;
+
+                       priv->intcounter = 0;
                        int_status = priv->hw_get_int_status(priv, &ireg);
 
                        if (int_status) {
-                               lbs_deb_thread(
-                                      "main-thread: reading HOST_INT_STATUS_REG failed\n");
-                               spin_unlock_irq(&adapter->driver_lock);
+                               lbs_deb_thread("main-thread: reading HOST_INT_STATUS_REG failed\n");
+                               spin_unlock_irq(&priv->driver_lock);
                                continue;
                        }
-                       adapter->hisregcpy |= ireg;
+                       priv->hisregcpy |= ireg;
                }
 
-               lbs_deb_thread("main-thread 444: intcounter=%d currenttxskb=%p "
-                      "dnld_sent=%d\n",
-                      adapter->intcounter,
-                      adapter->currenttxskb, priv->dnld_sent);
+               lbs_deb_thread("main-thread 444: intcounter=%d currenttxskb=%p dnld_sent=%d\n",
+                              priv->intcounter, priv->currenttxskb, priv->dnld_sent);
 
                /* command response? */
-               if (adapter->hisregcpy & MRVDRV_CMD_UPLD_RDY) {
+               if (priv->hisregcpy & MRVDRV_CMD_UPLD_RDY) {
                        lbs_deb_thread("main-thread: cmd response ready\n");
 
-                       adapter->hisregcpy &= ~MRVDRV_CMD_UPLD_RDY;
-                       spin_unlock_irq(&adapter->driver_lock);
+                       priv->hisregcpy &= ~MRVDRV_CMD_UPLD_RDY;
+                       spin_unlock_irq(&priv->driver_lock);
                        lbs_process_rx_command(priv);
-                       spin_lock_irq(&adapter->driver_lock);
+                       spin_lock_irq(&priv->driver_lock);
                }
 
                /* Any Card Event */
-               if (adapter->hisregcpy & MRVDRV_CARDEVENT) {
+               if (priv->hisregcpy & MRVDRV_CARDEVENT) {
                        lbs_deb_thread("main-thread: Card Event Activity\n");
 
-                       adapter->hisregcpy &= ~MRVDRV_CARDEVENT;
+                       priv->hisregcpy &= ~MRVDRV_CARDEVENT;
 
                        if (priv->hw_read_event_cause(priv)) {
-                               lbs_pr_alert(
-                                      "main-thread: hw_read_event_cause failed\n");
-                               spin_unlock_irq(&adapter->driver_lock);
+                               lbs_pr_alert("main-thread: hw_read_event_cause failed\n");
+                               spin_unlock_irq(&priv->driver_lock);
                                continue;
                        }
-                       spin_unlock_irq(&adapter->driver_lock);
+                       spin_unlock_irq(&priv->driver_lock);
                        lbs_process_event(priv);
                } else
-                       spin_unlock_irq(&adapter->driver_lock);
+                       spin_unlock_irq(&priv->driver_lock);
 
                /* Check if we need to confirm Sleep Request received previously */
-               if (adapter->psstate == PS_STATE_PRE_SLEEP) {
-                       if (!priv->dnld_sent && !adapter->cur_cmd) {
-                               if (adapter->connect_status ==
-                                   LBS_CONNECTED) {
-                                       lbs_deb_thread(
-                                              "main_thread: PRE_SLEEP--intcounter=%d currenttxskb=%p "
-                                              "dnld_sent=%d cur_cmd=%p, confirm now\n",
-                                              adapter->intcounter,
-                                              adapter->currenttxskb,
-                                              priv->dnld_sent,
-                                              adapter->cur_cmd);
-
-                                       lbs_ps_confirm_sleep(priv,
-                                                      (u16) adapter->psmode);
-                               } else {
-                                       /* workaround for firmware sending
-                                        * deauth/linkloss event immediately
-                                        * after sleep request, remove this
-                                        * after firmware fixes it
-                                        */
-                                       adapter->psstate = PS_STATE_AWAKE;
-                                       lbs_pr_alert(
-                                              "main-thread: ignore PS_SleepConfirm in non-connected state\n");
-                               }
+               if (priv->psstate == PS_STATE_PRE_SLEEP &&
+                   !priv->dnld_sent && !priv->cur_cmd) {
+                       if (priv->connect_status == LBS_CONNECTED) {
+                               lbs_deb_thread("main_thread: PRE_SLEEP--intcounter=%d currenttxskb=%p dnld_sent=%d cur_cmd=%p, confirm now\n",
+                                              priv->intcounter, priv->currenttxskb, priv->dnld_sent, priv->cur_cmd);
+
+                               lbs_ps_confirm_sleep(priv, (u16) priv->psmode);
+                       } else {
+                               /* workaround for firmware sending
+                                * deauth/linkloss event immediately
+                                * after sleep request; remove this
+                                * after firmware fixes it
+                                */
+                               priv->psstate = PS_STATE_AWAKE;
+                               lbs_pr_alert("main-thread: ignore PS_SleepConfirm in non-connected state\n");
                        }
                }
 
                /* The PS state is changed during processing of Sleep Request
                 * event above
                 */
-               if ((priv->adapter->psstate == PS_STATE_SLEEP) ||
-                   (priv->adapter->psstate == PS_STATE_PRE_SLEEP))
+               if ((priv->psstate == PS_STATE_SLEEP) ||
+                   (priv->psstate == PS_STATE_PRE_SLEEP))
                        continue;
 
                /* Execute the next command */
-               if (!priv->dnld_sent && !priv->adapter->cur_cmd)
+               if (!priv->dnld_sent && !priv->cur_cmd)
                        lbs_execute_next_command(priv);
 
                /* Wake-up command waiters which can't sleep in
                 * lbs_prepare_and_send_command
                 */
-               if (!adapter->nr_cmd_pending)
-                       wake_up_all(&adapter->cmd_pending);
-
-               lbs_tx_runqueue(priv);
+               if (!list_empty(&priv->cmdpendingq))
+                       wake_up_all(&priv->cmd_pending);
        }
 
-       del_timer(&adapter->command_timer);
-       adapter->nr_cmd_pending = 0;
-       wake_up_all(&adapter->cmd_pending);
+       del_timer(&priv->command_timer);
+       wake_up_all(&priv->cmd_pending);
 
        lbs_deb_leave(LBS_DEB_THREAD);
        return 0;
@@ -954,7 +856,6 @@ static int lbs_thread(void *data)
 static int lbs_setup_firmware(struct lbs_private *priv)
 {
        int ret = -1;
-       struct lbs_adapter *adapter = priv->adapter;
        struct cmd_ds_mesh_access mesh_access;
 
        lbs_deb_enter(LBS_DEB_FW);
@@ -962,7 +863,7 @@ static int lbs_setup_firmware(struct lbs_private *priv)
        /*
         * Read MAC address from HW
         */
-       memset(adapter->current_addr, 0xff, ETH_ALEN);
+       memset(priv->current_addr, 0xff, ETH_ALEN);
 
        ret = lbs_prepare_and_send_command(priv, CMD_GET_HW_SPEC,
                                    0, CMD_OPTION_WAITFORRSP, 0, NULL);
@@ -999,10 +900,6 @@ static int lbs_setup_firmware(struct lbs_private *priv)
                priv->mesh_autostart_enabled = 0;
        }
 
-       /* Set the boot2 version in firmware */
-       ret = lbs_prepare_and_send_command(priv, CMD_SET_BOOT2_VER,
-                                   0, CMD_OPTION_WAITFORRSP, 0, NULL);
-
        ret = 0;
 done:
        lbs_deb_leave_args(LBS_DEB_FW, "ret %d", ret);
@@ -1016,12 +913,11 @@ done:
 static void command_timer_fn(unsigned long data)
 {
        struct lbs_private *priv = (struct lbs_private *)data;
-       struct lbs_adapter *adapter = priv->adapter;
        struct cmd_ctrl_node *ptempnode;
        struct cmd_ds_command *cmd;
        unsigned long flags;
 
-       ptempnode = adapter->cur_cmd;
+       ptempnode = priv->cur_cmd;
        if (ptempnode == NULL) {
                lbs_deb_fw("ptempnode empty\n");
                return;
@@ -1035,15 +931,15 @@ static void command_timer_fn(unsigned long data)
 
        lbs_deb_fw("command_timer_fn fired, cmd %x\n", cmd->command);
 
-       if (!adapter->fw_ready)
+       if (!priv->fw_ready)
                return;
 
-       spin_lock_irqsave(&adapter->driver_lock, flags);
-       adapter->cur_cmd = NULL;
-       spin_unlock_irqrestore(&adapter->driver_lock, flags);
+       spin_lock_irqsave(&priv->driver_lock, flags);
+       priv->cur_cmd = NULL;
+       spin_unlock_irqrestore(&priv->driver_lock, flags);
 
        lbs_deb_fw("re-sending same command because of timeout\n");
-       lbs_queue_cmd(adapter, ptempnode, 0);
+       lbs_queue_cmd(priv, ptempnode, 0);
 
        wake_up_interruptible(&priv->waitq);
 
@@ -1052,64 +948,58 @@ static void command_timer_fn(unsigned long data)
 
 static int lbs_init_adapter(struct lbs_private *priv)
 {
-       struct lbs_adapter *adapter = priv->adapter;
        size_t bufsize;
        int i, ret = 0;
 
        /* Allocate buffer to store the BSSID list */
        bufsize = MAX_NETWORK_COUNT * sizeof(struct bss_descriptor);
-       adapter->networks = kzalloc(bufsize, GFP_KERNEL);
-       if (!adapter->networks) {
+       priv->networks = kzalloc(bufsize, GFP_KERNEL);
+       if (!priv->networks) {
                lbs_pr_err("Out of memory allocating beacons\n");
                ret = -1;
                goto out;
        }
 
        /* Initialize scan result lists */
-       INIT_LIST_HEAD(&adapter->network_free_list);
-       INIT_LIST_HEAD(&adapter->network_list);
+       INIT_LIST_HEAD(&priv->network_free_list);
+       INIT_LIST_HEAD(&priv->network_list);
        for (i = 0; i < MAX_NETWORK_COUNT; i++) {
-               list_add_tail(&adapter->networks[i].list,
-                             &adapter->network_free_list);
+               list_add_tail(&priv->networks[i].list,
+                             &priv->network_free_list);
        }
 
-       adapter->lbs_ps_confirm_sleep.seqnum = cpu_to_le16(++adapter->seqnum);
-       adapter->lbs_ps_confirm_sleep.command =
+       priv->lbs_ps_confirm_sleep.seqnum = cpu_to_le16(++priv->seqnum);
+       priv->lbs_ps_confirm_sleep.command =
            cpu_to_le16(CMD_802_11_PS_MODE);
-       adapter->lbs_ps_confirm_sleep.size =
+       priv->lbs_ps_confirm_sleep.size =
            cpu_to_le16(sizeof(struct PS_CMD_ConfirmSleep));
-       adapter->lbs_ps_confirm_sleep.action =
+       priv->lbs_ps_confirm_sleep.action =
            cpu_to_le16(CMD_SUBCMD_SLEEP_CONFIRMED);
 
-       memset(adapter->current_addr, 0xff, ETH_ALEN);
+       memset(priv->current_addr, 0xff, ETH_ALEN);
 
-       adapter->connect_status = LBS_DISCONNECTED;
-       adapter->mesh_connect_status = LBS_DISCONNECTED;
-       adapter->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
-       adapter->mode = IW_MODE_INFRA;
-       adapter->curbssparams.channel = DEFAULT_AD_HOC_CHANNEL;
-       adapter->currentpacketfilter = CMD_ACT_MAC_RX_ON | CMD_ACT_MAC_TX_ON;
-       adapter->radioon = RADIO_ON;
-       adapter->auto_rate = 1;
-       adapter->capability = WLAN_CAPABILITY_SHORT_PREAMBLE;
-       adapter->psmode = LBS802_11POWERMODECAM;
-       adapter->psstate = PS_STATE_FULL_POWER;
+       priv->connect_status = LBS_DISCONNECTED;
+       priv->mesh_connect_status = LBS_DISCONNECTED;
+       priv->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
+       priv->mode = IW_MODE_INFRA;
+       priv->curbssparams.channel = DEFAULT_AD_HOC_CHANNEL;
+       priv->currentpacketfilter = CMD_ACT_MAC_RX_ON | CMD_ACT_MAC_TX_ON;
+       priv->radioon = RADIO_ON;
+       priv->auto_rate = 1;
+       priv->capability = WLAN_CAPABILITY_SHORT_PREAMBLE;
+       priv->psmode = LBS802_11POWERMODECAM;
+       priv->psstate = PS_STATE_FULL_POWER;
 
-       mutex_init(&adapter->lock);
+       mutex_init(&priv->lock);
 
-       memset(&adapter->tx_queue_ps, 0, NR_TX_QUEUE*sizeof(struct sk_buff*));
-       adapter->tx_queue_idx = 0;
-       spin_lock_init(&adapter->txqueue_lock);
-
-       setup_timer(&adapter->command_timer, command_timer_fn,
+       setup_timer(&priv->command_timer, command_timer_fn,
                    (unsigned long)priv);
 
-       INIT_LIST_HEAD(&adapter->cmdfreeq);
-       INIT_LIST_HEAD(&adapter->cmdpendingq);
+       INIT_LIST_HEAD(&priv->cmdfreeq);
+       INIT_LIST_HEAD(&priv->cmdpendingq);
 
-       spin_lock_init(&adapter->driver_lock);
-       init_waitqueue_head(&adapter->cmd_pending);
-       adapter->nr_cmd_pending = 0;
+       spin_lock_init(&priv->driver_lock);
+       init_waitqueue_head(&priv->cmd_pending);
 
        /* Allocate the command buffers */
        if (lbs_allocate_cmd_buffer(priv)) {
@@ -1123,27 +1013,15 @@ out:
 
 static void lbs_free_adapter(struct lbs_private *priv)
 {
-       struct lbs_adapter *adapter = priv->adapter;
-
-       if (!adapter) {
-               lbs_deb_fw("why double free adapter?\n");
-               return;
-       }
-
        lbs_deb_fw("free command buffer\n");
        lbs_free_cmd_buffer(priv);
 
        lbs_deb_fw("free command_timer\n");
-       del_timer(&adapter->command_timer);
+       del_timer(&priv->command_timer);
 
        lbs_deb_fw("free scan results table\n");
-       kfree(adapter->networks);
-       adapter->networks = NULL;
-
-       /* Free the adapter object itself */
-       lbs_deb_fw("free adapter\n");
-       kfree(adapter);
-       priv->adapter = NULL;
+       kfree(priv->networks);
+       priv->networks = NULL;
 }
 
 /**
@@ -1168,13 +1046,6 @@ struct lbs_private *lbs_add_card(void *card, struct device *dmdev)
        }
        priv = dev->priv;
 
-       /* allocate buffer for struct lbs_adapter */
-       priv->adapter = kzalloc(sizeof(struct lbs_adapter), GFP_KERNEL);
-       if (!priv->adapter) {
-               lbs_pr_err("allocate buffer for struct lbs_adapter failed\n");
-               goto err_kzalloc;
-       }
-
        if (lbs_init_adapter(priv)) {
                lbs_pr_err("failed to initialize adapter structure.\n");
                goto err_init_adapter;
@@ -1184,11 +1055,10 @@ struct lbs_private *lbs_add_card(void *card, struct device *dmdev)
        priv->card = card;
        priv->mesh_open = 0;
        priv->infra_open = 0;
-       priv->hotplug_device = dmdev;
 
        /* Setup the OS Interface to our functions */
        dev->open = lbs_open;
-       dev->hard_start_xmit = lbs_pre_start_xmit;
+       dev->hard_start_xmit = lbs_hard_start_xmit;
        dev->stop = lbs_close;
        dev->set_mac_address = lbs_set_mac_address;
        dev->tx_timeout = lbs_tx_timeout;
@@ -1204,15 +1074,13 @@ struct lbs_private *lbs_add_card(void *card, struct device *dmdev)
        SET_NETDEV_DEV(dev, dmdev);
 
        priv->rtap_net_dev = NULL;
-       if (device_create_file(dmdev, &dev_attr_lbs_rtap))
-               goto err_init_adapter;
 
        lbs_deb_thread("Starting main thread...\n");
        init_waitqueue_head(&priv->waitq);
        priv->main_thread = kthread_run(lbs_thread, dev, "lbs_main");
        if (IS_ERR(priv->main_thread)) {
                lbs_deb_thread("Error creating main thread.\n");
-               goto err_kthread_run;
+               goto err_init_adapter;
        }
 
        priv->work_thread = create_singlethread_workqueue("lbs_worker");
@@ -1222,13 +1090,8 @@ struct lbs_private *lbs_add_card(void *card, struct device *dmdev)
 
        goto done;
 
-err_kthread_run:
-       device_remove_file(dmdev, &dev_attr_lbs_rtap);
-
 err_init_adapter:
        lbs_free_adapter(priv);
-
-err_kzalloc:
        free_netdev(dev);
        priv = NULL;
 
@@ -1241,7 +1104,6 @@ EXPORT_SYMBOL_GPL(lbs_add_card);
 
 int lbs_remove_card(struct lbs_private *priv)
 {
-       struct lbs_adapter *adapter = priv->adapter;
        struct net_device *dev = priv->dev;
        union iwreq_data wrqu;
 
@@ -1250,14 +1112,14 @@ int lbs_remove_card(struct lbs_private *priv)
        lbs_remove_rtap(priv);
 
        dev = priv->dev;
-       device_remove_file(priv->hotplug_device, &dev_attr_lbs_rtap);
+       device_remove_file(&dev->dev, &dev_attr_lbs_rtap);
 
        cancel_delayed_work(&priv->scan_work);
        cancel_delayed_work(&priv->assoc_work);
        destroy_workqueue(priv->work_thread);
 
-       if (adapter->psmode == LBS802_11POWERMODEMAX_PSP) {
-               adapter->psmode = LBS802_11POWERMODECAM;
+       if (priv->psmode == LBS802_11POWERMODEMAX_PSP) {
+               priv->psmode = LBS802_11POWERMODECAM;
                lbs_ps_wakeup(priv, CMD_OPTION_WAITFORRSP);
        }
 
@@ -1266,7 +1128,7 @@ int lbs_remove_card(struct lbs_private *priv)
        wireless_send_event(priv->dev, SIOCGIWAP, &wrqu, NULL);
 
        /* Stop the thread servicing the interrupts */
-       adapter->surpriseremoved = 1;
+       priv->surpriseremoved = 1;
        kthread_stop(priv->main_thread);
 
        lbs_free_adapter(priv);
@@ -1299,6 +1161,8 @@ int lbs_start_card(struct lbs_private *priv)
                lbs_pr_err("cannot register ethX device\n");
                goto done;
        }
+       if (device_create_file(&dev->dev, &dev_attr_lbs_rtap))
+               lbs_pr_err("cannot register lbs_rtap attribute\n");
 
        lbs_debugfs_init_one(priv, dev);
 
@@ -1328,12 +1192,12 @@ int lbs_stop_card(struct lbs_private *priv)
        lbs_debugfs_remove_one(priv);
 
        /* Flush pending command nodes */
-       spin_lock_irqsave(&priv->adapter->driver_lock, flags);
-       list_for_each_entry(cmdnode, &priv->adapter->cmdpendingq, list) {
+       spin_lock_irqsave(&priv->driver_lock, flags);
+       list_for_each_entry(cmdnode, &priv->cmdpendingq, list) {
                cmdnode->cmdwaitqwoken = 1;
                wake_up_interruptible(&cmdnode->cmdwait_q);
        }
-       spin_unlock_irqrestore(&priv->adapter->driver_lock, flags);
+       spin_unlock_irqrestore(&priv->driver_lock, flags);
 
        unregister_netdev(dev);
 
@@ -1366,7 +1230,7 @@ int lbs_add_mesh(struct lbs_private *priv, struct device *dev)
        priv->mesh_dev = mesh_dev;
 
        mesh_dev->open = lbs_mesh_open;
-       mesh_dev->hard_start_xmit = lbs_mesh_pre_start_xmit;
+       mesh_dev->hard_start_xmit = lbs_hard_start_xmit;
        mesh_dev->stop = lbs_mesh_close;
        mesh_dev->get_stats = lbs_get_stats;
        mesh_dev->set_mac_address = lbs_set_mac_address;
@@ -1465,7 +1329,6 @@ struct chan_freq_power *lbs_get_region_cfp_table(u8 region, u8 band, int *cfp_no
 
 int lbs_set_regiontable(struct lbs_private *priv, u8 region, u8 band)
 {
-       struct lbs_adapter *adapter = priv->adapter;
        int ret = 0;
        int i = 0;
 
@@ -1474,22 +1337,22 @@ int lbs_set_regiontable(struct lbs_private *priv, u8 region, u8 band)
 
        lbs_deb_enter(LBS_DEB_MAIN);
 
-       memset(adapter->region_channel, 0, sizeof(adapter->region_channel));
+       memset(priv->region_channel, 0, sizeof(priv->region_channel));
 
        {
                cfp = lbs_get_region_cfp_table(region, band, &cfp_no);
                if (cfp != NULL) {
-                       adapter->region_channel[i].nrcfp = cfp_no;
-                       adapter->region_channel[i].CFP = cfp;
+                       priv->region_channel[i].nrcfp = cfp_no;
+                       priv->region_channel[i].CFP = cfp;
                } else {
                        lbs_deb_main("wrong region code %#x in band B/G\n",
                               region);
                        ret = -1;
                        goto out;
                }
-               adapter->region_channel[i].valid = 1;
-               adapter->region_channel[i].region = region;
-               adapter->region_channel[i].band = band;
+               priv->region_channel[i].valid = 1;
+               priv->region_channel[i].region = region;
+               priv->region_channel[i].band = band;
                i++;
        }
 out:
@@ -1512,12 +1375,12 @@ void lbs_interrupt(struct net_device *dev)
        lbs_deb_enter(LBS_DEB_THREAD);
 
        lbs_deb_thread("lbs_interrupt: intcounter=%d\n",
-              priv->adapter->intcounter);
+              priv->intcounter);
 
-       priv->adapter->intcounter++;
+       priv->intcounter++;
 
-       if (priv->adapter->psstate == PS_STATE_SLEEP) {
-               priv->adapter->psstate = PS_STATE_AWAKE;
+       if (priv->psstate == PS_STATE_SLEEP) {
+               priv->psstate = PS_STATE_AWAKE;
                netif_wake_queue(dev);
                if (priv->mesh_dev)
                        netif_wake_queue(priv->mesh_dev);
@@ -1585,7 +1448,7 @@ static int lbs_rtap_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
 static struct net_device_stats *lbs_rtap_get_stats(struct net_device *dev)
 {
        struct lbs_private *priv = dev->priv;
-       return &priv->ieee->stats;
+       return &priv->stats;
 }
 
 
@@ -1594,42 +1457,37 @@ void lbs_remove_rtap(struct lbs_private *priv)
        if (priv->rtap_net_dev == NULL)
                return;
        unregister_netdev(priv->rtap_net_dev);
-       free_ieee80211(priv->rtap_net_dev);
+       free_netdev(priv->rtap_net_dev);
        priv->rtap_net_dev = NULL;
 }
 
 int lbs_add_rtap(struct lbs_private *priv)
 {
        int rc = 0;
+       struct net_device *rtap_dev;
 
        if (priv->rtap_net_dev)
                return -EPERM;
 
-       priv->rtap_net_dev = alloc_ieee80211(0);
-       if (priv->rtap_net_dev == NULL)
+       rtap_dev = alloc_netdev(0, "rtap%d", ether_setup);
+       if (rtap_dev == NULL)
                return -ENOMEM;
 
+       memcpy(rtap_dev->dev_addr, priv->current_addr, ETH_ALEN);
+       rtap_dev->type = ARPHRD_IEEE80211_RADIOTAP;
+       rtap_dev->open = lbs_rtap_open;
+       rtap_dev->stop = lbs_rtap_stop;
+       rtap_dev->get_stats = lbs_rtap_get_stats;
+       rtap_dev->hard_start_xmit = lbs_rtap_hard_start_xmit;
+       rtap_dev->set_multicast_list = lbs_set_multicast_list;
+       rtap_dev->priv = priv;
 
-       priv->ieee = netdev_priv(priv->rtap_net_dev);
-
-       strcpy(priv->rtap_net_dev->name, "rtap%d");
-
-       priv->rtap_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
-       priv->rtap_net_dev->open = lbs_rtap_open;
-       priv->rtap_net_dev->stop = lbs_rtap_stop;
-       priv->rtap_net_dev->get_stats = lbs_rtap_get_stats;
-       priv->rtap_net_dev->hard_start_xmit = lbs_rtap_hard_start_xmit;
-       priv->rtap_net_dev->set_multicast_list = lbs_set_multicast_list;
-       priv->rtap_net_dev->priv = priv;
-
-       priv->ieee->iw_mode = IW_MODE_MONITOR;
-
-       rc = register_netdev(priv->rtap_net_dev);
+       rc = register_netdev(rtap_dev);
        if (rc) {
-               free_ieee80211(priv->rtap_net_dev);
-               priv->rtap_net_dev = NULL;
+               free_netdev(rtap_dev);
                return rc;
        }
+       priv->rtap_net_dev = rtap_dev;
 
        return 0;
 }