Linux Audio

Check our new training course

Embedded Linux training

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