136 lines · 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 8int 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 21int 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 34int 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 47struct 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 63struct 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 78static 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 89struct 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 102void 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 111struct 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 131out_free:132 free(th);133 134 return NULL;135}136