1 | /* |
2 | * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting |
3 | * Copyright (c) 2004-2005 Atheros Communications, Inc. |
4 | * Copyright (c) 2007 Jiri Slaby <jirislaby@gmail.com> |
5 | * Copyright (c) 2009 Bob Copeland <me@bobcopeland.com> |
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 (maximlevitsky@gmail.com) */ |
62 | { ATH_SDEVICE(PCI_VENDOR_ID_FOXCONN, 0xe008), ATH_LED(3, 0) }, |
63 | /* Acer Aspire One AO531h AO751h (keng-yu.lin@canonical.com) */ |
64 | { ATH_SDEVICE(PCI_VENDOR_ID_FOXCONN, 0xe00d), ATH_LED(3, 0) }, |
65 | /* Acer Ferrari 5000 (russ.dill@gmail.com) */ |
66 | { ATH_SDEVICE(PCI_VENDOR_ID_AMBIT, 0x0422), ATH_LED(1, 1) }, |
67 | /* E-machines E510 (tuliom@gmail.com) */ |
68 | { ATH_SDEVICE(PCI_VENDOR_ID_AMBIT, 0x0428), ATH_LED(3, 0) }, |
69 | /* BenQ Joybook R55v (nowymarluk@wp.pl) */ |
70 | { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0100), ATH_LED(1, 0) }, |
71 | /* Acer Extensa 5620z (nekoreeve@gmail.com) */ |
72 | { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0105), ATH_LED(3, 0) }, |
73 | /* Fukato Datacask Jupiter 1014a (mrb74@gmx.at) */ |
74 | { ATH_SDEVICE(PCI_VENDOR_ID_AZWAVE, 0x1026), ATH_LED(3, 0) }, |
75 | /* IBM ThinkPad AR5BXB6 (legovini@spiro.fisica.unipd.it) */ |
76 | { ATH_SDEVICE(PCI_VENDOR_ID_IBM, 0x058a), ATH_LED(1, 0) }, |
77 | /* HP Compaq CQ60-206US (ddreggors@jumptv.com) */ |
78 | { ATH_SDEVICE(PCI_VENDOR_ID_HP, 0x0137a), ATH_LED(3, 1) }, |
79 | /* HP Compaq C700 (nitrousnrg@gmail.com) */ |
80 | { ATH_SDEVICE(PCI_VENDOR_ID_HP, 0x0137b), ATH_LED(3, 0) }, |
81 | /* LiteOn AR5BXB63 (magooz@salug.it) */ |
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 (shahar@shahar-or.co.il) */ |
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, gpio: 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, gpio: ah->led_pin, val: 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, gpio: ah->led_pin, val: !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(ah: led->ah); |
123 | else |
124 | ath5k_led_on(ah: 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 | strscpy(led->name, name, sizeof(led->name)); |
135 | led->led_dev.name = led->name; |
136 | led->led_dev.default_trigger = trigger; |
137 | led->led_dev.brightness_set = ath5k_led_brightness_set; |
138 | |
139 | err = led_classdev_register(parent: ah->dev, led_cdev: &led->led_dev); |
140 | if (err) { |
141 | ATH5K_WARN(ah, "could not register LED %s\n" , name); |
142 | led->ah = NULL; |
143 | } |
144 | return err; |
145 | } |
146 | |
147 | static void |
148 | ath5k_unregister_led(struct ath5k_led *led) |
149 | { |
150 | if (!IS_ENABLED(CONFIG_MAC80211_LEDS) || !led->ah) |
151 | return; |
152 | led_classdev_unregister(led_cdev: &led->led_dev); |
153 | ath5k_led_off(ah: led->ah); |
154 | led->ah = NULL; |
155 | } |
156 | |
157 | void ath5k_unregister_leds(struct ath5k_hw *ah) |
158 | { |
159 | ath5k_unregister_led(led: &ah->rx_led); |
160 | ath5k_unregister_led(led: &ah->tx_led); |
161 | } |
162 | |
163 | int ath5k_init_leds(struct ath5k_hw *ah) |
164 | { |
165 | int ret = 0; |
166 | struct ieee80211_hw *hw = ah->hw; |
167 | #ifndef CONFIG_ATH5K_AHB |
168 | struct pci_dev *pdev = ah->pdev; |
169 | #endif |
170 | char name[ATH5K_LED_MAX_NAME_LEN + 1]; |
171 | const struct pci_device_id *match; |
172 | |
173 | if (!IS_ENABLED(CONFIG_MAC80211_LEDS) || !ah->pdev) |
174 | return 0; |
175 | |
176 | #ifdef CONFIG_ATH5K_AHB |
177 | match = NULL; |
178 | #else |
179 | match = pci_match_id(ids: &ath5k_led_devices[0], dev: pdev); |
180 | #endif |
181 | if (match) { |
182 | __set_bit(ATH_STAT_LEDSOFT, ah->status); |
183 | ah->led_pin = ATH_PIN(match->driver_data); |
184 | ah->led_on = ATH_POLARITY(match->driver_data); |
185 | } |
186 | |
187 | if (!test_bit(ATH_STAT_LEDSOFT, ah->status)) |
188 | goto out; |
189 | |
190 | ath5k_led_enable(ah); |
191 | |
192 | snprintf(buf: name, size: sizeof(name), fmt: "ath5k-%s::rx" , wiphy_name(wiphy: hw->wiphy)); |
193 | ret = ath5k_register_led(ah, led: &ah->rx_led, name, |
194 | trigger: ieee80211_get_rx_led_name(hw)); |
195 | if (ret) |
196 | goto out; |
197 | |
198 | snprintf(buf: name, size: sizeof(name), fmt: "ath5k-%s::tx" , wiphy_name(wiphy: hw->wiphy)); |
199 | ret = ath5k_register_led(ah, led: &ah->tx_led, name, |
200 | trigger: ieee80211_get_tx_led_name(hw)); |
201 | out: |
202 | return ret; |
203 | } |
204 | |
205 | |