1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Fan Control HDL CORE driver
4  *
5  * Copyright 2019 Analog Devices Inc.
6  */
7 #include <linux/bits.h>
8 #include <linux/clk.h>
9 #include <linux/fpga/adi-axi-common.h>
10 #include <linux/hwmon.h>
11 #include <linux/interrupt.h>
12 #include <linux/io.h>
13 #include <linux/kernel.h>
14 #include <linux/module.h>
15 #include <linux/of.h>
16 #include <linux/platform_device.h>
17 
18 /* register map */
19 #define ADI_REG_RSTN		0x0080
20 #define ADI_REG_PWM_WIDTH	0x0084
21 #define ADI_REG_TACH_PERIOD	0x0088
22 #define ADI_REG_TACH_TOLERANCE	0x008c
23 #define ADI_REG_PWM_PERIOD	0x00c0
24 #define ADI_REG_TACH_MEASUR	0x00c4
25 #define ADI_REG_TEMPERATURE	0x00c8
26 
27 #define ADI_REG_IRQ_MASK	0x0040
28 #define ADI_REG_IRQ_PENDING	0x0044
29 #define ADI_REG_IRQ_SRC		0x0048
30 
31 /* IRQ sources */
32 #define ADI_IRQ_SRC_PWM_CHANGED		BIT(0)
33 #define ADI_IRQ_SRC_TACH_ERR		BIT(1)
34 #define ADI_IRQ_SRC_TEMP_INCREASE	BIT(2)
35 #define ADI_IRQ_SRC_NEW_MEASUR		BIT(3)
36 #define ADI_IRQ_SRC_MASK		GENMASK(3, 0)
37 #define ADI_IRQ_MASK_OUT_ALL		0xFFFFFFFFU
38 
39 #define SYSFS_PWM_MAX			255
40 
41 struct axi_fan_control_data {
42 	void __iomem *base;
43 	struct device *hdev;
44 	unsigned long clk_rate;
45 	int irq;
46 	/* pulses per revolution */
47 	u32 ppr;
48 	bool hw_pwm_req;
49 	bool update_tacho_params;
50 	u8 fan_fault;
51 };
52 
53 static inline void axi_iowrite(const u32 val, const u32 reg,
54 			       const struct axi_fan_control_data *ctl)
55 {
56 	iowrite32(val, ctl->base + reg);
57 }
58 
59 static inline u32 axi_ioread(const u32 reg,
60 			     const struct axi_fan_control_data *ctl)
61 {
62 	return ioread32(ctl->base + reg);
63 }
64 
65 static long axi_fan_control_get_pwm_duty(const struct axi_fan_control_data *ctl)
66 {
67 	u32 pwm_width = axi_ioread(ADI_REG_PWM_WIDTH, ctl);
68 	u32 pwm_period = axi_ioread(ADI_REG_PWM_PERIOD, ctl);
69 	/*
70 	 * PWM_PERIOD is a RO register set by the core. It should never be 0.
71 	 * For now we are trusting the HW...
72 	 */
73 	return DIV_ROUND_CLOSEST(pwm_width * SYSFS_PWM_MAX, pwm_period);
74 }
75 
76 static int axi_fan_control_set_pwm_duty(const long val,
77 					struct axi_fan_control_data *ctl)
78 {
79 	u32 pwm_period = axi_ioread(ADI_REG_PWM_PERIOD, ctl);
80 	u32 new_width;
81 	long __val = clamp_val(val, 0, SYSFS_PWM_MAX);
82 
83 	new_width = DIV_ROUND_CLOSEST(__val * pwm_period, SYSFS_PWM_MAX);
84 
85 	axi_iowrite(new_width, ADI_REG_PWM_WIDTH, ctl);
86 
87 	return 0;
88 }
89 
90 static long axi_fan_control_get_fan_rpm(const struct axi_fan_control_data *ctl)
91 {
92 	const u32 tach = axi_ioread(ADI_REG_TACH_MEASUR, ctl);
93 
94 	if (tach == 0)
95 		/* should we return error, EAGAIN maybe? */
96 		return 0;
97 	/*
98 	 * The tacho period should be:
99 	 *      TACH = 60/(ppr * rpm), where rpm is revolutions per second
100 	 *      and ppr is pulses per revolution.
101 	 * Given the tacho period, we can multiply it by the input clock
102 	 * so that we know how many clocks we need to have this period.
103 	 * From this, we can derive the RPM value.
104 	 */
105 	return DIV_ROUND_CLOSEST(60 * ctl->clk_rate, ctl->ppr * tach);
106 }
107 
108 static int axi_fan_control_read_temp(struct device *dev, u32 attr, long *val)
109 {
110 	struct axi_fan_control_data *ctl = dev_get_drvdata(dev);
111 	long raw_temp;
112 
113 	switch (attr) {
114 	case hwmon_temp_input:
115 		raw_temp = axi_ioread(ADI_REG_TEMPERATURE, ctl);
116 		/*
117 		 * The formula for the temperature is:
118 		 *      T = (ADC * 501.3743 / 2^bits) - 273.6777
119 		 * It's multiplied by 1000 to have millidegrees as
120 		 * specified by the hwmon sysfs interface.
121 		 */
122 		*val = ((raw_temp * 501374) >> 16) - 273677;
123 		return 0;
124 	default:
125 		return -ENOTSUPP;
126 	}
127 }
128 
129 static int axi_fan_control_read_fan(struct device *dev, u32 attr, long *val)
130 {
131 	struct axi_fan_control_data *ctl = dev_get_drvdata(dev);
132 
133 	switch (attr) {
134 	case hwmon_fan_fault:
135 		*val = ctl->fan_fault;
136 		/* clear it now */
137 		ctl->fan_fault = 0;
138 		return 0;
139 	case hwmon_fan_input:
140 		*val = axi_fan_control_get_fan_rpm(ctl);
141 		return 0;
142 	default:
143 		return -ENOTSUPP;
144 	}
145 }
146 
147 static int axi_fan_control_read_pwm(struct device *dev, u32 attr, long *val)
148 {
149 	struct axi_fan_control_data *ctl = dev_get_drvdata(dev);
150 
151 	switch (attr) {
152 	case hwmon_pwm_input:
153 		*val = axi_fan_control_get_pwm_duty(ctl);
154 		return 0;
155 	default:
156 		return -ENOTSUPP;
157 	}
158 }
159 
160 static int axi_fan_control_write_pwm(struct device *dev, u32 attr, long val)
161 {
162 	struct axi_fan_control_data *ctl = dev_get_drvdata(dev);
163 
164 	switch (attr) {
165 	case hwmon_pwm_input:
166 		return axi_fan_control_set_pwm_duty(val, ctl);
167 	default:
168 		return -ENOTSUPP;
169 	}
170 }
171 
172 static int axi_fan_control_read_labels(struct device *dev,
173 				       enum hwmon_sensor_types type,
174 				       u32 attr, int channel, const char **str)
175 {
176 	switch (type) {
177 	case hwmon_fan:
178 		*str = "FAN";
179 		return 0;
180 	case hwmon_temp:
181 		*str = "SYSMON4";
182 		return 0;
183 	default:
184 		return -ENOTSUPP;
185 	}
186 }
187 
188 static int axi_fan_control_read(struct device *dev,
189 				enum hwmon_sensor_types type,
190 				u32 attr, int channel, long *val)
191 {
192 	switch (type) {
193 	case hwmon_fan:
194 		return axi_fan_control_read_fan(dev, attr, val);
195 	case hwmon_pwm:
196 		return axi_fan_control_read_pwm(dev, attr, val);
197 	case hwmon_temp:
198 		return axi_fan_control_read_temp(dev, attr, val);
199 	default:
200 		return -ENOTSUPP;
201 	}
202 }
203 
204 static int axi_fan_control_write(struct device *dev,
205 				 enum hwmon_sensor_types type,
206 				 u32 attr, int channel, long val)
207 {
208 	switch (type) {
209 	case hwmon_pwm:
210 		return axi_fan_control_write_pwm(dev, attr, val);
211 	default:
212 		return -ENOTSUPP;
213 	}
214 }
215 
216 static umode_t axi_fan_control_fan_is_visible(const u32 attr)
217 {
218 	switch (attr) {
219 	case hwmon_fan_input:
220 	case hwmon_fan_fault:
221 	case hwmon_fan_label:
222 		return 0444;
223 	default:
224 		return 0;
225 	}
226 }
227 
228 static umode_t axi_fan_control_pwm_is_visible(const u32 attr)
229 {
230 	switch (attr) {
231 	case hwmon_pwm_input:
232 		return 0644;
233 	default:
234 		return 0;
235 	}
236 }
237 
238 static umode_t axi_fan_control_temp_is_visible(const u32 attr)
239 {
240 	switch (attr) {
241 	case hwmon_temp_input:
242 	case hwmon_temp_label:
243 		return 0444;
244 	default:
245 		return 0;
246 	}
247 }
248 
249 static umode_t axi_fan_control_is_visible(const void *data,
250 					  enum hwmon_sensor_types type,
251 					  u32 attr, int channel)
252 {
253 	switch (type) {
254 	case hwmon_fan:
255 		return axi_fan_control_fan_is_visible(attr);
256 	case hwmon_pwm:
257 		return axi_fan_control_pwm_is_visible(attr);
258 	case hwmon_temp:
259 		return axi_fan_control_temp_is_visible(attr);
260 	default:
261 		return 0;
262 	}
263 }
264 
265 /*
266  * This core has two main ways of changing the PWM duty cycle. It is done,
267  * either by a request from userspace (writing on pwm1_input) or by the
268  * core itself. When the change is done by the core, it will use predefined
269  * parameters to evaluate the tach signal and, on that case we cannot set them.
270  * On the other hand, when the request is done by the user, with some arbitrary
271  * value that the core does not now about, we have to provide the tach
272  * parameters so that, the core can evaluate the signal. On the IRQ handler we
273  * distinguish this by using the ADI_IRQ_SRC_TEMP_INCREASE interrupt. This tell
274  * us that the CORE requested a new duty cycle. After this, there is 5s delay
275  * on which the core waits for the fan rotation speed to stabilize. After this
276  * we get ADI_IRQ_SRC_PWM_CHANGED irq where we will decide if we need to set
277  * the tach parameters or not on the next tach measurement cycle (corresponding
278  * already to the ney duty cycle) based on the %ctl->hw_pwm_req flag.
279  */
280 static irqreturn_t axi_fan_control_irq_handler(int irq, void *data)
281 {
282 	struct axi_fan_control_data *ctl = (struct axi_fan_control_data *)data;
283 	u32 irq_pending = axi_ioread(ADI_REG_IRQ_PENDING, ctl);
284 	u32 clear_mask;
285 
286 	if (irq_pending & ADI_IRQ_SRC_NEW_MEASUR) {
287 		if (ctl->update_tacho_params) {
288 			u32 new_tach = axi_ioread(ADI_REG_TACH_MEASUR, ctl);
289 
290 			/* get 25% tolerance */
291 			u32 tach_tol = DIV_ROUND_CLOSEST(new_tach * 25, 100);
292 			/* set new tacho parameters */
293 			axi_iowrite(new_tach, ADI_REG_TACH_PERIOD, ctl);
294 			axi_iowrite(tach_tol, ADI_REG_TACH_TOLERANCE, ctl);
295 			ctl->update_tacho_params = false;
296 		}
297 	}
298 
299 	if (irq_pending & ADI_IRQ_SRC_PWM_CHANGED) {
300 		/*
301 		 * if the pwm changes on behalf of software,
302 		 * we need to provide new tacho parameters to the core.
303 		 * Wait for the next measurement for that...
304 		 */
305 		if (!ctl->hw_pwm_req) {
306 			ctl->update_tacho_params = true;
307 		} else {
308 			ctl->hw_pwm_req = false;
309 			sysfs_notify(&ctl->hdev->kobj, NULL, "pwm1");
310 		}
311 	}
312 
313 	if (irq_pending & ADI_IRQ_SRC_TEMP_INCREASE)
314 		/* hardware requested a new pwm */
315 		ctl->hw_pwm_req = true;
316 
317 	if (irq_pending & ADI_IRQ_SRC_TACH_ERR)
318 		ctl->fan_fault = 1;
319 
320 	/* clear all interrupts */
321 	clear_mask = irq_pending & ADI_IRQ_SRC_MASK;
322 	axi_iowrite(clear_mask, ADI_REG_IRQ_PENDING, ctl);
323 
324 	return IRQ_HANDLED;
325 }
326 
327 static int axi_fan_control_init(struct axi_fan_control_data *ctl,
328 				const struct device_node *np)
329 {
330 	int ret;
331 
332 	/* get fan pulses per revolution */
333 	ret = of_property_read_u32(np, "pulses-per-revolution", &ctl->ppr);
334 	if (ret)
335 		return ret;
336 
337 	/* 1, 2 and 4 are the typical and accepted values */
338 	if (ctl->ppr != 1 && ctl->ppr != 2 && ctl->ppr != 4)
339 		return -EINVAL;
340 	/*
341 	 * Enable all IRQs
342 	 */
343 	axi_iowrite(ADI_IRQ_MASK_OUT_ALL &
344 		    ~(ADI_IRQ_SRC_NEW_MEASUR | ADI_IRQ_SRC_TACH_ERR |
345 		      ADI_IRQ_SRC_PWM_CHANGED | ADI_IRQ_SRC_TEMP_INCREASE),
346 		    ADI_REG_IRQ_MASK, ctl);
347 
348 	/* bring the device out of reset */
349 	axi_iowrite(0x01, ADI_REG_RSTN, ctl);
350 
351 	return ret;
352 }
353 
354 static const struct hwmon_channel_info *axi_fan_control_info[] = {
355 	HWMON_CHANNEL_INFO(pwm, HWMON_PWM_INPUT),
356 	HWMON_CHANNEL_INFO(fan, HWMON_F_INPUT | HWMON_F_FAULT | HWMON_F_LABEL),
357 	HWMON_CHANNEL_INFO(temp, HWMON_T_INPUT | HWMON_T_LABEL),
358 	NULL
359 };
360 
361 static const struct hwmon_ops axi_fan_control_hwmon_ops = {
362 	.is_visible = axi_fan_control_is_visible,
363 	.read = axi_fan_control_read,
364 	.write = axi_fan_control_write,
365 	.read_string = axi_fan_control_read_labels,
366 };
367 
368 static const struct hwmon_chip_info axi_chip_info = {
369 	.ops = &axi_fan_control_hwmon_ops,
370 	.info = axi_fan_control_info,
371 };
372 
373 static const u32 version_1_0_0 = ADI_AXI_PCORE_VER(1, 0, 'a');
374 
375 static const struct of_device_id axi_fan_control_of_match[] = {
376 	{ .compatible = "adi,axi-fan-control-1.00.a",
377 		.data = (void *)&version_1_0_0},
378 	{},
379 };
380 MODULE_DEVICE_TABLE(of, axi_fan_control_of_match);
381 
382 static int axi_fan_control_probe(struct platform_device *pdev)
383 {
384 	struct axi_fan_control_data *ctl;
385 	struct clk *clk;
386 	const struct of_device_id *id;
387 	const char *name = "axi_fan_control";
388 	u32 version;
389 	int ret;
390 
391 	id = of_match_node(axi_fan_control_of_match, pdev->dev.of_node);
392 	if (!id)
393 		return -EINVAL;
394 
395 	ctl = devm_kzalloc(&pdev->dev, sizeof(*ctl), GFP_KERNEL);
396 	if (!ctl)
397 		return -ENOMEM;
398 
399 	ctl->base = devm_platform_ioremap_resource(pdev, 0);
400 	if (IS_ERR(ctl->base))
401 		return PTR_ERR(ctl->base);
402 
403 	clk = devm_clk_get(&pdev->dev, NULL);
404 	if (IS_ERR(clk)) {
405 		dev_err(&pdev->dev, "clk_get failed with %ld\n", PTR_ERR(clk));
406 		return PTR_ERR(clk);
407 	}
408 
409 	ctl->clk_rate = clk_get_rate(clk);
410 	if (!ctl->clk_rate)
411 		return -EINVAL;
412 
413 	version = axi_ioread(ADI_AXI_REG_VERSION, ctl);
414 	if (ADI_AXI_PCORE_VER_MAJOR(version) !=
415 	    ADI_AXI_PCORE_VER_MAJOR((*(u32 *)id->data))) {
416 		dev_err(&pdev->dev, "Major version mismatch. Expected %d.%.2d.%c, Reported %d.%.2d.%c\n",
417 			ADI_AXI_PCORE_VER_MAJOR((*(u32 *)id->data)),
418 			ADI_AXI_PCORE_VER_MINOR((*(u32 *)id->data)),
419 			ADI_AXI_PCORE_VER_PATCH((*(u32 *)id->data)),
420 			ADI_AXI_PCORE_VER_MAJOR(version),
421 			ADI_AXI_PCORE_VER_MINOR(version),
422 			ADI_AXI_PCORE_VER_PATCH(version));
423 		return -ENODEV;
424 	}
425 
426 	ctl->irq = platform_get_irq(pdev, 0);
427 	if (ctl->irq < 0)
428 		return ctl->irq;
429 
430 	ret = devm_request_threaded_irq(&pdev->dev, ctl->irq, NULL,
431 					axi_fan_control_irq_handler,
432 					IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
433 					pdev->driver_override, ctl);
434 	if (ret) {
435 		dev_err(&pdev->dev, "failed to request an irq, %d", ret);
436 		return ret;
437 	}
438 
439 	ret = axi_fan_control_init(ctl, pdev->dev.of_node);
440 	if (ret) {
441 		dev_err(&pdev->dev, "Failed to initialize device\n");
442 		return ret;
443 	}
444 
445 	ctl->hdev = devm_hwmon_device_register_with_info(&pdev->dev,
446 							 name,
447 							 ctl,
448 							 &axi_chip_info,
449 							 NULL);
450 
451 	return PTR_ERR_OR_ZERO(ctl->hdev);
452 }
453 
454 static struct platform_driver axi_fan_control_driver = {
455 	.driver = {
456 		.name = "axi_fan_control_driver",
457 		.of_match_table = axi_fan_control_of_match,
458 	},
459 	.probe = axi_fan_control_probe,
460 };
461 module_platform_driver(axi_fan_control_driver);
462 
463 MODULE_AUTHOR("Nuno Sa <nuno.sa@analog.com>");
464 MODULE_DESCRIPTION("Analog Devices Fan Control HDL CORE driver");
465 MODULE_LICENSE("GPL");
466