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