1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3 * Copyright (C) 2012-2014, 2018-2019 Intel Corporation
4 * Copyright (C) 2017 Intel Deutschland GmbH
5 */
6 #include <linux/leds.h>
7 #include "iwl-io.h"
8 #include "iwl-csr.h"
9 #include "mvm.h"
10
iwl_mvm_send_led_fw_cmd(struct iwl_mvm * mvm,bool on)11 static void iwl_mvm_send_led_fw_cmd(struct iwl_mvm *mvm, bool on)
12 {
13 struct iwl_led_cmd led_cmd = {
14 .status = cpu_to_le32(on),
15 };
16 struct iwl_host_cmd cmd = {
17 .id = WIDE_ID(LONG_GROUP, LEDS_CMD),
18 .len = { sizeof(led_cmd), },
19 .data = { &led_cmd, },
20 .flags = CMD_ASYNC,
21 };
22 int err;
23
24 if (!iwl_mvm_firmware_running(mvm))
25 return;
26
27 err = iwl_mvm_send_cmd(mvm, &cmd);
28
29 if (err)
30 IWL_WARN(mvm, "LED command failed: %d\n", err);
31 }
32
iwl_mvm_led_set(struct iwl_mvm * mvm,bool on)33 static void iwl_mvm_led_set(struct iwl_mvm *mvm, bool on)
34 {
35 if (fw_has_capa(&mvm->fw->ucode_capa,
36 IWL_UCODE_TLV_CAPA_LED_CMD_SUPPORT)) {
37 iwl_mvm_send_led_fw_cmd(mvm, on);
38 return;
39 }
40
41 iwl_write32(mvm->trans, CSR_LED_REG,
42 on ? CSR_LED_REG_TURN_ON : CSR_LED_REG_TURN_OFF);
43 }
44
iwl_led_brightness_set(struct led_classdev * led_cdev,enum led_brightness brightness)45 static void iwl_led_brightness_set(struct led_classdev *led_cdev,
46 enum led_brightness brightness)
47 {
48 struct iwl_mvm *mvm = container_of(led_cdev, struct iwl_mvm, led);
49
50 iwl_mvm_led_set(mvm, brightness > 0);
51 }
52
iwl_mvm_leds_init(struct iwl_mvm * mvm)53 int iwl_mvm_leds_init(struct iwl_mvm *mvm)
54 {
55 int mode = iwlwifi_mod_params.led_mode;
56 int ret;
57
58 switch (mode) {
59 case IWL_LED_BLINK:
60 IWL_ERR(mvm, "Blink led mode not supported, used default\n");
61 fallthrough;
62 case IWL_LED_DEFAULT:
63 case IWL_LED_RF_STATE:
64 mode = IWL_LED_RF_STATE;
65 break;
66 case IWL_LED_DISABLE:
67 IWL_INFO(mvm, "Led disabled\n");
68 return 0;
69 default:
70 return -EINVAL;
71 }
72
73 mvm->led.name = kasprintf(GFP_KERNEL, "%s-led",
74 wiphy_name(mvm->hw->wiphy));
75 if (!mvm->led.name)
76 return -ENOMEM;
77
78 mvm->led.brightness_set = iwl_led_brightness_set;
79 mvm->led.max_brightness = 1;
80
81 if (mode == IWL_LED_RF_STATE)
82 mvm->led.default_trigger =
83 ieee80211_get_radio_led_name(mvm->hw);
84
85 ret = led_classdev_register(mvm->trans->dev, &mvm->led);
86 if (ret) {
87 kfree(mvm->led.name);
88 IWL_INFO(mvm, "Failed to enable led\n");
89 return ret;
90 }
91
92 mvm->init_status |= IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE;
93 return 0;
94 }
95
iwl_mvm_leds_sync(struct iwl_mvm * mvm)96 void iwl_mvm_leds_sync(struct iwl_mvm *mvm)
97 {
98 if (!(mvm->init_status & IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE))
99 return;
100
101 /*
102 * if we control through the register, we're doing it
103 * even when the firmware isn't up, so no need to sync
104 */
105 if (mvm->trans->trans_cfg->device_family < IWL_DEVICE_FAMILY_8000)
106 return;
107
108 iwl_mvm_led_set(mvm, mvm->led.brightness > 0);
109 }
110
iwl_mvm_leds_exit(struct iwl_mvm * mvm)111 void iwl_mvm_leds_exit(struct iwl_mvm *mvm)
112 {
113 if (!(mvm->init_status & IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE))
114 return;
115
116 led_classdev_unregister(&mvm->led);
117 kfree(mvm->led.name);
118 mvm->init_status &= ~IWL_MVM_INIT_STATUS_LEDS_INIT_COMPLETE;
119 }
120