1 // SPDX-License-Identifier: BSD-3-Clause-Clear
2 /*
3  * Copyright (c) 2020 The Linux Foundation. All rights reserved.
4  * Copyright (c) 2022-2023 Qualcomm Innovation Center, Inc. All rights reserved.
5  */
6 
7 #include <linux/device.h>
8 #include <linux/sysfs.h>
9 #include <linux/thermal.h>
10 #include <linux/hwmon.h>
11 #include <linux/hwmon-sysfs.h>
12 #include "core.h"
13 #include "debug.h"
14 
15 static int
ath11k_thermal_get_max_throttle_state(struct thermal_cooling_device * cdev,unsigned long * state)16 ath11k_thermal_get_max_throttle_state(struct thermal_cooling_device *cdev,
17 				      unsigned long *state)
18 {
19 	*state = ATH11K_THERMAL_THROTTLE_MAX;
20 
21 	return 0;
22 }
23 
24 static int
ath11k_thermal_get_cur_throttle_state(struct thermal_cooling_device * cdev,unsigned long * state)25 ath11k_thermal_get_cur_throttle_state(struct thermal_cooling_device *cdev,
26 				      unsigned long *state)
27 {
28 	struct ath11k *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
ath11k_thermal_set_cur_throttle_state(struct thermal_cooling_device * cdev,unsigned long throttle_state)38 ath11k_thermal_set_cur_throttle_state(struct thermal_cooling_device *cdev,
39 				      unsigned long throttle_state)
40 {
41 	struct ath11k *ar = cdev->devdata;
42 	int ret;
43 
44 	if (throttle_state > ATH11K_THERMAL_THROTTLE_MAX) {
45 		ath11k_warn(ar->ab, "throttle state %ld is exceeding the limit %d\n",
46 			    throttle_state, ATH11K_THERMAL_THROTTLE_MAX);
47 		return -EINVAL;
48 	}
49 	mutex_lock(&ar->conf_mutex);
50 	ret = ath11k_thermal_set_throttling(ar, throttle_state);
51 	if (ret == 0)
52 		ar->thermal.throttle_state = throttle_state;
53 	mutex_unlock(&ar->conf_mutex);
54 	return ret;
55 }
56 
57 static const struct thermal_cooling_device_ops ath11k_thermal_ops = {
58 	.get_max_state = ath11k_thermal_get_max_throttle_state,
59 	.get_cur_state = ath11k_thermal_get_cur_throttle_state,
60 	.set_cur_state = ath11k_thermal_set_cur_throttle_state,
61 };
62 
ath11k_thermal_show_temp(struct device * dev,struct device_attribute * attr,char * buf)63 static ssize_t ath11k_thermal_show_temp(struct device *dev,
64 					struct device_attribute *attr,
65 					char *buf)
66 {
67 	struct ath11k *ar = dev_get_drvdata(dev);
68 	int ret, temperature;
69 	unsigned long time_left;
70 
71 	mutex_lock(&ar->conf_mutex);
72 
73 	/* Can't get temperature when the card is off */
74 	if (ar->state != ATH11K_STATE_ON) {
75 		ret = -ENETDOWN;
76 		goto out;
77 	}
78 
79 	reinit_completion(&ar->thermal.wmi_sync);
80 	ret = ath11k_wmi_send_pdev_temperature_cmd(ar);
81 	if (ret) {
82 		ath11k_warn(ar->ab, "failed to read temperature %d\n", ret);
83 		goto out;
84 	}
85 
86 	if (test_bit(ATH11K_FLAG_CRASH_FLUSH, &ar->ab->dev_flags)) {
87 		ret = -ESHUTDOWN;
88 		goto out;
89 	}
90 
91 	time_left = wait_for_completion_timeout(&ar->thermal.wmi_sync,
92 						ATH11K_THERMAL_SYNC_TIMEOUT_HZ);
93 	if (!time_left) {
94 		ath11k_warn(ar->ab, "failed to synchronize thermal read\n");
95 		ret = -ETIMEDOUT;
96 		goto out;
97 	}
98 
99 	spin_lock_bh(&ar->data_lock);
100 	temperature = ar->thermal.temperature;
101 	spin_unlock_bh(&ar->data_lock);
102 
103 	/* display in millidegree Celsius */
104 	ret = snprintf(buf, PAGE_SIZE, "%d\n", temperature * 1000);
105 out:
106 	mutex_unlock(&ar->conf_mutex);
107 	return ret;
108 }
109 
ath11k_thermal_event_temperature(struct ath11k * ar,int temperature)110 void ath11k_thermal_event_temperature(struct ath11k *ar, int temperature)
111 {
112 	spin_lock_bh(&ar->data_lock);
113 	ar->thermal.temperature = temperature;
114 	spin_unlock_bh(&ar->data_lock);
115 	complete(&ar->thermal.wmi_sync);
116 }
117 
118 static SENSOR_DEVICE_ATTR(temp1_input, 0444, ath11k_thermal_show_temp,
119 			  NULL, 0);
120 
121 static struct attribute *ath11k_hwmon_attrs[] = {
122 	&sensor_dev_attr_temp1_input.dev_attr.attr,
123 	NULL,
124 };
125 ATTRIBUTE_GROUPS(ath11k_hwmon);
126 
ath11k_thermal_set_throttling(struct ath11k * ar,u32 throttle_state)127 int ath11k_thermal_set_throttling(struct ath11k *ar, u32 throttle_state)
128 {
129 	struct ath11k_base *sc = ar->ab;
130 	struct thermal_mitigation_params param;
131 	int ret = 0;
132 
133 	lockdep_assert_held(&ar->conf_mutex);
134 
135 	if (ar->state != ATH11K_STATE_ON)
136 		return 0;
137 
138 	memset(&param, 0, sizeof(param));
139 	param.pdev_id = ar->pdev->pdev_id;
140 	param.enable = throttle_state ? 1 : 0;
141 	param.dc = ATH11K_THERMAL_DEFAULT_DUTY_CYCLE;
142 	param.dc_per_event = 0xFFFFFFFF;
143 
144 	param.levelconf[0].tmplwm = ATH11K_THERMAL_TEMP_LOW_MARK;
145 	param.levelconf[0].tmphwm = ATH11K_THERMAL_TEMP_HIGH_MARK;
146 	param.levelconf[0].dcoffpercent = throttle_state;
147 	param.levelconf[0].priority = 0; /* disable all data tx queues */
148 
149 	ret = ath11k_wmi_send_thermal_mitigation_param_cmd(ar, &param);
150 	if (ret) {
151 		ath11k_warn(sc, "failed to send thermal mitigation duty cycle %u ret %d\n",
152 			    throttle_state, ret);
153 	}
154 
155 	return ret;
156 }
157 
ath11k_thermal_register(struct ath11k_base * sc)158 int ath11k_thermal_register(struct ath11k_base *sc)
159 {
160 	struct thermal_cooling_device *cdev;
161 	struct device *hwmon_dev;
162 	struct ath11k *ar;
163 	struct ath11k_pdev *pdev;
164 	int i, ret;
165 
166 	for (i = 0; i < sc->num_radios; i++) {
167 		pdev = &sc->pdevs[i];
168 		ar = pdev->ar;
169 		if (!ar)
170 			continue;
171 
172 		cdev = thermal_cooling_device_register("ath11k_thermal", ar,
173 						       &ath11k_thermal_ops);
174 
175 		if (IS_ERR(cdev)) {
176 			ath11k_err(sc, "failed to setup thermal device result: %ld\n",
177 				   PTR_ERR(cdev));
178 			ret = -EINVAL;
179 			goto err_thermal_destroy;
180 		}
181 
182 		ar->thermal.cdev = cdev;
183 
184 		ret = sysfs_create_link(&ar->hw->wiphy->dev.kobj, &cdev->device.kobj,
185 					"cooling_device");
186 		if (ret) {
187 			ath11k_err(sc, "failed to create cooling device symlink\n");
188 			goto err_thermal_destroy;
189 		}
190 
191 		if (!IS_REACHABLE(CONFIG_HWMON))
192 			return 0;
193 
194 		hwmon_dev = devm_hwmon_device_register_with_groups(&ar->hw->wiphy->dev,
195 								   "ath11k_hwmon", ar,
196 								   ath11k_hwmon_groups);
197 		if (IS_ERR(hwmon_dev)) {
198 			ath11k_err(ar->ab, "failed to register hwmon device: %ld\n",
199 				   PTR_ERR(hwmon_dev));
200 			ret = -EINVAL;
201 			goto err_thermal_destroy;
202 		}
203 	}
204 
205 	return 0;
206 
207 err_thermal_destroy:
208 	ath11k_thermal_unregister(sc);
209 	return ret;
210 }
211 
ath11k_thermal_unregister(struct ath11k_base * sc)212 void ath11k_thermal_unregister(struct ath11k_base *sc)
213 {
214 	struct ath11k *ar;
215 	struct ath11k_pdev *pdev;
216 	int i;
217 
218 	for (i = 0; i < sc->num_radios; i++) {
219 		pdev = &sc->pdevs[i];
220 		ar = pdev->ar;
221 		if (!ar)
222 			continue;
223 
224 		sysfs_remove_link(&ar->hw->wiphy->dev.kobj, "cooling_device");
225 		thermal_cooling_device_unregister(ar->thermal.cdev);
226 	}
227 }
228