LXR linux/drivers/net/wireless/ath/ath5k/rfkill.c

   1/*
   2 * RFKILL support for ath5k
   3 *
   4 * Copyright (c) 2009 Tobias Doerffel <tobias.doerffel@gmail.com>
   5 *
   6 * All rights reserved.
   7 *
   8 * Redistribution and use in source and binary forms, with or without
   9 * modification, are permitted provided that the following conditions
  10 * are met:
  11 * 1. Redistributions of source code must retain the above copyright
  12 *    notice, this list of conditions and the following disclaimer,
  13 *    without modification.
  14 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
  15 *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
  16 *    redistribution must be conditioned upon including a substantially
  17 *    similar Disclaimer requirement for further binary redistribution.
  18 * 3. Neither the names of the above-listed copyright holders nor the names
  19 *    of any contributors may be used to endorse or promote products derived
  20 *    from this software without specific prior written permission.
  21 *
  22 * NO WARRANTY
  23 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  24 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  25 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
  26 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
  27 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
  28 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  29 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  30 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
  31 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  32 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  33 * THE POSSIBILITY OF SUCH DAMAGES.
  34 */
  35
  36#include "ath5k.h"
  37
  38
  39static inline void ath5k_rfkill_disable(struct ath5k_hw *ah)
  40{
  41        ATH5K_DBG(ah, ATH5K_DEBUG_ANY, "rfkill disable (gpio:%d polarity:%d)\n",
  42                ah->rf_kill.gpio, ah->rf_kill.polarity);
  43        ath5k_hw_set_gpio_output(ah, ah->rf_kill.gpio);
  44        ath5k_hw_set_gpio(ah, ah->rf_kill.gpio, !ah->rf_kill.polarity);
  45}
  46
  47
  48static inline void ath5k_rfkill_enable(struct ath5k_hw *ah)
  49{
  50        ATH5K_DBG(ah, ATH5K_DEBUG_ANY, "rfkill enable (gpio:%d polarity:%d)\n",
  51                ah->rf_kill.gpio, ah->rf_kill.polarity);
  52        ath5k_hw_set_gpio_output(ah, ah->rf_kill.gpio);
  53        ath5k_hw_set_gpio(ah, ah->rf_kill.gpio, ah->rf_kill.polarity);
  54}
  55
  56static inline void ath5k_rfkill_set_intr(struct ath5k_hw *ah, bool enable)
  57{
  58        u32 curval;
  59
  60        ath5k_hw_set_gpio_input(ah, ah->rf_kill.gpio);
  61        curval = ath5k_hw_get_gpio(ah, ah->rf_kill.gpio);
  62        ath5k_hw_set_gpio_intr(ah, ah->rf_kill.gpio, enable ?
  63                                        !!curval : !curval);
  64}
  65
  66static bool
  67ath5k_is_rfkill_set(struct ath5k_hw *ah)
  68{
  69        /* configuring GPIO for input for some reason disables rfkill */
  70        /*ath5k_hw_set_gpio_input(ah, ah->rf_kill.gpio);*/
  71        return ath5k_hw_get_gpio(ah, ah->rf_kill.gpio) ==
  72                                                        ah->rf_kill.polarity;
  73}
  74
  75static void
  76ath5k_tasklet_rfkill_toggle(unsigned long data)
  77{
  78        struct ath5k_hw *ah = (void *)data;
  79        bool blocked;
  80
  81        blocked = ath5k_is_rfkill_set(ah);
  82        wiphy_rfkill_set_hw_state(ah->hw->wiphy, blocked);
  83}
  84
  85
  86void
  87ath5k_rfkill_hw_start(struct ath5k_hw *ah)
  88{
  89        /* read rfkill GPIO configuration from EEPROM header */
  90        ah->rf_kill.gpio = ah->ah_capabilities.cap_eeprom.ee_rfkill_pin;
  91        ah->rf_kill.polarity = ah->ah_capabilities.cap_eeprom.ee_rfkill_pol;
  92
  93        tasklet_init(&ah->rf_kill.toggleq, ath5k_tasklet_rfkill_toggle,
  94                (unsigned long)ah);
  95
  96        ath5k_rfkill_disable(ah);
  97
  98        /* enable interrupt for rfkill switch */
  99        if (AR5K_EEPROM_HDR_RFKILL(ah->ah_capabilities.cap_eeprom.ee_header))
 100                ath5k_rfkill_set_intr(ah, true);
 101}
 102
 103
 104void
 105ath5k_rfkill_hw_stop(struct ath5k_hw *ah)
 106{
 107        /* disable interrupt for rfkill switch */
 108        if (AR5K_EEPROM_HDR_RFKILL(ah->ah_capabilities.cap_eeprom.ee_header))
 109                ath5k_rfkill_set_intr(ah, false);
 110
 111        tasklet_kill(&ah->rf_kill.toggleq);
 112
 113        /* enable RFKILL when stopping HW so Wifi LED is turned off */
 114        ath5k_rfkill_enable(ah);
 115}
 116
 117