• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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
type_show(struct device * dev,struct device_attribute * attr,char * buf)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
temp_show(struct device * dev,struct device_attribute * attr,char * buf)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
mode_show(struct device * dev,struct device_attribute * attr,char * buf)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
mode_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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
trip_point_type_show(struct device * dev,struct device_attribute * attr,char * buf)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
trip_point_temp_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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
trip_point_temp_show(struct device * dev,struct device_attribute * attr,char * buf)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
trip_point_hyst_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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
trip_point_hyst_show(struct device * dev,struct device_attribute * attr,char * buf)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
passive_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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
passive_show(struct device * dev,struct device_attribute * attr,char * buf)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
policy_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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
policy_show(struct device * dev,struct device_attribute * devattr,char * buf)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
available_policies_show(struct device * dev,struct device_attribute * devattr,char * buf)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
emul_temp_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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
sustainable_power_show(struct device * dev,struct device_attribute * devattr,char * buf)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
sustainable_power_store(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)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 
thermal_zone_mode_is_visible(struct kobject * kobj,struct attribute * attr,int attrno)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 
thermal_zone_passive_is_visible(struct kobject * kobj,struct attribute * attr,int attrno)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  */
create_trip_attrs(struct thermal_zone_device * tz,int mask)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  */
destroy_trip_attrs(struct thermal_zone_device * tz)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 
thermal_zone_create_device_groups(struct thermal_zone_device * tz,int mask)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 
thermal_zone_destroy_device_groups(struct thermal_zone_device * tz)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
cdev_type_show(struct device * dev,struct device_attribute * attr,char * buf)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 
max_state_show(struct device * dev,struct device_attribute * attr,char * buf)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 
cur_state_show(struct device * dev,struct device_attribute * attr,char * buf)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
cur_state_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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 	mutex_lock(&cdev->lock);
716 
717 	result = cdev->ops->set_cur_state(cdev, state);
718 	if (!result)
719 		thermal_cooling_device_stats_update(cdev, state);
720 
721 	mutex_unlock(&cdev->lock);
722 	return result ? result : count;
723 }
724 
725 static struct device_attribute
726 dev_attr_cdev_type = __ATTR(type, 0444, cdev_type_show, NULL);
727 static DEVICE_ATTR_RO(max_state);
728 static DEVICE_ATTR_RW(cur_state);
729 
730 static struct attribute *cooling_device_attrs[] = {
731 	&dev_attr_cdev_type.attr,
732 	&dev_attr_max_state.attr,
733 	&dev_attr_cur_state.attr,
734 	NULL,
735 };
736 
737 static const struct attribute_group cooling_device_attr_group = {
738 	.attrs = cooling_device_attrs,
739 };
740 
741 static const struct attribute_group *cooling_device_attr_groups[] = {
742 	&cooling_device_attr_group,
743 	NULL, /* Space allocated for cooling_device_stats_attr_group */
744 	NULL,
745 };
746 
747 #ifdef CONFIG_THERMAL_STATISTICS
748 struct cooling_dev_stats {
749 	spinlock_t lock;
750 	unsigned int total_trans;
751 	unsigned long state;
752 	unsigned long max_states;
753 	ktime_t last_time;
754 	ktime_t *time_in_state;
755 	unsigned int *trans_table;
756 };
757 
update_time_in_state(struct cooling_dev_stats * stats)758 static void update_time_in_state(struct cooling_dev_stats *stats)
759 {
760 	ktime_t now = ktime_get(), delta;
761 
762 	delta = ktime_sub(now, stats->last_time);
763 	stats->time_in_state[stats->state] =
764 		ktime_add(stats->time_in_state[stats->state], delta);
765 	stats->last_time = now;
766 }
767 
thermal_cooling_device_stats_update(struct thermal_cooling_device * cdev,unsigned long new_state)768 void thermal_cooling_device_stats_update(struct thermal_cooling_device *cdev,
769 					 unsigned long new_state)
770 {
771 	struct cooling_dev_stats *stats = cdev->stats;
772 
773 	spin_lock(&stats->lock);
774 
775 	if (stats->state == new_state)
776 		goto unlock;
777 
778 	update_time_in_state(stats);
779 	stats->trans_table[stats->state * stats->max_states + new_state]++;
780 	stats->state = new_state;
781 	stats->total_trans++;
782 
783 unlock:
784 	spin_unlock(&stats->lock);
785 }
786 
total_trans_show(struct device * dev,struct device_attribute * attr,char * buf)787 static ssize_t total_trans_show(struct device *dev,
788 				struct device_attribute *attr, char *buf)
789 {
790 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
791 	struct cooling_dev_stats *stats = cdev->stats;
792 	int ret;
793 
794 	spin_lock(&stats->lock);
795 	ret = sprintf(buf, "%u\n", stats->total_trans);
796 	spin_unlock(&stats->lock);
797 
798 	return ret;
799 }
800 
801 static ssize_t
time_in_state_ms_show(struct device * dev,struct device_attribute * attr,char * buf)802 time_in_state_ms_show(struct device *dev, struct device_attribute *attr,
803 		      char *buf)
804 {
805 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
806 	struct cooling_dev_stats *stats = cdev->stats;
807 	ssize_t len = 0;
808 	int i;
809 
810 	spin_lock(&stats->lock);
811 	update_time_in_state(stats);
812 
813 	for (i = 0; i < stats->max_states; i++) {
814 		len += sprintf(buf + len, "state%u\t%llu\n", i,
815 			       ktime_to_ms(stats->time_in_state[i]));
816 	}
817 	spin_unlock(&stats->lock);
818 
819 	return len;
820 }
821 
822 static ssize_t
reset_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)823 reset_store(struct device *dev, struct device_attribute *attr, const char *buf,
824 	    size_t count)
825 {
826 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
827 	struct cooling_dev_stats *stats = cdev->stats;
828 	int i, states = stats->max_states;
829 
830 	spin_lock(&stats->lock);
831 
832 	stats->total_trans = 0;
833 	stats->last_time = ktime_get();
834 	memset(stats->trans_table, 0,
835 	       states * states * sizeof(*stats->trans_table));
836 
837 	for (i = 0; i < stats->max_states; i++)
838 		stats->time_in_state[i] = ktime_set(0, 0);
839 
840 	spin_unlock(&stats->lock);
841 
842 	return count;
843 }
844 
trans_table_show(struct device * dev,struct device_attribute * attr,char * buf)845 static ssize_t trans_table_show(struct device *dev,
846 				struct device_attribute *attr, char *buf)
847 {
848 	struct thermal_cooling_device *cdev = to_cooling_device(dev);
849 	struct cooling_dev_stats *stats = cdev->stats;
850 	ssize_t len = 0;
851 	int i, j;
852 
853 	len += snprintf(buf + len, PAGE_SIZE - len, " From  :    To\n");
854 	len += snprintf(buf + len, PAGE_SIZE - len, "       : ");
855 	for (i = 0; i < stats->max_states; i++) {
856 		if (len >= PAGE_SIZE)
857 			break;
858 		len += snprintf(buf + len, PAGE_SIZE - len, "state%2u  ", i);
859 	}
860 	if (len >= PAGE_SIZE)
861 		return PAGE_SIZE;
862 
863 	len += snprintf(buf + len, PAGE_SIZE - len, "\n");
864 
865 	for (i = 0; i < stats->max_states; i++) {
866 		if (len >= PAGE_SIZE)
867 			break;
868 
869 		len += snprintf(buf + len, PAGE_SIZE - len, "state%2u:", i);
870 
871 		for (j = 0; j < stats->max_states; j++) {
872 			if (len >= PAGE_SIZE)
873 				break;
874 			len += snprintf(buf + len, PAGE_SIZE - len, "%8u ",
875 				stats->trans_table[i * stats->max_states + j]);
876 		}
877 		if (len >= PAGE_SIZE)
878 			break;
879 		len += snprintf(buf + len, PAGE_SIZE - len, "\n");
880 	}
881 
882 	if (len >= PAGE_SIZE) {
883 		pr_warn_once("Thermal transition table exceeds PAGE_SIZE. Disabling\n");
884 		return -EFBIG;
885 	}
886 	return len;
887 }
888 
889 static DEVICE_ATTR_RO(total_trans);
890 static DEVICE_ATTR_RO(time_in_state_ms);
891 static DEVICE_ATTR_WO(reset);
892 static DEVICE_ATTR_RO(trans_table);
893 
894 static struct attribute *cooling_device_stats_attrs[] = {
895 	&dev_attr_total_trans.attr,
896 	&dev_attr_time_in_state_ms.attr,
897 	&dev_attr_reset.attr,
898 	&dev_attr_trans_table.attr,
899 	NULL
900 };
901 
902 static const struct attribute_group cooling_device_stats_attr_group = {
903 	.attrs = cooling_device_stats_attrs,
904 	.name = "stats"
905 };
906 
cooling_device_stats_setup(struct thermal_cooling_device * cdev)907 static void cooling_device_stats_setup(struct thermal_cooling_device *cdev)
908 {
909 	struct cooling_dev_stats *stats;
910 	unsigned long states;
911 	int var;
912 
913 	if (cdev->ops->get_max_state(cdev, &states))
914 		return;
915 
916 	states++; /* Total number of states is highest state + 1 */
917 
918 	var = sizeof(*stats);
919 	var += sizeof(*stats->time_in_state) * states;
920 	var += sizeof(*stats->trans_table) * states * states;
921 
922 	stats = kzalloc(var, GFP_KERNEL);
923 	if (!stats)
924 		return;
925 
926 	stats->time_in_state = (ktime_t *)(stats + 1);
927 	stats->trans_table = (unsigned int *)(stats->time_in_state + states);
928 	cdev->stats = stats;
929 	stats->last_time = ktime_get();
930 	stats->max_states = states;
931 
932 	spin_lock_init(&stats->lock);
933 
934 	/* Fill the empty slot left in cooling_device_attr_groups */
935 	var = ARRAY_SIZE(cooling_device_attr_groups) - 2;
936 	cooling_device_attr_groups[var] = &cooling_device_stats_attr_group;
937 }
938 
cooling_device_stats_destroy(struct thermal_cooling_device * cdev)939 static void cooling_device_stats_destroy(struct thermal_cooling_device *cdev)
940 {
941 	kfree(cdev->stats);
942 	cdev->stats = NULL;
943 }
944 
945 #else
946 
947 static inline void
cooling_device_stats_setup(struct thermal_cooling_device * cdev)948 cooling_device_stats_setup(struct thermal_cooling_device *cdev) {}
949 static inline void
cooling_device_stats_destroy(struct thermal_cooling_device * cdev)950 cooling_device_stats_destroy(struct thermal_cooling_device *cdev) {}
951 
952 #endif /* CONFIG_THERMAL_STATISTICS */
953 
thermal_cooling_device_setup_sysfs(struct thermal_cooling_device * cdev)954 void thermal_cooling_device_setup_sysfs(struct thermal_cooling_device *cdev)
955 {
956 	cooling_device_stats_setup(cdev);
957 	cdev->device.groups = cooling_device_attr_groups;
958 }
959 
thermal_cooling_device_destroy_sysfs(struct thermal_cooling_device * cdev)960 void thermal_cooling_device_destroy_sysfs(struct thermal_cooling_device *cdev)
961 {
962 	cooling_device_stats_destroy(cdev);
963 }
964 
965 /* these helper will be used only at the time of bindig */
966 ssize_t
trip_point_show(struct device * dev,struct device_attribute * attr,char * buf)967 trip_point_show(struct device *dev, struct device_attribute *attr, char *buf)
968 {
969 	struct thermal_instance *instance;
970 
971 	instance =
972 	    container_of(attr, struct thermal_instance, attr);
973 
974 	if (instance->trip == THERMAL_TRIPS_NONE)
975 		return sprintf(buf, "-1\n");
976 	else
977 		return sprintf(buf, "%d\n", instance->trip);
978 }
979 
980 ssize_t
weight_show(struct device * dev,struct device_attribute * attr,char * buf)981 weight_show(struct device *dev, struct device_attribute *attr, char *buf)
982 {
983 	struct thermal_instance *instance;
984 
985 	instance = container_of(attr, struct thermal_instance, weight_attr);
986 
987 	return sprintf(buf, "%d\n", instance->weight);
988 }
989 
weight_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)990 ssize_t weight_store(struct device *dev, struct device_attribute *attr,
991 		     const char *buf, size_t count)
992 {
993 	struct thermal_instance *instance;
994 	int ret, weight;
995 
996 	ret = kstrtoint(buf, 0, &weight);
997 	if (ret)
998 		return ret;
999 
1000 	instance = container_of(attr, struct thermal_instance, weight_attr);
1001 	instance->weight = weight;
1002 
1003 	return count;
1004 }
1005