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