src/lib/lmsensor.c

   1 /*
   2  * Copyright (C) 2010-2012 jeanfi@gmail.com
   3  *
   4  * This program is free software; you can redistribute it and/or
   5  * modify it under the terms of the GNU General Public License as
   6  * published by the Free Software Foundation; either version 2 of the
   7  * License, or (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with this program; if not, write to the Free Software
  16  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  17  * 02110-1301 USA
  18  */
  19 #include <locale.h>
  20 #include <libintl.h>
  21 #define _(str) gettext(str)
  22
  23 #include <stdio.h>
  24 #include <stdlib.h>
  25 #include <string.h>
  26
  27 #include <sensors/sensors.h>
  28 #include <sensors/error.h>
  29
  30 #include "psensor.h"
  31
  32 static int init_done;
  33
  34 static double get_value(const sensors_chip_name *name,
  35                         const sensors_subfeature *sub)
  36 {
  37         double val;
  38         int err;
  39
  40         err = sensors_get_value(name, sub->number, &val);
  41         if (err) {
  42                 log_err(_("lmsensor: cannot get value of subfeature %s: %s."),
  43                         sub->name, sensors_strerror(err));
  44                 val = UNKNOWN_DBL_VALUE;
  45         }
  46         return val;
  47 }
  48
  49 static double get_temp_input(struct psensor *sensor)
  50 {
  51         const sensors_chip_name *chip = sensor->iname;
  52         const sensors_feature *feature = sensor->feature;
  53
  54         const sensors_subfeature *sf;
  55
  56         sf = sensors_get_subfeature(chip,
  57                                     feature, SENSORS_SUBFEATURE_TEMP_INPUT);
  58         if (sf)
  59                 return get_value(chip, sf);
  60         else
  61                 return UNKNOWN_DBL_VALUE;
  62 }
  63
  64 static double get_fan_input(struct psensor *sensor)
  65 {
  66         const sensors_chip_name *chip = sensor->iname;
  67         const sensors_feature *feature = sensor->feature;
  68
  69         const sensors_subfeature *sf;
  70
  71         sf = sensors_get_subfeature(chip,
  72                                     feature, SENSORS_SUBFEATURE_FAN_INPUT);
  73         if (sf)
  74                 return get_value(chip, sf);
  75         else
  76                 return UNKNOWN_DBL_VALUE;
  77 }
  78
  79 void lmsensor_psensor_list_update(struct psensor **sensors)
  80 {
  81         struct psensor **s_ptr = sensors;
  82
  83         if (!init_done)
  84                 return ;
  85
  86         while (*s_ptr) {
  87                 struct psensor *sensor = *s_ptr;
  88
  89                 if (sensor->type == SENSOR_TYPE_LMSENSOR_TEMP)
  90                         psensor_set_current_value
  91                             (sensor, get_temp_input(sensor));
  92                 else if (sensor->type == SENSOR_TYPE_LMSENSOR_FAN)
  93                         psensor_set_current_value(sensor,
  94                                                   get_fan_input(sensor));
  95
  96                 s_ptr++;
  97         }
  98 }
  99
 100 static struct psensor *
 101 lmsensor_psensor_create(const sensors_chip_name *chip,
 102                         const sensors_feature *feature,
 103                         int values_max_length)
 104 {
 105         char name[200];
 106         const sensors_subfeature *sf;
 107         char *label;
 108         int type;
 109         char *id;
 110         struct psensor *psensor;
 111         sensors_subfeature_type fault_subfeature;
 112
 113         if (sensors_snprintf_chip_name(name, 200, chip) < 0)
 114                 return NULL;
 115
 116         if (feature->type == SENSORS_FEATURE_TEMP) {
 117                 fault_subfeature = SENSORS_SUBFEATURE_TEMP_FAULT;
 118
 119         } else if (feature->type == SENSORS_FEATURE_FAN) {
 120                 fault_subfeature = SENSORS_SUBFEATURE_FAN_FAULT;
 121
 122         } else {
 123                 log_err(_("lmsensor: lmsensor_psensor_create failure:"
 124                           " wrong feature type."));
 125                 return NULL;
 126         }
 127
 128         sf = sensors_get_subfeature(chip, feature, fault_subfeature);
 129         if (sf && get_value(chip, sf))
 130                 return NULL;
 131
 132         label = sensors_get_label(chip, feature);
 133         if (!label)
 134                 return NULL;
 135
 136         type = 0;
 137         if (feature->type == SENSORS_FEATURE_TEMP)
 138                 type = SENSOR_TYPE_LMSENSOR_TEMP;
 139         else if (feature->type == SENSORS_FEATURE_FAN)
 140                 type = SENSOR_TYPE_LMSENSOR_FAN;
 141         else
 142                 return NULL;
 143
 144         id = malloc(strlen("lmsensor ") + 1 + strlen(name) + 1 + strlen(label) +
 145                     1);
 146         sprintf(id, "lmsensor %s %s", name, label);
 147
 148         psensor = psensor_create(id, label, type, values_max_length);
 149
 150         psensor->iname = chip;
 151         psensor->feature = feature;
 152
 153         if (feature->type == SENSORS_FEATURE_TEMP
 154             && (get_temp_input(psensor) == UNKNOWN_DBL_VALUE)) {
 155                 free(psensor);
 156                 return NULL;
 157         }
 158
 159         return psensor;
 160 }
 161
 162 struct psensor **lmsensor_psensor_list_add(struct psensor **sensors,
 163                                            int vn)
 164 {
 165         const sensors_chip_name *chip;
 166         int chip_nr = 0;
 167         struct psensor **tmp, **result;
 168         const sensors_feature *feature;
 169         struct psensor *s;
 170         int i;
 171
 172         if (!init_done)
 173                 return NULL;
 174
 175         result = sensors;
 176         while ((chip = sensors_get_detected_chips(NULL, &chip_nr))) {
 177
 178                 i = 0;
 179                 while ((feature = sensors_get_features(chip, &i))) {
 180
 181                         if (feature->type == SENSORS_FEATURE_TEMP
 182                             || feature->type == SENSORS_FEATURE_FAN) {
 183
 184                                 s = lmsensor_psensor_create(chip, feature, vn);
 185
 186                                 if (s) {
 187                                         tmp = psensor_list_add(result, s);
 188
 189                                         if (tmp != sensors)
 190                                                 free(result);
 191
 192                                         result = tmp;
 193                                 }
 194                         }
 195                 }
 196         }
 197
 198         return result;
 199 }
 200
 201 void lmsensor_init()
 202 {
 203         int err = sensors_init(NULL);
 204
 205         if (err) {
 206                 log_err(_("lmsensor: initialization failure: %s."),
 207                         sensors_strerror(err));
 208                 init_done = 0;
 209         } else {
 210                 init_done = 1;
 211         }
 212 }
 213
 214 void lmsensor_cleanup()
 215 {
 216         if (init_done)
 217                 sensors_cleanup();
 218 }