1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  *  thermal.c - sysfs interface of thermal devices
4  *
5  *  Copyright (C) 2016 Eduardo Valentin <edubezval@gmail.com>
6  *
7  *  Highly based on original thermal_core.c
8  *  Copyright (C) 2008 Intel Corp
9  *  Copyright (C) 2008 Zhang Rui <rui.zhang@intel.com>
10  *  Copyright (C) 2008 Sujith Thomas <sujith.thomas@intel.com>
11  */
12 
13 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
14 
15 #include <linux/sysfs.h>
16 #include <linux/device.h>
17 #include <linux/err.h>
18 #include <linux/slab.h>
19 #include <linux/string.h>
20 #include <linux/jiffies.h>
21 
22 #include "thermal_core.h"
23 
24 /* sys I/F for thermal zone */
25 
26 static ssize_t
27 type_show(struct device *dev, struct device_attribute *attr, char *buf)
28 {
29 	struct thermal_zone_device *tz = to_thermal_zone(dev);
30 
31 	return sprintf(buf, "%s\n", tz->type);
32 }
33 
34 static ssize_t
35 temp_show(struct device *dev, struct device_attribute *attr, char *buf)
36 {
37 	struct thermal_zone_device *tz = to_thermal_zone(dev);
38 	int temperature, ret;
39 
40 	ret = thermal_zone_get_temp(tz, &temperature);
41 
42 	if (ret)
43 		return ret;
44 
45 	return sprintf(buf, "%d\n", temperature);
46 }
47 
48 static ssize_t
49 mode_show(struct device *dev, struct device_attribute *attr, char *buf)
50 {
51 	struct thermal_zone_device *tz = to_thermal_zone(dev);
52 	enum thermal_device_mode mode;
53 	int result;
54 
55 	if (!tz->ops->get_mode)
56 		return -EPERM;
57 
58 	result = tz->ops->get_mode(tz, &mode);
59 	if (result)
60 		return result;
61 
62 	return sprintf(buf, "%s\n", mode == THERMAL_DEVICE_ENABLED ? "enabled"
63 		       : "disabled");
64 }
65 
66 static ssize_t
67 mode_store(struct device *dev, struct device_attribute *attr,
68 	   const char *buf, size_t count)
69 {
70 	struct thermal_zone_device *tz = to_thermal_zone(dev);
71 	int result;
72 
73 	if (!tz->ops->set_mode)
74 		return -EPERM;
75 
76 	if (!strncmp(buf, "enabled", sizeof("enabled") - 1))
77 		result = tz->ops->set_mode(tz, THERMAL_DEVICE_ENABLED);
78 	else if (!strncmp(buf, "disabled", sizeof("disabled") - 1))
79 		result = tz->ops->set_mode(tz, THERMAL_DEVICE_DISABLED);
80 	else
81 		result = -EINVAL;
82 
83 	if (result)
84 		return result;
85 
86 	return count;
87 }
88 
89 static ssize_t
90 trip_point_type_show(struct device *dev, struct device_attribute *attr,
91 		     char *buf)
92 {
93 	struct thermal_zone_device *tz = to_thermal_zone(dev);
94 	enum thermal_trip_type type;
95 	int trip, result;
96 
97 	if (!tz->ops->get_trip_type)
98 		return -EPERM;
99 
100 	if (sscanf(attr->attr.name, "trip_point_%d_type", &trip) != 1)
101 		return -EINVAL;
102 
103 	result = tz->ops->get_trip_type(tz, trip, &type);
104 	if (result)
105 		return result;
106 
107 	switch (type) {
108 	case THERMAL_TRIP_CRITICAL:
109 		return sprintf(buf, "critical\n");
110 	case THERMAL_TRIP_HOT:
111 		return sprintf(buf, "hot\n");
112 	case THERMAL_TRIP_PASSIVE:
113 		return sprintf(buf, "passive\n");
114 	case THERMAL_TRIP_ACTIVE:
115 		return sprintf(buf, "active\n");
116 	default:
117 		return sprintf(buf, "unknown\n");
118 	}
119 }
120 
121 static ssize_t
122 trip_point_temp_store(struct device *dev, struct device_attribute *attr,
123 		      const char *buf, size_t count)
124 {
125 	struct thermal_zone_device *tz = to_thermal_zone(dev);
126 	int trip, ret;
127 	int temperature;
128 
129 	if (!tz->ops->set_trip_temp)
130 		return -EPERM;
131 
132 	if (sscanf(attr->attr.name, "trip_point_%d_temp", &trip) != 1)
133 		return -EINVAL;
134 
135 	if (kstrtoint(buf, 10, &temperature))
136 		return -EINVAL;
137 
138 	ret = tz->ops->set_trip_temp(tz, trip, temperature);
139 	if (ret)
140 		return ret;
141 
142 	thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED);
143 
144 	return count;
145 }
146 
147 static ssize_t
148 trip_point_temp_show(struct device *dev, struct device_attribute *attr,
149 		     char *buf)
150 {
151 	struct thermal_zone_device *tz = to_thermal_zone(dev);
152 	int trip, ret;
153 	int temperature;
154 
155 	if (!tz->ops->get_trip_temp)
156 		return -EPERM;
157 
158 	if (sscanf(attr->attr.name, "trip_point_%d_temp", &trip) != 1)
159 		return -EINVAL;
160 
161 	ret = tz->ops->get_trip_temp(tz, trip, &temperature);
162 
163 	if (ret)
164 		return ret;
165 
166 	return sprintf(buf, "%d\n", temperature);
167 }
168 
169 static ssize_t
170 trip_point_hyst_store(struct device *dev, struct device_attribute *attr,
171 		      const char *buf, size_t count)
172 {
173 	struct thermal_zone_device *tz = to_thermal_zone(dev);
174 	int trip, ret;
175 	int temperature;
176 
177 	if (!tz->ops->set_trip_hyst)
178 		return -EPERM;
179 
180 	if (sscanf(attr->attr.name, "trip_point_%d_hyst", &trip) != 1)
181 		return -EINVAL;
182 
183 	if (kstrtoint(buf, 10, &temperature))
184 		return -EINVAL;
185 
186 	/*
187 	 * We are not doing any check on the 'temperature' value
188 	 * here. The driver implementing 'set_trip_hyst' has to
189 	 * take care of this.
190 	 */
191 	ret = tz->ops->set_trip_hyst(tz, trip, temperature);
192 
193 	if (!ret)
194 		thermal_zone_set_trips(tz);
195 
196 	return ret ? ret : count;
197 }
198 
199 static ssize_t
200 trip_point_hyst_show(struct device *dev, struct device_attribute *attr,
201 		     char *buf)
202 {
203 	struct thermal_zone_device *tz = to_thermal_zone(dev);
204 	int trip, ret;
205 	int temperature;
206 
207 	if (!tz->ops->get_trip_hyst)
208 		return -EPERM;
209 
210 	if (sscanf(attr->attr.name, "trip_point_%d_hyst", &trip) != 1)
211 		return -EINVAL;
212 
213 	ret = tz->ops->get_trip_hyst(tz, trip, &temperature);
214 
215 	return ret ? ret : sprintf(buf, "%d\n", temperature);
216 }
217 
218 static ssize_t
219 passive_store(struct device *dev, struct device_attribute *attr,
220 	      const char *buf, size_t count)
221 {
222 	struct thermal_zone_device *tz = to_thermal_zone(dev);
223 	int state;
224 
225 	if (sscanf(buf, "%d\n", &state) != 1)
226 		return -EINVAL;
227 
228 	/* sanity check: values below 1000 millicelcius don't make sense
229 	 * and can cause the system to go into a thermal heart attack
230 	 */
231 	if (state && state < 1000)
232 		return -EINVAL;
233 
234 	if (state && !tz->forced_passive) {
235 		if (!tz->passive_delay)
236 			tz->passive_delay = 1000;
237 		thermal_zone_device_rebind_exception(tz, "Processor",
238 						     sizeof("Processor"));
239 	} else if (!state && tz->forced_passive) {
240 		tz->passive_delay = 0;
241 		thermal_zone_device_unbind_exception(tz, "Processor",
242 						     sizeof("Processor"));
243 	}
244 
245 	tz->forced_passive = state;
246 
247 	thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED);
248 
249 	return count;
250 }
251 
252 static ssize_t
253 passive_show(struct device *dev, struct device_attribute *attr,
254 	     char *buf)
255 {
256 	struct thermal_zone_device *tz = to_thermal_zone(dev);
257 
258 	return sprintf(buf, "%d\n", tz->forced_passive);
259 }
260 
261 static ssize_t
262 policy_store(struct device *dev, struct device_attribute *attr,
263 	     const char *buf, size_t count)
264 {
265 	struct thermal_zone_device *tz = to_thermal_zone(dev);
266 	char name[THERMAL_NAME_LENGTH];
267 	int ret;
268 
269 	snprintf(name, sizeof(name), "%s", buf);
270 
271 	ret = thermal_zone_device_set_policy(tz, name);
272 	if (!ret)
273 		ret = count;
274 
275 	return ret;
276 }
277 
278 static ssize_t
279 policy_show(struct device *dev, struct device_attribute *devattr, char *buf)
280 {
281 	struct thermal_zone_device *tz = to_thermal_zone(dev);
282 
283 	return sprintf(buf, "%s\n", tz->governor->name);
284 }
285 
286 static ssize_t
287 available_policies_show(struct device *dev, struct device_attribute *devattr,
288 			char *buf)
289 {
290 	return thermal_build_list_of_policies(buf);
291 }
292 
293 #if (IS_ENABLED(CONFIG_THERMAL_EMULATION))
294 static ssize_t
295 emul_temp_store(struct device *dev, struct device_attribute *attr,
296 		const char *buf, size_t count)
297 {
298 	struct thermal_zone_device *tz = to_thermal_zone(dev);
299 	int ret = 0;
300 	int temperature;
301 
302 	if (kstrtoint(buf, 10, &temperature))
303 		return -EINVAL;
304 
305 	if (!tz->ops->set_emul_temp) {
306 		mutex_lock(&tz->lock);
307 		tz->emul_temperature = temperature;
308 		mutex_unlock(&tz->lock);
309 	} else {
310 		ret = tz->ops->set_emul_temp(tz, temperature);
311 	}
312 
313 	if (!ret)
314 		thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED);
315 
316 	return ret ? ret : count;
317 }
318 static DEVICE_ATTR_WO(emul_temp);
319 #endif
320 
321 static ssize_t
322 sustainable_power_show(struct device *dev, struct device_attribute *devattr,
323 		       char *buf)
324 {
325 	struct thermal_zone_device *tz = to_thermal_zone(dev);
326 
327 	if (tz->tzp)
328 		return sprintf(buf, "%u\n", tz->tzp->sustainable_power);
329 	else
330 		return -EIO;
331 }
332 
333 static ssize_t
334 sustainable_power_store(struct device *dev, struct device_attribute *devattr,
335 			const char *buf, size_t count)
336 {
337 	struct thermal_zone_device *tz = to_thermal_zone(dev);
338 	u32 sustainable_power;
339 
340 	if (!tz->tzp)
341 		return -EIO;
342 
343 	if (kstrtou32(buf, 10, &sustainable_power))
344 		return -EINVAL;
345 
346 	tz->tzp->sustainable_power = sustainable_power;
347 
348 	return count;
349 }
350 
351 #define create_s32_tzp_attr(name)					\
352 	static ssize_t							\
353 	name##_show(struct device *dev, struct device_attribute *devattr, \
354 		char *buf)						\
355 	{								\
356 	struct thermal_zone_device *tz = to_thermal_zone(dev);		\
357 									\
358 	if (tz->tzp)							\
359 		return sprintf(buf, "%d\n", tz->tzp->name);		\
360 	else								\
361 		return -EIO;						\
362 	}								\
363 									\
364 	static ssize_t							\
365 	name##_store(struct device *dev, struct device_attribute *devattr, \
366 		const char *buf, size_t count)				\
367 	{								\
368 		struct thermal_zone_device *tz = to_thermal_zone(dev);	\
369 		s32 value;						\
370 									\
371 		if (!tz->tzp)						\
372 			return -EIO;					\
373 									\
374 		if (kstrtos32(buf, 10, &value))				\
375 			return -EINVAL;					\
376 									\
377 		tz->tzp->name = value;					\
378 									\
379 		return count;						\
380 	}								\
381 	static DEVICE_ATTR_RW(name)
382 
383 create_s32_tzp_attr(k_po);
384 create_s32_tzp_attr(k_pu);
385 create_s32_tzp_attr(k_i);
386 create_s32_tzp_attr(k_d);
387 create_s32_tzp_attr(integral_cutoff);
388 create_s32_tzp_attr(slope);
389 create_s32_tzp_attr(offset);
390 #undef create_s32_tzp_attr
391 
392 /*
393  * These are thermal zone device attributes that will always be present.
394  * All the attributes created for tzp (create_s32_tzp_attr) also are always
395  * present on the sysfs interface.
396  */
397 static DEVICE_ATTR_RO(type);
398 static DEVICE_ATTR_RO(temp);
399 static DEVICE_ATTR_RW(policy);
400 static DEVICE_ATTR_RO(available_policies);
401 static DEVICE_ATTR_RW(sustainable_power);
402 
403 /* These thermal zone device attributes are created based on conditions */
404 static DEVICE_ATTR_RW(mode);
405 static DEVICE_ATTR_RW(passive);
406 
407 /* These attributes are unconditionally added to a thermal zone */
408 static struct attribute *thermal_zone_dev_attrs[] = {
409 	&dev_attr_type.attr,
410 	&dev_attr_temp.attr,
411 #if (IS_ENABLED(CONFIG_THERMAL_EMULATION))
412 	&dev_attr_emul_temp.attr,
413 #endif
414 	&dev_attr_policy.attr,
415 	&dev_attr_available_policies.attr,
416 	&dev_attr_sustainable_power.attr,
417 	&dev_attr_k_po.attr,
418 	&dev_attr_k_pu.attr,
419 	&dev_attr_k_i.attr,
420 	&dev_attr_k_d.attr,
421 	&dev_attr_integral_cutoff.attr,
422 	&dev_attr_slope.attr,
423 	&dev_attr_offset.attr,
424 	NULL,
425 };
426 
427 static struct attribute_group thermal_zone_attribute_group = {
428 	.attrs = thermal_zone_dev_attrs,
429 };
430 
431 /* We expose mode only if .get_mode is present */
432 static struct attribute *thermal_zone_mode_attrs[] = {
433 	&dev_attr_mode.attr,
434 	NULL,
435 };
436 
437 static umode_t thermal_zone_mode_is_visible(struct kobject *kobj,
438 					    struct attribute *attr,
439 					    int attrno)
440 {
441 	struct device *dev = container_of(kobj, struct device, kobj);
442 	struct thermal_zone_device *tz;
443 
444 	tz = container_of(dev, struct thermal_zone_device, device);
445 
446 	if (tz->ops->get_mode)
447 		return attr->mode;
448 
449 	return 0;
450 }
451 
452 static struct attribute_group thermal_zone_mode_attribute_group = {
453 	.attrs = thermal_zone_mode_attrs,
454 	.is_visible = thermal_zone_mode_is_visible,
455 };
456 
457 /* We expose passive only if passive trips are present */
458 static struct attribute *thermal_zone_passive_attrs[] = {
459 	&dev_attr_passive.attr,
460 	NULL,
461 };
462 
463 static umode_t thermal_zone_passive_is_visible(struct kobject *kobj,
464 					       struct attribute *attr,
465 					       int attrno)
466 {
467 	struct device *dev = container_of(kobj, struct device, kobj);
468 	struct thermal_zone_device *tz;
469 	enum thermal_trip_type trip_type;
470 	int count, passive = 0;
471 
472 	tz = container_of(dev, struct thermal_zone_device, device);
473 
474 	for (count = 0; count < tz->trips && !passive; count++) {
475 		tz->ops->get_trip_type(tz, count, &trip_type);
476 
477 		if (trip_type == THERMAL_TRIP_PASSIVE)
478 			passive = 1;
479 	}
480 
481 	if (!passive)
482 		return attr->mode;
483 
484 	return 0;
485 }
486 
487 static struct attribute_group thermal_zone_passive_attribute_group = {
488 	.attrs = thermal_zone_passive_attrs,
489 	.is_visible = thermal_zone_passive_is_visible,
490 };
491 
492 static const struct attribute_group *thermal_zone_attribute_groups[] = {
493 	&thermal_zone_attribute_group,
494 	&thermal_zone_mode_attribute_group,
495 	&thermal_zone_passive_attribute_group,
496 	/* This is not NULL terminated as we create the group dynamically */
497 };
498 
499 /**
500  * create_trip_attrs() - create attributes for trip points
501  * @tz:		the thermal zone device
502  * @mask:	Writeable trip point bitmap.
503  *
504  * helper function to instantiate sysfs entries for every trip
505  * point and its properties of a struct thermal_zone_device.
506  *
507  * Return: 0 on success, the proper error value otherwise.
508  */
509 static int create_trip_attrs(struct thermal_zone_device *tz, int mask)
510 {
511 	struct attribute **attrs;
512 	int indx;
513 
514 	/* This function works only for zones with at least one trip */
515 	if (tz->trips <= 0)
516 		return -EINVAL;
517 
518 	tz->trip_type_attrs = kcalloc(tz->trips, sizeof(*tz->trip_type_attrs),
519 				      GFP_KERNEL);
520 	if (!tz->trip_type_attrs)
521 		return -ENOMEM;
522 
523 	tz->trip_temp_attrs = kcalloc(tz->trips, sizeof(*tz->trip_temp_attrs),
524 				      GFP_KERNEL);
525 	if (!tz->trip_temp_attrs) {
526 		kfree(tz->trip_type_attrs);
527 		return -ENOMEM;
528 	}
529 
530 	if (tz->ops->get_trip_hyst) {
531 		tz->trip_hyst_attrs = kcalloc(tz->trips,
532 					      sizeof(*tz->trip_hyst_attrs),
533 					      GFP_KERNEL);
534 		if (!tz->trip_hyst_attrs) {
535 			kfree(tz->trip_type_attrs);
536 			kfree(tz->trip_temp_attrs);
537 			return -ENOMEM;
538 		}
539 	}
540 
541 	attrs = kcalloc(tz->trips * 3 + 1, sizeof(*attrs), GFP_KERNEL);
542 	if (!attrs) {
543 		kfree(tz->trip_type_attrs);
544 		kfree(tz->trip_temp_attrs);
545 		if (tz->ops->get_trip_hyst)
546 			kfree(tz->trip_hyst_attrs);
547 		return -ENOMEM;
548 	}
549 
550 	for (indx = 0; indx < tz->trips; indx++) {
551 		/* create trip type attribute */
552 		snprintf(tz->trip_type_attrs[indx].name, THERMAL_NAME_LENGTH,
553 			 "trip_point_%d_type", indx);
554 
555 		sysfs_attr_init(&tz->trip_type_attrs[indx].attr.attr);
556 		tz->trip_type_attrs[indx].attr.attr.name =
557 						tz->trip_type_attrs[indx].name;
558 		tz->trip_type_attrs[indx].attr.attr.mode = S_IRUGO;
559 		tz->trip_type_attrs[indx].attr.show = trip_point_type_show;
560 		attrs[indx] = &tz->trip_type_attrs[indx].attr.attr;
561 
562 		/* create trip temp attribute */
563 		snprintf(tz->trip_temp_attrs[indx].name, THERMAL_NAME_LENGTH,
564 			 "trip_point_%d_temp", indx);
565 
566 		sysfs_attr_init(&tz->trip_temp_attrs[indx].attr.attr);
567 		tz->trip_temp_attrs[indx].attr.attr.name =
568 						tz->trip_temp_attrs[indx].name;
569 		tz->trip_temp_attrs[indx].attr.attr.mode = S_IRUGO;
570 		tz->trip_temp_attrs[indx].attr.show = trip_point_temp_show;
571 		if (IS_ENABLED(CONFIG_THERMAL_WRITABLE_TRIPS) &&
572 		    mask & (1 << indx)) {
573 			tz->trip_temp_attrs[indx].attr.attr.mode |= S_IWUSR;
574 			tz->trip_temp_attrs[indx].attr.store =
575 							trip_point_temp_store;
576 		}
577 		attrs[indx + tz->trips] = &tz->trip_temp_attrs[indx].attr.attr;
578 
579 		/* create Optional trip hyst attribute */
580 		if (!tz->ops->get_trip_hyst)
581 			continue;
582 		snprintf(tz->trip_hyst_attrs[indx].name, THERMAL_NAME_LENGTH,
583 			 "trip_point_%d_hyst", indx);
584 
585 		sysfs_attr_init(&tz->trip_hyst_attrs[indx].attr.attr);
586 		tz->trip_hyst_attrs[indx].attr.attr.name =
587 					tz->trip_hyst_attrs[indx].name;
588 		tz->trip_hyst_attrs[indx].attr.attr.mode = S_IRUGO;
589 		tz->trip_hyst_attrs[indx].attr.show = trip_point_hyst_show;
590 		if (tz->ops->set_trip_hyst) {
591 			tz->trip_hyst_attrs[indx].attr.attr.mode |= S_IWUSR;
592 			tz->trip_hyst_attrs[indx].attr.store =
593 					trip_point_hyst_store;
594 		}
595 		attrs[indx + tz->trips * 2] =
596 					&tz->trip_hyst_attrs[indx].attr.attr;
597 	}
598 	attrs[tz->trips * 3] = NULL;
599 
600 	tz->trips_attribute_group.attrs = attrs;
601 
602 	return 0;
603 }
604 
605 /**
606  * destroy_trip_attrs() - destroy attributes for trip points
607  * @tz:		the thermal zone device
608  *
609  * helper function to free resources allocated by create_trip_attrs()
610  */
611 static void destroy_trip_attrs(struct thermal_zone_device *tz)
612 {
613 	if (!tz)
614 		return;
615 
616 	kfree(tz->trip_type_attrs);
617 	kfree(tz->trip_temp_attrs);
618 	if (tz->ops->get_trip_hyst)
619 		kfree(tz->trip_hyst_attrs);
620 	kfree(tz->trips_attribute_group.attrs);
621 }
622 
623 int thermal_zone_create_device_groups(struct thermal_zone_device *tz,
624 				      int mask)
625 {
626 	const struct attribute_group **groups;
627 	int i, size, result;
628 
629 	/* we need one extra for trips and the NULL to terminate the array */
630 	size = ARRAY_SIZE(thermal_zone_attribute_groups) + 2;
631 	/* This also takes care of API requirement to be NULL terminated */
632 	groups = kcalloc(size, sizeof(*groups), GFP_KERNEL);
633 	if (!groups)
634 		return -ENOMEM;
635 
636 	for (i = 0; i < size - 2; i++)
637 		groups[i] = thermal_zone_attribute_groups[i];
638 
639 	if (tz->trips) {
640 		result = create_trip_attrs(tz, mask);
641 		if (result) {
642 			kfree(groups);
643 
644 			return result;
645 		}
646 
647 		groups[size - 2] = &tz->trips_attribute_group;
648 	}
649 
650 	tz->device.groups = groups;
651 
652 	return 0;
653 }
654 
655 void thermal_zone_destroy_device_groups(struct thermal_zone_device *tz)
656 {
657 	if (!tz)
658 		return;
659 
660 	if (tz->trips)
661 		destroy_trip_attrs(tz);
662 
663 	kfree(tz->device.groups);
664 }
665 
666 /* sys I/F for cooling device */
667 static ssize_t
668 cdev_type_show(struct device *dev, struct device_attribute *attr, char *buf)
669 {
670 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
671 
672 	return sprintf(buf, "%s\n", cdev->type);
673 }
674 
675 static ssize_t max_state_show(struct device *dev, struct device_attribute *attr,
676 			      char *buf)
677 {
678 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
679 	unsigned long state;
680 	int ret;
681 
682 	ret = cdev->ops->get_max_state(cdev, &state);
683 	if (ret)
684 		return ret;
685 	return sprintf(buf, "%ld\n", state);
686 }
687 
688 static ssize_t cur_state_show(struct device *dev, struct device_attribute *attr,
689 			      char *buf)
690 {
691 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
692 	unsigned long state;
693 	int ret;
694 
695 	ret = cdev->ops->get_cur_state(cdev, &state);
696 	if (ret)
697 		return ret;
698 	return sprintf(buf, "%ld\n", state);
699 }
700 
701 static ssize_t
702 cur_state_store(struct device *dev, struct device_attribute *attr,
703 		const char *buf, size_t count)
704 {
705 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
706 	unsigned long state;
707 	int result;
708 
709 	if (sscanf(buf, "%ld\n", &state) != 1)
710 		return -EINVAL;
711 
712 	if ((long)state < 0)
713 		return -EINVAL;
714 
715 	result = cdev->ops->set_cur_state(cdev, state);
716 	if (result)
717 		return result;
718 	thermal_cooling_device_stats_update(cdev, state);
719 	return count;
720 }
721 
722 static struct device_attribute
723 dev_attr_cdev_type = __ATTR(type, 0444, cdev_type_show, NULL);
724 static DEVICE_ATTR_RO(max_state);
725 static DEVICE_ATTR_RW(cur_state);
726 
727 static struct attribute *cooling_device_attrs[] = {
728 	&dev_attr_cdev_type.attr,
729 	&dev_attr_max_state.attr,
730 	&dev_attr_cur_state.attr,
731 	NULL,
732 };
733 
734 static const struct attribute_group cooling_device_attr_group = {
735 	.attrs = cooling_device_attrs,
736 };
737 
738 static const struct attribute_group *cooling_device_attr_groups[] = {
739 	&cooling_device_attr_group,
740 	NULL, /* Space allocated for cooling_device_stats_attr_group */
741 	NULL,
742 };
743 
744 #ifdef CONFIG_THERMAL_STATISTICS
745 struct cooling_dev_stats {
746 	spinlock_t lock;
747 	unsigned int total_trans;
748 	unsigned long state;
749 	unsigned long max_states;
750 	ktime_t last_time;
751 	ktime_t *time_in_state;
752 	unsigned int *trans_table;
753 };
754 
755 static void update_time_in_state(struct cooling_dev_stats *stats)
756 {
757 	ktime_t now = ktime_get(), delta;
758 
759 	delta = ktime_sub(now, stats->last_time);
760 	stats->time_in_state[stats->state] =
761 		ktime_add(stats->time_in_state[stats->state], delta);
762 	stats->last_time = now;
763 }
764 
765 void thermal_cooling_device_stats_update(struct thermal_cooling_device *cdev,
766 					 unsigned long new_state)
767 {
768 	struct cooling_dev_stats *stats = cdev->stats;
769 
770 	spin_lock(&stats->lock);
771 
772 	if (stats->state == new_state)
773 		goto unlock;
774 
775 	update_time_in_state(stats);
776 	stats->trans_table[stats->state * stats->max_states + new_state]++;
777 	stats->state = new_state;
778 	stats->total_trans++;
779 
780 unlock:
781 	spin_unlock(&stats->lock);
782 }
783 
784 static ssize_t total_trans_show(struct device *dev,
785 				struct device_attribute *attr, char *buf)
786 {
787 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
788 	struct cooling_dev_stats *stats = cdev->stats;
789 	int ret;
790 
791 	spin_lock(&stats->lock);
792 	ret = sprintf(buf, "%u\n", stats->total_trans);
793 	spin_unlock(&stats->lock);
794 
795 	return ret;
796 }
797 
798 static ssize_t
799 time_in_state_ms_show(struct device *dev, struct device_attribute *attr,
800 		      char *buf)
801 {
802 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
803 	struct cooling_dev_stats *stats = cdev->stats;
804 	ssize_t len = 0;
805 	int i;
806 
807 	spin_lock(&stats->lock);
808 	update_time_in_state(stats);
809 
810 	for (i = 0; i < stats->max_states; i++) {
811 		len += sprintf(buf + len, "state%u\t%llu\n", i,
812 			       ktime_to_ms(stats->time_in_state[i]));
813 	}
814 	spin_unlock(&stats->lock);
815 
816 	return len;
817 }
818 
819 static ssize_t
820 reset_store(struct device *dev, struct device_attribute *attr, const char *buf,
821 	    size_t count)
822 {
823 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
824 	struct cooling_dev_stats *stats = cdev->stats;
825 	int i, states = stats->max_states;
826 
827 	spin_lock(&stats->lock);
828 
829 	stats->total_trans = 0;
830 	stats->last_time = ktime_get();
831 	memset(stats->trans_table, 0,
832 	       states * states * sizeof(*stats->trans_table));
833 
834 	for (i = 0; i < stats->max_states; i++)
835 		stats->time_in_state[i] = ktime_set(0, 0);
836 
837 	spin_unlock(&stats->lock);
838 
839 	return count;
840 }
841 
842 static ssize_t trans_table_show(struct device *dev,
843 				struct device_attribute *attr, char *buf)
844 {
845 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
846 	struct cooling_dev_stats *stats = cdev->stats;
847 	ssize_t len = 0;
848 	int i, j;
849 
850 	len += snprintf(buf + len, PAGE_SIZE - len, " From  :    To\n");
851 	len += snprintf(buf + len, PAGE_SIZE - len, "       : ");
852 	for (i = 0; i < stats->max_states; i++) {
853 		if (len >= PAGE_SIZE)
854 			break;
855 		len += snprintf(buf + len, PAGE_SIZE - len, "state%2u  ", i);
856 	}
857 	if (len >= PAGE_SIZE)
858 		return PAGE_SIZE;
859 
860 	len += snprintf(buf + len, PAGE_SIZE - len, "\n");
861 
862 	for (i = 0; i < stats->max_states; i++) {
863 		if (len >= PAGE_SIZE)
864 			break;
865 
866 		len += snprintf(buf + len, PAGE_SIZE - len, "state%2u:", i);
867 
868 		for (j = 0; j < stats->max_states; j++) {
869 			if (len >= PAGE_SIZE)
870 				break;
871 			len += snprintf(buf + len, PAGE_SIZE - len, "%8u ",
872 				stats->trans_table[i * stats->max_states + j]);
873 		}
874 		if (len >= PAGE_SIZE)
875 			break;
876 		len += snprintf(buf + len, PAGE_SIZE - len, "\n");
877 	}
878 
879 	if (len >= PAGE_SIZE) {
880 		pr_warn_once("Thermal transition table exceeds PAGE_SIZE. Disabling\n");
881 		return -EFBIG;
882 	}
883 	return len;
884 }
885 
886 static DEVICE_ATTR_RO(total_trans);
887 static DEVICE_ATTR_RO(time_in_state_ms);
888 static DEVICE_ATTR_WO(reset);
889 static DEVICE_ATTR_RO(trans_table);
890 
891 static struct attribute *cooling_device_stats_attrs[] = {
892 	&dev_attr_total_trans.attr,
893 	&dev_attr_time_in_state_ms.attr,
894 	&dev_attr_reset.attr,
895 	&dev_attr_trans_table.attr,
896 	NULL
897 };
898 
899 static const struct attribute_group cooling_device_stats_attr_group = {
900 	.attrs = cooling_device_stats_attrs,
901 	.name = "stats"
902 };
903 
904 static void cooling_device_stats_setup(struct thermal_cooling_device *cdev)
905 {
906 	struct cooling_dev_stats *stats;
907 	unsigned long states;
908 	int var;
909 
910 	if (cdev->ops->get_max_state(cdev, &states))
911 		return;
912 
913 	states++; /* Total number of states is highest state + 1 */
914 
915 	var = sizeof(*stats);
916 	var += sizeof(*stats->time_in_state) * states;
917 	var += sizeof(*stats->trans_table) * states * states;
918 
919 	stats = kzalloc(var, GFP_KERNEL);
920 	if (!stats)
921 		return;
922 
923 	stats->time_in_state = (ktime_t *)(stats + 1);
924 	stats->trans_table = (unsigned int *)(stats->time_in_state + states);
925 	cdev->stats = stats;
926 	stats->last_time = ktime_get();
927 	stats->max_states = states;
928 
929 	spin_lock_init(&stats->lock);
930 
931 	/* Fill the empty slot left in cooling_device_attr_groups */
932 	var = ARRAY_SIZE(cooling_device_attr_groups) - 2;
933 	cooling_device_attr_groups[var] = &cooling_device_stats_attr_group;
934 }
935 
936 static void cooling_device_stats_destroy(struct thermal_cooling_device *cdev)
937 {
938 	kfree(cdev->stats);
939 	cdev->stats = NULL;
940 }
941 
942 #else
943 
944 static inline void
945 cooling_device_stats_setup(struct thermal_cooling_device *cdev) {}
946 static inline void
947 cooling_device_stats_destroy(struct thermal_cooling_device *cdev) {}
948 
949 #endif /* CONFIG_THERMAL_STATISTICS */
950 
951 void thermal_cooling_device_setup_sysfs(struct thermal_cooling_device *cdev)
952 {
953 	cooling_device_stats_setup(cdev);
954 	cdev->device.groups = cooling_device_attr_groups;
955 }
956 
957 void thermal_cooling_device_destroy_sysfs(struct thermal_cooling_device *cdev)
958 {
959 	cooling_device_stats_destroy(cdev);
960 }
961 
962 /* these helper will be used only at the time of bindig */
963 ssize_t
964 trip_point_show(struct device *dev, struct device_attribute *attr, char *buf)
965 {
966 	struct thermal_instance *instance;
967 
968 	instance =
969 	    container_of(attr, struct thermal_instance, attr);
970 
971 	if (instance->trip == THERMAL_TRIPS_NONE)
972 		return sprintf(buf, "-1\n");
973 	else
974 		return sprintf(buf, "%d\n", instance->trip);
975 }
976 
977 ssize_t
978 weight_show(struct device *dev, struct device_attribute *attr, char *buf)
979 {
980 	struct thermal_instance *instance;
981 
982 	instance = container_of(attr, struct thermal_instance, weight_attr);
983 
984 	return sprintf(buf, "%d\n", instance->weight);
985 }
986 
987 ssize_t weight_store(struct device *dev, struct device_attribute *attr,
988 		     const char *buf, size_t count)
989 {
990 	struct thermal_instance *instance;
991 	int ret, weight;
992 
993 	ret = kstrtoint(buf, 0, &weight);
994 	if (ret)
995 		return ret;
996 
997 	instance = container_of(attr, struct thermal_instance, weight_attr);
998 	instance->weight = weight;
999 
1000 	return count;
1001 }
1002