drivers/net/wireless/ath/ath5k/led.c

   1 /*
   2  * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
   3  * Copyright (c) 2004-2005 Atheros Communications, Inc.
   4  * Copyright (c) 2007 Jiri Slaby <[email protected]>
   5  * Copyright (c) 2009 Bob Copeland <[email protected]>
   6  *
   7  * All rights reserved.
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice, this list of conditions and the following disclaimer,
  14  *    without modification.
  15  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
  16  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
  17  *    redistribution must be conditioned upon including a substantially
  18  *    similar Disclaimer requirement for further binary redistribution.
  19  * 3. Neither the names of the above-listed copyright holders nor the names
  20  *    of any contributors may be used to endorse or promote products derived
  21  *    from this software without specific prior written permission.
  22  *
  23  * Alternatively, this software may be distributed under the terms of the
  24  * GNU General Public License ("GPL") version 2 as published by the Free
  25  * Software Foundation.
  26  *
  27  * NO WARRANTY
  28  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  29  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  30  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
  31  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
  32  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
  33  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  34  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  35  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
  36  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  37  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  38  * THE POSSIBILITY OF SUCH DAMAGES.
  39  *
  40  */
  41
  42 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  43
  44 #include <linux/pci.h>
  45 #include "ath5k.h"
  46
  47 #define ATH_SDEVICE(subv, subd) \
  48         .vendor = PCI_ANY_ID, .device = PCI_ANY_ID, \
  49         .subvendor = (subv), .subdevice = (subd)
  50
  51 #define ATH_LED(pin, polarity) .driver_data = (((pin) << 8) | (polarity))
  52 #define ATH_PIN(data) ((data) >> 8)
  53 #define ATH_POLARITY(data) ((data) & 0xff)
  54
  55 /* Devices we match on for LED config info (typically laptops) */
  56 static const struct pci_device_id ath5k_led_devices[] = {
  57         /* AR5211 */
  58         { PCI_VDEVICE(ATHEROS, PCI_DEVICE_ID_ATHEROS_AR5211), ATH_LED(0, 0) },
  59         /* HP Compaq nc6xx, nc4000, nx6000 */
  60         { ATH_SDEVICE(PCI_VENDOR_ID_COMPAQ, PCI_ANY_ID), ATH_LED(1, 1) },
  61         /* Acer Aspire One A150 ([email protected]) */
  62         { ATH_SDEVICE(PCI_VENDOR_ID_FOXCONN, 0xe008), ATH_LED(3, 0) },
  63         /* Acer Aspire One AO531h AO751h ([email protected]) */
  64         { ATH_SDEVICE(PCI_VENDOR_ID_FOXCONN, 0xe00d), ATH_LED(3, 0) },
  65         /* Acer Ferrari 5000 ([email protected]) */
  66         { ATH_SDEVICE(PCI_VENDOR_ID_AMBIT, 0x0422), ATH_LED(1, 1) },
  67         /* E-machines E510 ([email protected]) */
  68         { ATH_SDEVICE(PCI_VENDOR_ID_AMBIT, 0x0428), ATH_LED(3, 0) },
  69         /* BenQ Joybook R55v ([email protected]) */
  70         { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0100), ATH_LED(1, 0) },
  71         /* Acer Extensa 5620z ([email protected]) */
  72         { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0105), ATH_LED(3, 0) },
  73         /* Fukato Datacask Jupiter 1014a ([email protected]) */
  74         { ATH_SDEVICE(PCI_VENDOR_ID_AZWAVE, 0x1026), ATH_LED(3, 0) },
  75         /* IBM ThinkPad AR5BXB6 ([email protected]) */
  76         { ATH_SDEVICE(PCI_VENDOR_ID_IBM, 0x058a), ATH_LED(1, 0) },
  77         /* HP Compaq CQ60-206US ([email protected]) */
  78         { ATH_SDEVICE(PCI_VENDOR_ID_HP, 0x0137a), ATH_LED(3, 1) },
  79         /* HP Compaq C700 ([email protected]) */
  80         { ATH_SDEVICE(PCI_VENDOR_ID_HP, 0x0137b), ATH_LED(3, 0) },
  81         /* LiteOn AR5BXB63 ([email protected]) */
  82         { ATH_SDEVICE(PCI_VENDOR_ID_ATHEROS, 0x3067), ATH_LED(3, 0) },
  83         /* IBM-specific AR5212 (all others) */
  84         { PCI_VDEVICE(ATHEROS, PCI_DEVICE_ID_ATHEROS_AR5212_IBM), ATH_LED(0, 0) },
  85         /* Dell Vostro A860 ([email protected]) */
  86         { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0112), ATH_LED(3, 0) },
  87         { }
  88 };
  89
  90 void ath5k_led_enable(struct ath5k_hw *ah)
  91 {
  92         if (IS_ENABLED(CONFIG_MAC80211_LEDS) &&
  93             test_bit(ATH_STAT_LEDSOFT, ah->status)) {
  94                 ath5k_hw_set_gpio_output(ah, ah->led_pin);
  95                 ath5k_led_off(ah);
  96         }
  97 }
  98
  99 static void ath5k_led_on(struct ath5k_hw *ah)
 100 {
 101         if (!test_bit(ATH_STAT_LEDSOFT, ah->status))
 102                 return;
 103         ath5k_hw_set_gpio(ah, ah->led_pin, ah->led_on);
 104 }
 105
 106 void ath5k_led_off(struct ath5k_hw *ah)
 107 {
 108         if (!IS_ENABLED(CONFIG_MAC80211_LEDS) ||
 109             !test_bit(ATH_STAT_LEDSOFT, ah->status))
 110                 return;
 111         ath5k_hw_set_gpio(ah, ah->led_pin, !ah->led_on);
 112 }
 113
 114 static void
 115 ath5k_led_brightness_set(struct led_classdev *led_dev,
 116         enum led_brightness brightness)
 117 {
 118         struct ath5k_led *led = container_of(led_dev, struct ath5k_led,
 119                 led_dev);
 120
 121         if (brightness == LED_OFF)
 122                 ath5k_led_off(led->ah);
 123         else
 124                 ath5k_led_on(led->ah);
 125 }
 126
 127 static int
 128 ath5k_register_led(struct ath5k_hw *ah, struct ath5k_led *led,
 129                    const char *name, const char *trigger)
 130 {
 131         int err;
 132
 133         led->ah = ah;
 134         strncpy(led->name, name, sizeof(led->name));
 135         led->name[sizeof(led->name)-1] = 0;
 136         led->led_dev.name = led->name;
 137         led->led_dev.default_trigger = trigger;
 138         led->led_dev.brightness_set = ath5k_led_brightness_set;
 139
 140         err = led_classdev_register(ah->dev, &led->led_dev);
 141         if (err) {
 142                 ATH5K_WARN(ah, "could not register LED %s\n", name);
 143                 led->ah = NULL;
 144         }
 145         return err;
 146 }
 147
 148 static void
 149 ath5k_unregister_led(struct ath5k_led *led)
 150 {
 151         if (!IS_ENABLED(CONFIG_MAC80211_LEDS) || !led->ah)
 152                 return;
 153         led_classdev_unregister(&led->led_dev);
 154         ath5k_led_off(led->ah);
 155         led->ah = NULL;
 156 }
 157
 158 void ath5k_unregister_leds(struct ath5k_hw *ah)
 159 {
 160         ath5k_unregister_led(&ah->rx_led);
 161         ath5k_unregister_led(&ah->tx_led);
 162 }
 163
 164 int ath5k_init_leds(struct ath5k_hw *ah)
 165 {
 166         int ret = 0;
 167         struct ieee80211_hw *hw = ah->hw;
 168 #ifndef CONFIG_ATH5K_AHB
 169         struct pci_dev *pdev = ah->pdev;
 170 #endif
 171         char name[ATH5K_LED_MAX_NAME_LEN + 1];
 172         const struct pci_device_id *match;
 173
 174         if (!IS_ENABLED(CONFIG_MAC80211_LEDS) || !ah->pdev)
 175                 return 0;
 176
 177 #ifdef CONFIG_ATH5K_AHB
 178         match = NULL;
 179 #else
 180         match = pci_match_id(&ath5k_led_devices[0], pdev);
 181 #endif
 182         if (match) {
 183                 __set_bit(ATH_STAT_LEDSOFT, ah->status);
 184                 ah->led_pin = ATH_PIN(match->driver_data);
 185                 ah->led_on = ATH_POLARITY(match->driver_data);
 186         }
 187
 188         if (!test_bit(ATH_STAT_LEDSOFT, ah->status))
 189                 goto out;
 190
 191         ath5k_led_enable(ah);
 192
 193         snprintf(name, sizeof(name), "ath5k-%s::rx", wiphy_name(hw->wiphy));
 194         ret = ath5k_register_led(ah, &ah->rx_led, name,
 195                 ieee80211_get_rx_led_name(hw));
 196         if (ret)
 197                 goto out;
 198
 199         snprintf(name, sizeof(name), "ath5k-%s::tx", wiphy_name(hw->wiphy));
 200         ret = ath5k_register_led(ah, &ah->tx_led, name,
 201                 ieee80211_get_tx_led_name(hw));
 202 out:
 203         return ret;
 204 }
 205