1 // SPDX-License-Identifier: LGPL-2.1+
2 // Copyright (C) 2022, Linaro Ltd - Daniel Lezcano <daniel.lezcano@linaro.org>
3 #include <stdio.h>
4 #include <thermal.h>
5 
6 #include "thermal_nl.h"
7 
for_each_thermal_cdev(struct thermal_cdev * cdev,cb_tc_t cb,void * arg)8 int for_each_thermal_cdev(struct thermal_cdev *cdev, cb_tc_t cb, void *arg)
9 {
10 	int i, ret = 0;
11 
12 	if (!cdev)
13 		return 0;
14 
15 	for (i = 0; cdev[i].id != -1; i++)
16 		ret |= cb(&cdev[i], arg);
17 
18 	return ret;
19 }
20 
for_each_thermal_trip(struct thermal_trip * tt,cb_tt_t cb,void * arg)21 int for_each_thermal_trip(struct thermal_trip *tt, cb_tt_t cb, void *arg)
22 {
23 	int i, ret = 0;
24 
25 	if (!tt)
26 		return 0;
27 
28 	for (i = 0; tt[i].id != -1; i++)
29 		ret |= cb(&tt[i], arg);
30 
31 	return ret;
32 }
33 
for_each_thermal_zone(struct thermal_zone * tz,cb_tz_t cb,void * arg)34 int for_each_thermal_zone(struct thermal_zone *tz, cb_tz_t cb, void *arg)
35 {
36 	int i, ret = 0;
37 
38 	if (!tz)
39 		return 0;
40 
41 	for (i = 0; tz[i].id != -1; i++)
42 		ret |= cb(&tz[i], arg);
43 
44 	return ret;
45 }
46 
thermal_zone_find_by_name(struct thermal_zone * tz,const char * name)47 struct thermal_zone *thermal_zone_find_by_name(struct thermal_zone *tz,
48 					       const char *name)
49 {
50 	int i;
51 
52 	if (!tz || !name)
53 		return NULL;
54 
55 	for (i = 0; tz[i].id != -1; i++) {
56 		if (!strcmp(tz[i].name, name))
57 			return &tz[i];
58 	}
59 
60 	return NULL;
61 }
62 
thermal_zone_find_by_id(struct thermal_zone * tz,int id)63 struct thermal_zone *thermal_zone_find_by_id(struct thermal_zone *tz, int id)
64 {
65 	int i;
66 
67 	if (!tz || id < 0)
68 		return NULL;
69 
70 	for (i = 0; tz[i].id != -1; i++) {
71 		if (tz[i].id == id)
72 			return &tz[i];
73 	}
74 
75 	return NULL;
76 }
77 
__thermal_zone_discover(struct thermal_zone * tz,void * th)78 static int __thermal_zone_discover(struct thermal_zone *tz, void *th)
79 {
80 	if (thermal_cmd_get_trip(th, tz) < 0)
81 		return -1;
82 
83 	if (thermal_cmd_get_governor(th, tz))
84 		return -1;
85 
86 	return 0;
87 }
88 
thermal_zone_discover(struct thermal_handler * th)89 struct thermal_zone *thermal_zone_discover(struct thermal_handler *th)
90 {
91 	struct thermal_zone *tz;
92 
93 	if (thermal_cmd_get_tz(th, &tz) < 0)
94 		return NULL;
95 
96 	if (for_each_thermal_zone(tz, __thermal_zone_discover, th))
97 		return NULL;
98 
99 	return tz;
100 }
101 
thermal_exit(struct thermal_handler * th)102 void thermal_exit(struct thermal_handler *th)
103 {
104 	thermal_cmd_exit(th);
105 	thermal_events_exit(th);
106 	thermal_sampling_exit(th);
107 
108 	free(th);
109 }
110 
thermal_init(struct thermal_ops * ops)111 struct thermal_handler *thermal_init(struct thermal_ops *ops)
112 {
113 	struct thermal_handler *th;
114 
115 	th = malloc(sizeof(*th));
116 	if (!th)
117 		return NULL;
118 	th->ops = ops;
119 
120 	if (thermal_events_init(th))
121 		goto out_free;
122 
123 	if (thermal_sampling_init(th))
124 		goto out_free;
125 
126 	if (thermal_cmd_init(th))
127 		goto out_free;
128 
129 	return th;
130 
131 out_free:
132 	free(th);
133 
134 	return NULL;
135 }
136