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 * 8 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 9 * Copyright(c) 2017 Intel Deutschland GmbH 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 26 * in the file called COPYING. 27 * 28 * Contact Information: 29 * Intel Linux Wireless <linuxwifi@intel.com> 30 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 31 * 32 * BSD LICENSE 33 * 34 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 35 * Copyright(c) 2017 Intel Deutschland GmbH 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 71 static void iwl_mvm_send_led_fw_cmd(struct iwl_mvm *mvm, bool on) 72 { 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); 91 } 92 93 static void iwl_mvm_led_set(struct iwl_mvm *mvm, bool on) 94 { 95 if (fw_has_capa(&mvm->fw->ucode_capa, 96 IWL_UCODE_TLV_CAPA_LED_CMD_SUPPORT)) { 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); 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); 109 110 iwl_mvm_led_set(mvm, brightness > 0); 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) { 119 case IWL_LED_BLINK: 120 IWL_ERR(mvm, "Blink led mode not supported, used default\n"); 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; 130 } 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 148 mvm->init_status |= IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE; 149 return 0; 150 } 151 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 167 void iwl_mvm_leds_exit(struct iwl_mvm *mvm) 168 { 169 if (!(mvm->init_status & IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE)) 170 return; 171 172 led_classdev_unregister(&mvm->led); 173 kfree(mvm->led.name); 174 mvm->init_status &= ~IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE; 175 } 176