tools/lib/thermal/thermal.c

   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
   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
  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
  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
  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
  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
  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
  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
 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
 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 }