Commit | Line | Data |
---|---|---|
8ca151b5 JB |
1 | /****************************************************************************** |
2 | * | |
3 | * This file is provided under a dual BSD/GPLv2 license. When using or | |
4 | * redistributing this file, you may do so under either license. | |
5 | * | |
6 | * GPL LICENSE SUMMARY | |
7 | * | |
51368bf7 | 8 | * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. |
7089ae63 | 9 | * Copyright(c) 2017 Intel Deutschland GmbH |
8ca151b5 JB |
10 | * |
11 | * This program is free software; you can redistribute it and/or modify | |
12 | * it under the terms of version 2 of the GNU General Public License as | |
13 | * published by the Free Software Foundation. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, but | |
16 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
18 | * General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, | |
23 | * USA | |
24 | * | |
25 | * The full GNU General Public License is included in this distribution | |
410dc5aa | 26 | * in the file called COPYING. |
8ca151b5 JB |
27 | * |
28 | * Contact Information: | |
d01c5366 | 29 | * Intel Linux Wireless <linuxwifi@intel.com> |
8ca151b5 JB |
30 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
31 | * | |
32 | * BSD LICENSE | |
33 | * | |
51368bf7 | 34 | * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. |
7089ae63 | 35 | * Copyright(c) 2017 Intel Deutschland GmbH |
8ca151b5 JB |
36 | * All rights reserved. |
37 | * | |
38 | * Redistribution and use in source and binary forms, with or without | |
39 | * modification, are permitted provided that the following conditions | |
40 | * are met: | |
41 | * | |
42 | * * Redistributions of source code must retain the above copyright | |
43 | * notice, this list of conditions and the following disclaimer. | |
44 | * * Redistributions in binary form must reproduce the above copyright | |
45 | * notice, this list of conditions and the following disclaimer in | |
46 | * the documentation and/or other materials provided with the | |
47 | * distribution. | |
48 | * * Neither the name Intel Corporation nor the names of its | |
49 | * contributors may be used to endorse or promote products derived | |
50 | * from this software without specific prior written permission. | |
51 | * | |
52 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
53 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
54 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | |
55 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | |
56 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | |
57 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
58 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | |
59 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | |
60 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
61 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | |
62 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
63 | * | |
64 | *****************************************************************************/ | |
65 | ||
66 | #include <linux/leds.h> | |
67 | #include "iwl-io.h" | |
68 | #include "iwl-csr.h" | |
69 | #include "mvm.h" | |
70 | ||
7089ae63 | 71 | static void iwl_mvm_send_led_fw_cmd(struct iwl_mvm *mvm, bool on) |
8ca151b5 | 72 | { |
7089ae63 JB |
73 | struct iwl_led_cmd led_cmd = { |
74 | .status = cpu_to_le32(on), | |
75 | }; | |
76 | struct iwl_host_cmd cmd = { | |
77 | .id = WIDE_ID(LONG_GROUP, LEDS_CMD), | |
78 | .len = { sizeof(led_cmd), }, | |
79 | .data = { &led_cmd, }, | |
80 | .flags = CMD_ASYNC, | |
81 | }; | |
82 | int err; | |
83 | ||
84 | if (!iwl_mvm_firmware_running(mvm)) | |
85 | return; | |
86 | ||
87 | err = iwl_mvm_send_cmd(mvm, &cmd); | |
88 | ||
89 | if (err) | |
90 | IWL_WARN(mvm, "LED command failed: %d\n", err); | |
8ca151b5 JB |
91 | } |
92 | ||
7089ae63 | 93 | static void iwl_mvm_led_set(struct iwl_mvm *mvm, bool on) |
8ca151b5 | 94 | { |
2eabc84d LC |
95 | if (fw_has_capa(&mvm->fw->ucode_capa, |
96 | IWL_UCODE_TLV_CAPA_LED_CMD_SUPPORT)) { | |
7089ae63 JB |
97 | iwl_mvm_send_led_fw_cmd(mvm, on); |
98 | return; | |
99 | } | |
100 | ||
101 | iwl_write32(mvm->trans, CSR_LED_REG, | |
102 | on ? CSR_LED_REG_TURN_ON : CSR_LED_REG_TURN_OFF); | |
8ca151b5 JB |
103 | } |
104 | ||
105 | static void iwl_led_brightness_set(struct led_classdev *led_cdev, | |
106 | enum led_brightness brightness) | |
107 | { | |
108 | struct iwl_mvm *mvm = container_of(led_cdev, struct iwl_mvm, led); | |
7089ae63 JB |
109 | |
110 | iwl_mvm_led_set(mvm, brightness > 0); | |
8ca151b5 JB |
111 | } |
112 | ||
113 | int iwl_mvm_leds_init(struct iwl_mvm *mvm) | |
114 | { | |
115 | int mode = iwlwifi_mod_params.led_mode; | |
116 | int ret; | |
117 | ||
118 | switch (mode) { | |
1f00c721 EG |
119 | case IWL_LED_BLINK: |
120 | IWL_ERR(mvm, "Blink led mode not supported, used default\n"); | |
8ca151b5 JB |
121 | case IWL_LED_DEFAULT: |
122 | case IWL_LED_RF_STATE: | |
123 | mode = IWL_LED_RF_STATE; | |
124 | break; | |
125 | case IWL_LED_DISABLE: | |
126 | IWL_INFO(mvm, "Led disabled\n"); | |
127 | return 0; | |
128 | default: | |
129 | return -EINVAL; | |
14648d65 | 130 | } |
8ca151b5 JB |
131 | |
132 | mvm->led.name = kasprintf(GFP_KERNEL, "%s-led", | |
133 | wiphy_name(mvm->hw->wiphy)); | |
134 | mvm->led.brightness_set = iwl_led_brightness_set; | |
135 | mvm->led.max_brightness = 1; | |
136 | ||
137 | if (mode == IWL_LED_RF_STATE) | |
138 | mvm->led.default_trigger = | |
139 | ieee80211_get_radio_led_name(mvm->hw); | |
140 | ||
141 | ret = led_classdev_register(mvm->trans->dev, &mvm->led); | |
142 | if (ret) { | |
143 | kfree(mvm->led.name); | |
144 | IWL_INFO(mvm, "Failed to enable led\n"); | |
145 | return ret; | |
146 | } | |
147 | ||
de8ba41b | 148 | mvm->init_status |= IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE; |
8ca151b5 JB |
149 | return 0; |
150 | } | |
151 | ||
7089ae63 JB |
152 | void iwl_mvm_leds_sync(struct iwl_mvm *mvm) |
153 | { | |
154 | if (!(mvm->init_status & IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE)) | |
155 | return; | |
156 | ||
157 | /* | |
158 | * if we control through the register, we're doing it | |
159 | * even when the firmware isn't up, so no need to sync | |
160 | */ | |
161 | if (mvm->cfg->device_family < IWL_DEVICE_FAMILY_8000) | |
162 | return; | |
163 | ||
164 | iwl_mvm_led_set(mvm, mvm->led.brightness > 0); | |
165 | } | |
166 | ||
8ca151b5 JB |
167 | void iwl_mvm_leds_exit(struct iwl_mvm *mvm) |
168 | { | |
4aa234ee | 169 | if (!(mvm->init_status & IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE)) |
8ca151b5 JB |
170 | return; |
171 | ||
172 | led_classdev_unregister(&mvm->led); | |
173 | kfree(mvm->led.name); | |
de8ba41b | 174 | mvm->init_status &= ~IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE; |
8ca151b5 | 175 | } |