1 // SPDX-License-Identifier: GPL-2.0-only
4  * Driver for hwmon elements found on QNAP-MCU devices
11 #include <linux/mfd/qnap-mcu.h>
40 	ret = qnap_mcu_exec(hwm->mcu, cmd, sizeof(cmd), reply, sizeof(reply));  in qnap_mcu_hwmon_get_rpm()
44 	/* First 2 bytes must mirror the sent command */  in qnap_mcu_hwmon_get_rpm()
46 		return -EIO;  in qnap_mcu_hwmon_get_rpm()
53 	static const u8 cmd[] = { '@', 'F', 'Z', '0' }; /* 0 = fan-id? */  in qnap_mcu_hwmon_get_pwm()
58 	ret = qnap_mcu_exec(hwm->mcu, cmd, sizeof(cmd), reply, sizeof(reply));  in qnap_mcu_hwmon_get_pwm()
62 	/* First 3 bytes must mirror the sent command */  in qnap_mcu_hwmon_get_pwm()
64 		return -EIO;  in qnap_mcu_hwmon_get_pwm()
71 	const u8 cmd[] = { '@', 'F', 'W', '0', pwm }; /* 0 = fan-id?, pwm 0-255 */  in qnap_mcu_hwmon_set_pwm()
74 	return qnap_mcu_exec_with_ack(hwm->mcu, cmd, sizeof(cmd));  in qnap_mcu_hwmon_set_pwm()
84 	ret = qnap_mcu_exec(hwm->mcu, cmd, sizeof(cmd), reply, sizeof(reply));  in qnap_mcu_hwmon_get_temp()
88 	/* First bytes must mirror the sent command */  in qnap_mcu_hwmon_get_temp()
90 		return -EIO;  in qnap_mcu_hwmon_get_temp()
95 	 * original qnap firmware-tools, so just drop bit7 for now.  in qnap_mcu_hwmon_get_temp()
108 			return -EINVAL;  in qnap_mcu_hwmon_write()
111 			val = clamp_val(val, hwm->pwm_min, hwm->pwm_max);  in qnap_mcu_hwmon_write()
115 		return -EOPNOTSUPP;  in qnap_mcu_hwmon_write()
138 			return -EOPNOTSUPP;  in qnap_mcu_hwmon_read()
155 		return -EOPNOTSUPP;  in qnap_mcu_hwmon_read()
159 static umode_t qnap_mcu_hwmon_is_visible(const void *data,  in qnap_mcu_hwmon_is_visible()  argument
188 	struct qnap_mcu_hwmon *hwm = cdev->devdata;  in qnap_mcu_hwmon_get_max_state()
191 		return -EINVAL;  in qnap_mcu_hwmon_get_max_state()
193 	*state = hwm->fan_max_state;  in qnap_mcu_hwmon_get_max_state()
201 	struct qnap_mcu_hwmon *hwm = cdev->devdata;  in qnap_mcu_hwmon_get_cur_state()
204 		return -EINVAL;  in qnap_mcu_hwmon_get_cur_state()
206 	*state = hwm->fan_state;  in qnap_mcu_hwmon_get_cur_state()
214 	struct qnap_mcu_hwmon *hwm = cdev->devdata;  in qnap_mcu_hwmon_set_cur_state()
217 	if (!hwm || state > hwm->fan_max_state)  in qnap_mcu_hwmon_set_cur_state()
218 		return -EINVAL;  in qnap_mcu_hwmon_set_cur_state()
220 	if (state == hwm->fan_state)  in qnap_mcu_hwmon_set_cur_state()
223 	ret = qnap_mcu_hwmon_set_pwm(hwm, hwm->fan_cooling_levels[state]);  in qnap_mcu_hwmon_set_cur_state()
227 	hwm->fan_state = state;  in qnap_mcu_hwmon_set_cur_state()
238 static void devm_fan_node_release(void *data)  in devm_fan_node_release()  argument
240 	struct qnap_mcu_hwmon *hwm = data;  in devm_fan_node_release()
242 	fwnode_handle_put(hwm->fan_node);  in devm_fan_node_release()
250 	fwnode = device_get_named_child_node(dev->parent, "fan-0");  in qnap_mcu_hwmon_get_cooling_data()
254 	/* if we found the fan-node, we're keeping it until device-unbind */  in qnap_mcu_hwmon_get_cooling_data()
255 	hwm->fan_node = fwnode;  in qnap_mcu_hwmon_get_cooling_data()
260 	num = fwnode_property_count_u32(fwnode, "cooling-levels");  in qnap_mcu_hwmon_get_cooling_data()
262 		return dev_err_probe(dev, num ? : -EINVAL,  in qnap_mcu_hwmon_get_cooling_data()
263 				     "Failed to count elements in 'cooling-levels'\n");  in qnap_mcu_hwmon_get_cooling_data()
265 	hwm->fan_cooling_levels = devm_kcalloc(dev, num, sizeof(u32),  in qnap_mcu_hwmon_get_cooling_data()
267 	if (!hwm->fan_cooling_levels)  in qnap_mcu_hwmon_get_cooling_data()
268 		return -ENOMEM;  in qnap_mcu_hwmon_get_cooling_data()
270 	ret = fwnode_property_read_u32_array(fwnode, "cooling-levels",  in qnap_mcu_hwmon_get_cooling_data()
271 					     hwm->fan_cooling_levels, num);  in qnap_mcu_hwmon_get_cooling_data()
273 		return dev_err_probe(dev, ret, "Failed to read 'cooling-levels'\n");  in qnap_mcu_hwmon_get_cooling_data()
276 		if (hwm->fan_cooling_levels[i] > hwm->pwm_max)  in qnap_mcu_hwmon_get_cooling_data()
277 			return dev_err_probe(dev, -EINVAL, "fan state[%d]:%d > %d\n", i,  in qnap_mcu_hwmon_get_cooling_data()
278 					     hwm->fan_cooling_levels[i], hwm->pwm_max);  in qnap_mcu_hwmon_get_cooling_data()
281 	hwm->fan_max_state = num - 1;  in qnap_mcu_hwmon_get_cooling_data()
295 	struct qnap_mcu *mcu = dev_get_drvdata(pdev->dev.parent);  in qnap_mcu_hwmon_probe()
296 	const struct qnap_mcu_variant *variant = pdev->dev.platform_data;  in qnap_mcu_hwmon_probe()
299 	struct device *dev = &pdev->dev;  in qnap_mcu_hwmon_probe()
305 		return -ENOMEM;  in qnap_mcu_hwmon_probe()
307 	hwm->mcu = mcu;  in qnap_mcu_hwmon_probe()
308 	hwm->dev = &pdev->dev;  in qnap_mcu_hwmon_probe()
309 	hwm->pwm_min = variant->fan_pwm_min;  in qnap_mcu_hwmon_probe()
310 	hwm->pwm_max = variant->fan_pwm_max;  in qnap_mcu_hwmon_probe()
317 	ret = qnap_mcu_hwmon_set_pwm(hwm, hwm->pwm_max);  in qnap_mcu_hwmon_probe()
321 	hwm->info.ops = &qnap_mcu_hwmon_hwmon_ops;  in qnap_mcu_hwmon_probe()
322 	hwm->info.info = qnap_mcu_hwmon_channels;  in qnap_mcu_hwmon_probe()
328 	hwm->fan_state = hwm->fan_max_state;  in qnap_mcu_hwmon_probe()
331 						     hwm, &hwm->info, NULL);  in qnap_mcu_hwmon_probe()
336 	 * Only register cooling device when we found cooling-levels.  in qnap_mcu_hwmon_probe()
340 	if (IS_ENABLED(CONFIG_THERMAL) && hwm->fan_cooling_levels) {  in qnap_mcu_hwmon_probe()
342 					to_of_node(hwm->fan_node), "qnap-mcu-hwmon",  in qnap_mcu_hwmon_probe()
346 				"Failed to register qnap-mcu-hwmon as cooling device\n");  in qnap_mcu_hwmon_probe()
347 		hwm->cdev = cdev;  in qnap_mcu_hwmon_probe()
356 		.name = "qnap-mcu-hwmon",
361 MODULE_ALIAS("platform:qnap-mcu-hwmon");