1 // SPDX-License-Identifier: ISC
2 /*
3  * Copyright (c) 2014-2015 Qualcomm Atheros, Inc.
4  */
5 
6 #include <linux/device.h>
7 #include <linux/sysfs.h>
8 #include <linux/thermal.h>
9 #include <linux/hwmon.h>
10 #include <linux/hwmon-sysfs.h>
11 #include "core.h"
12 #include "debug.h"
13 #include "wmi-ops.h"
14 
15 static int
ath10k_thermal_get_max_throttle_state(struct thermal_cooling_device * cdev,unsigned long * state)16 ath10k_thermal_get_max_throttle_state(struct thermal_cooling_device *cdev,
17 				      unsigned long *state)
18 {
19 	*state = ATH10K_THERMAL_THROTTLE_MAX;
20 
21 	return 0;
22 }
23 
24 static int
ath10k_thermal_get_cur_throttle_state(struct thermal_cooling_device * cdev,unsigned long * state)25 ath10k_thermal_get_cur_throttle_state(struct thermal_cooling_device *cdev,
26 				      unsigned long *state)
27 {
28 	struct ath10k *ar = cdev->devdata;
29 
30 	mutex_lock(&ar->conf_mutex);
31 	*state = ar->thermal.throttle_state;
32 	mutex_unlock(&ar->conf_mutex);
33 
34 	return 0;
35 }
36 
37 static int
ath10k_thermal_set_cur_throttle_state(struct thermal_cooling_device * cdev,unsigned long throttle_state)38 ath10k_thermal_set_cur_throttle_state(struct thermal_cooling_device *cdev,
39 				      unsigned long throttle_state)
40 {
41 	struct ath10k *ar = cdev->devdata;
42 
43 	if (throttle_state > ATH10K_THERMAL_THROTTLE_MAX) {
44 		ath10k_warn(ar, "throttle state %ld is exceeding the limit %d\n",
45 			    throttle_state, ATH10K_THERMAL_THROTTLE_MAX);
46 		return -EINVAL;
47 	}
48 	mutex_lock(&ar->conf_mutex);
49 	ar->thermal.throttle_state = throttle_state;
50 	ath10k_thermal_set_throttling(ar);
51 	mutex_unlock(&ar->conf_mutex);
52 	return 0;
53 }
54 
55 static const struct thermal_cooling_device_ops ath10k_thermal_ops = {
56 	.get_max_state = ath10k_thermal_get_max_throttle_state,
57 	.get_cur_state = ath10k_thermal_get_cur_throttle_state,
58 	.set_cur_state = ath10k_thermal_set_cur_throttle_state,
59 };
60 
ath10k_thermal_show_temp(struct device * dev,struct device_attribute * attr,char * buf)61 static ssize_t ath10k_thermal_show_temp(struct device *dev,
62 					struct device_attribute *attr,
63 					char *buf)
64 {
65 	struct ath10k *ar = dev_get_drvdata(dev);
66 	int ret, temperature;
67 	unsigned long time_left;
68 
69 	mutex_lock(&ar->conf_mutex);
70 
71 	/* Can't get temperature when the card is off */
72 	if (ar->state != ATH10K_STATE_ON) {
73 		ret = -ENETDOWN;
74 		goto out;
75 	}
76 
77 	reinit_completion(&ar->thermal.wmi_sync);
78 	ret = ath10k_wmi_pdev_get_temperature(ar);
79 	if (ret) {
80 		ath10k_warn(ar, "failed to read temperature %d\n", ret);
81 		goto out;
82 	}
83 
84 	if (test_bit(ATH10K_FLAG_CRASH_FLUSH, &ar->dev_flags)) {
85 		ret = -ESHUTDOWN;
86 		goto out;
87 	}
88 
89 	time_left = wait_for_completion_timeout(&ar->thermal.wmi_sync,
90 						ATH10K_THERMAL_SYNC_TIMEOUT_HZ);
91 	if (!time_left) {
92 		ath10k_warn(ar, "failed to synchronize thermal read\n");
93 		ret = -ETIMEDOUT;
94 		goto out;
95 	}
96 
97 	spin_lock_bh(&ar->data_lock);
98 	temperature = ar->thermal.temperature;
99 	spin_unlock_bh(&ar->data_lock);
100 
101 	/* display in millidegree celsius */
102 	ret = snprintf(buf, PAGE_SIZE, "%d\n", temperature * 1000);
103 out:
104 	mutex_unlock(&ar->conf_mutex);
105 	return ret;
106 }
107 
ath10k_thermal_event_temperature(struct ath10k * ar,int temperature)108 void ath10k_thermal_event_temperature(struct ath10k *ar, int temperature)
109 {
110 	spin_lock_bh(&ar->data_lock);
111 	ar->thermal.temperature = temperature;
112 	spin_unlock_bh(&ar->data_lock);
113 	complete(&ar->thermal.wmi_sync);
114 }
115 
116 static SENSOR_DEVICE_ATTR(temp1_input, 0444, ath10k_thermal_show_temp,
117 			  NULL, 0);
118 
119 static struct attribute *ath10k_hwmon_attrs[] = {
120 	&sensor_dev_attr_temp1_input.dev_attr.attr,
121 	NULL,
122 };
123 ATTRIBUTE_GROUPS(ath10k_hwmon);
124 
ath10k_thermal_set_throttling(struct ath10k * ar)125 void ath10k_thermal_set_throttling(struct ath10k *ar)
126 {
127 	u32 period, duration, enabled;
128 	int ret;
129 
130 	lockdep_assert_held(&ar->conf_mutex);
131 
132 	if (!test_bit(WMI_SERVICE_THERM_THROT, ar->wmi.svc_map))
133 		return;
134 
135 	if (!ar->wmi.ops->gen_pdev_set_quiet_mode)
136 		return;
137 
138 	if (ar->state != ATH10K_STATE_ON)
139 		return;
140 
141 	period = ar->thermal.quiet_period;
142 	duration = (period * ar->thermal.throttle_state) / 100;
143 	enabled = duration ? 1 : 0;
144 
145 	ret = ath10k_wmi_pdev_set_quiet_mode(ar, period, duration,
146 					     ATH10K_QUIET_START_OFFSET,
147 					     enabled);
148 	if (ret) {
149 		ath10k_warn(ar, "failed to set quiet mode period %u duarion %u enabled %u ret %d\n",
150 			    period, duration, enabled, ret);
151 	}
152 }
153 
ath10k_thermal_register(struct ath10k * ar)154 int ath10k_thermal_register(struct ath10k *ar)
155 {
156 	struct thermal_cooling_device *cdev;
157 	struct device *hwmon_dev;
158 	int ret;
159 
160 	if (!test_bit(WMI_SERVICE_THERM_THROT, ar->wmi.svc_map))
161 		return 0;
162 
163 	cdev = thermal_cooling_device_register("ath10k_thermal", ar,
164 					       &ath10k_thermal_ops);
165 
166 	if (IS_ERR(cdev)) {
167 		ath10k_err(ar, "failed to setup thermal device result: %ld\n",
168 			   PTR_ERR(cdev));
169 		return -EINVAL;
170 	}
171 
172 	ret = sysfs_create_link(&ar->dev->kobj, &cdev->device.kobj,
173 				"cooling_device");
174 	if (ret) {
175 		ath10k_err(ar, "failed to create cooling device symlink\n");
176 		goto err_cooling_destroy;
177 	}
178 
179 	ar->thermal.cdev = cdev;
180 	ar->thermal.quiet_period = ATH10K_QUIET_PERIOD_DEFAULT;
181 
182 	/* Do not register hwmon device when temperature reading is not
183 	 * supported by firmware
184 	 */
185 	if (!(ar->wmi.ops->gen_pdev_get_temperature))
186 		return 0;
187 
188 	/* Avoid linking error on devm_hwmon_device_register_with_groups, I
189 	 * guess linux/hwmon.h is missing proper stubs.
190 	 */
191 	if (!IS_REACHABLE(CONFIG_HWMON))
192 		return 0;
193 
194 	hwmon_dev = devm_hwmon_device_register_with_groups(ar->dev,
195 							   "ath10k_hwmon", ar,
196 							   ath10k_hwmon_groups);
197 	if (IS_ERR(hwmon_dev)) {
198 		ath10k_err(ar, "failed to register hwmon device: %ld\n",
199 			   PTR_ERR(hwmon_dev));
200 		ret = -EINVAL;
201 		goto err_remove_link;
202 	}
203 	return 0;
204 
205 err_remove_link:
206 	sysfs_remove_link(&ar->dev->kobj, "cooling_device");
207 err_cooling_destroy:
208 	thermal_cooling_device_unregister(cdev);
209 	return ret;
210 }
211 
ath10k_thermal_unregister(struct ath10k * ar)212 void ath10k_thermal_unregister(struct ath10k *ar)
213 {
214 	if (!test_bit(WMI_SERVICE_THERM_THROT, ar->wmi.svc_map))
215 		return;
216 
217 	sysfs_remove_link(&ar->dev->kobj, "cooling_device");
218 	thermal_cooling_device_unregister(ar->thermal.cdev);
219 }
220