iwmc3200wifi: Add new Intel Wireless Multicomm 802.11 driver

This driver supports Intel's full MAC wireless multicomm 802.11 hardware.
Although the hardware is a 802.11agn device, we currently only support
802.11ag, in managed and ad-hoc mode (no AP mode for now).

Signed-off-by: Zhu Yi <yi.zhu@intel.com>
Signed-off-by: Samuel Ortiz <samuel.ortiz@intel.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

1 files changed, 88 insertions, 0 deletions

diff --git a/drivers/net/wireless/iwmc3200wifi/rfkill.c b/drivers/net/wireless/iwmc3200wifi/rfkill.c
new file mode 100644
index 000000000000..4ca8b495f82d
--- /dev/null
+++ b/drivers/net/wireless/iwmc3200wifi/rfkill.c
@@ -0,0 +1,88 @@
+/*
+ * 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.
+ *
+ */
+
+#include <linux/rfkill.h>
+
+#include "iwm.h"
+
+static int iwm_rfkill_soft_toggle(void *data, enum rfkill_state state)
+{
+        struct iwm_priv *iwm = data;
+
+        switch (state) {
+        case RFKILL_STATE_UNBLOCKED:
+                if (test_bit(IWM_RADIO_RFKILL_HW, &iwm->radio))
+                        return -EBUSY;
+
+                if (test_and_clear_bit(IWM_RADIO_RFKILL_SW, &iwm->radio) &&
+                    (iwm_to_ndev(iwm)->flags & IFF_UP))
+                        iwm_up(iwm);
+
+                break;
+        case RFKILL_STATE_SOFT_BLOCKED:
+                if (!test_and_set_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
+                        iwm_down(iwm);
+
+                break;
+        default:
+                break;
+        }
+
+        return 0;
+}
+
+int iwm_rfkill_init(struct iwm_priv *iwm)
+{
+        int ret;
+
+        iwm->rfkill = rfkill_allocate(iwm_to_dev(iwm), RFKILL_TYPE_WLAN);
+        if (!iwm->rfkill) {
+                IWM_ERR(iwm, "Unable to allocate rfkill device\n");
+                return -ENOMEM;
+        }
+
+        iwm->rfkill->name = KBUILD_MODNAME;
+        iwm->rfkill->data = iwm;
+        iwm->rfkill->state = RFKILL_STATE_UNBLOCKED;
+        iwm->rfkill->toggle_radio = iwm_rfkill_soft_toggle;
+
+        ret = rfkill_register(iwm->rfkill);
+        if (ret) {
+                IWM_ERR(iwm, "Failed to register rfkill device\n");
+                goto fail;
+        }
+
+        return 0;
+ fail:
+        rfkill_free(iwm->rfkill);
+        return ret;
+}
+
+void iwm_rfkill_exit(struct iwm_priv *iwm)
+{
+        if (iwm->rfkill)
+                rfkill_unregister(iwm->rfkill);
+
+        rfkill_free(iwm->rfkill);
+        iwm->rfkill = NULL;
+}