1 files changed, 172 insertions, 0 deletions

diff --git a/drivers/net/wireless/iwmc3200wifi/netdev.c b/drivers/net/wireless/iwmc3200wifi/netdev.c
new file mode 100644
index 000000000000..eec7201e91a8
--- /dev/null
+++ b/drivers/net/wireless/iwmc3200wifi/netdev.c
@@ -0,0 +1,172 @@
+/*
+ * Intel Wireless Multicomm 3200 WiFi driver
+ *
+ * Copyright (C) 2009 Intel Corporation <ilw@linux.intel.com>
+ * Samuel Ortiz <samuel.ortiz@intel.com>
+ * Zhu Yi <yi.zhu@intel.com>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License version
+ * 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
+ * 02110-1301, USA.
+ *
+ */
+
+/*
+ * This is the netdev related hooks for iwm.
+ *
+ * Some interesting code paths:
+ *
+ * iwm_open() (Called at netdev interface bringup time)
+ *  -> iwm_up() (main.c)
+ *      -> iwm_bus_enable()
+ *          -> if_sdio_enable() (In case of an SDIO bus)
+ *              -> sdio_enable_func()
+ *      -> iwm_notif_wait(BARKER_REBOOT) (wait for reboot barker)
+ *      -> iwm_notif_wait(ACK_BARKER) (wait for ACK barker)
+ *      -> iwm_load_fw() (fw.c)
+ *          -> iwm_load_umac()
+ *          -> iwm_load_lmac() (Calibration LMAC)
+ *          -> iwm_load_lmac() (Operational LMAC)
+ *      -> iwm_send_umac_config()
+ *
+ * iwm_stop() (Called at netdev interface bringdown time)
+ *  -> iwm_down()
+ *      -> iwm_bus_disable()
+ *          -> if_sdio_disable() (In case of an SDIO bus)
+ *              -> sdio_disable_func()
+ */
+#include <linux/netdevice.h>
+
+#include "iwm.h"
+#include "cfg80211.h"
+#include "debug.h"
+
+static int iwm_open(struct net_device *ndev)
+{
+        struct iwm_priv *iwm = ndev_to_iwm(ndev);
+        int ret = 0;
+
+        if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
+                ret = iwm_up(iwm);
+
+        return ret;
+}
+
+static int iwm_stop(struct net_device *ndev)
+{
+        struct iwm_priv *iwm = ndev_to_iwm(ndev);
+        int ret = 0;
+
+        if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
+                ret = iwm_down(iwm);
+
+        return ret;
+}
+
+/*
+ * iwm AC to queue mapping
+ *
+ * AC_VO -> queue 3
+ * AC_VI -> queue 2
+ * AC_BE -> queue 1
+ * AC_BK -> queue 0
+ */
+static const u16 iwm_1d_to_queue[8] = { 1, 0, 0, 1, 2, 2, 3, 3 };
+
+static u16 iwm_select_queue(struct net_device *dev, struct sk_buff *skb)
+{
+        skb->priority = cfg80211_classify8021d(skb);
+
+        return iwm_1d_to_queue[skb->priority];
+}
+
+static const struct net_device_ops iwm_netdev_ops = {
+        .ndo_open               = iwm_open,
+        .ndo_stop               = iwm_stop,
+        .ndo_start_xmit         = iwm_xmit_frame,
+        .ndo_select_queue       = iwm_select_queue,
+};
+
+void *iwm_if_alloc(int sizeof_bus, struct device *dev,
+                   struct iwm_if_ops *if_ops)
+{
+        struct net_device *ndev;
+        struct wireless_dev *wdev;
+        struct iwm_priv *iwm;
+        int ret = 0;
+
+        wdev = iwm_wdev_alloc(sizeof_bus, dev);
+        if (!wdev) {
+                dev_err(dev, "no memory for wireless device instance\n");
+                return ERR_PTR(-ENOMEM);
+        }
+
+        iwm = wdev_to_iwm(wdev);
+        iwm->bus_ops = if_ops;
+        iwm->wdev = wdev;
+        iwm_priv_init(iwm);
+        wdev->iftype = iwm_mode_to_nl80211_iftype(iwm->conf.mode);
+
+        ndev = alloc_netdev_mq(0, "wlan%d", ether_setup,
+                               IWM_TX_QUEUES);
+        if (!ndev) {
+                dev_err(dev, "no memory for network device instance\n");
+                goto out_wdev;
+        }
+
+        ndev->netdev_ops = &iwm_netdev_ops;
+        ndev->wireless_handlers = &iwm_iw_handler_def;
+        ndev->ieee80211_ptr = wdev;
+        SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
+        ret = register_netdev(ndev);
+        if (ret < 0) {
+                dev_err(dev, "Failed to register netdev: %d\n", ret);
+                goto out_ndev;
+        }
+
+        wdev->netdev = ndev;
+
+        ret = iwm_rfkill_init(iwm);
+        if (ret) {
+                dev_err(dev, "Failed to init rfkill\n");
+                goto out_rfkill;
+        }
+
+        return iwm;
+
+ out_rfkill:
+        unregister_netdev(ndev);
+
+ out_ndev:
+        free_netdev(ndev);
+
+ out_wdev:
+        iwm_wdev_free(iwm);
+        return ERR_PTR(ret);
+}
+
+void iwm_if_free(struct iwm_priv *iwm)
+{
+        int i;
+
+        if (!iwm_to_ndev(iwm))
+                return;
+
+        iwm_rfkill_exit(iwm);
+        unregister_netdev(iwm_to_ndev(iwm));
+        free_netdev(iwm_to_ndev(iwm));
+        iwm_wdev_free(iwm);
+        destroy_workqueue(iwm->rx_wq);
+        for (i = 0; i < IWM_TX_QUEUES; i++)
+                destroy_workqueue(iwm->txq[i].wq);
+}