drivers/net/wireless/rtl818x/rtl8187_rfkill.c

   1 /*
   2  * Linux RFKILL support for RTL8187
   3  *
   4  * Copyright (c) 2009 Herton Ronaldo Krzesinski <herton@mandriva.com.br>
   5  *
   6  * Based on the RFKILL handling in the r8187 driver, which is:
   7  * Copyright (c) Realtek Semiconductor Corp. All rights reserved.
   8  *
   9  * Thanks to Realtek for their support!
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  */
  15
  16 #include <linux/types.h>
  17 #include <linux/usb.h>
  18 #include <net/mac80211.h>
  19
  20 #include "rtl8187.h"
  21
  22 static bool rtl8187_is_radio_enabled(struct rtl8187_priv *priv)
  23 {
  24         u8 gpio;
  25
  26         gpio = rtl818x_ioread8(priv, &priv->map->GPIO0);
  27         rtl818x_iowrite8(priv, &priv->map->GPIO0, gpio & ~0x02);
  28         gpio = rtl818x_ioread8(priv, &priv->map->GPIO1);
  29
  30         return gpio & 0x02;
  31 }
  32
  33 void rtl8187_rfkill_init(struct ieee80211_hw *hw)
  34 {
  35         struct rtl8187_priv *priv = hw->priv;
  36
  37         priv->rfkill_off = rtl8187_is_radio_enabled(priv);
  38         printk(KERN_INFO "rtl8187: wireless switch is %s\n",
  39                priv->rfkill_off ? "on" : "off");
  40         wiphy_rfkill_set_hw_state(hw->wiphy, !priv->rfkill_off);
  41         wiphy_rfkill_start_polling(hw->wiphy);
  42 }
  43
  44 void rtl8187_rfkill_poll(struct ieee80211_hw *hw)
  45 {
  46         bool enabled;
  47         struct rtl8187_priv *priv = hw->priv;
  48
  49         mutex_lock(&priv->conf_mutex);
  50         enabled = rtl8187_is_radio_enabled(priv);
  51         if (unlikely(enabled != priv->rfkill_off)) {
  52                 priv->rfkill_off = enabled;
  53                 printk(KERN_INFO "rtl8187: wireless radio switch turned %s\n",
  54                        enabled ? "on" : "off");
  55                 wiphy_rfkill_set_hw_state(hw->wiphy, !enabled);
  56         }
  57         mutex_unlock(&priv->conf_mutex);
  58 }
  59
  60 void rtl8187_rfkill_exit(struct ieee80211_hw *hw)
  61 {
  62         wiphy_rfkill_stop_polling(hw->wiphy);
  63 }