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                 fprintf(stderr,
  43                         _("ERROR: Can't get value of subfeature %s: %s\n"),
  44                         sub->name, sensors_strerror(err));
  45                 val = UNKNOWN_DBL_VALUE;
  46         }
  47         return val;
  48 }
  49
  50 static double get_temp_input(struct psensor *sensor)
  51 {
  52         const sensors_chip_name *chip = sensor->iname;
  53         const sensors_feature *feature = sensor->feature;
  54
  55         const sensors_subfeature *sf;
  56
  57         sf = sensors_get_subfeature(chip,
  58                                     feature, SENSORS_SUBFEATURE_TEMP_INPUT);
  59         if (sf)
  60                 return get_value(chip, sf);
  61         else
  62                 return UNKNOWN_DBL_VALUE;
  63 }
  64
  65 static double get_fan_input(struct psensor *sensor)
  66 {
  67         const sensors_chip_name *chip = sensor->iname;
  68         const sensors_feature *feature = sensor->feature;
  69
  70         const sensors_subfeature *sf;
  71
  72         sf = sensors_get_subfeature(chip,
  73                                     feature, SENSORS_SUBFEATURE_FAN_INPUT);
  74         if (sf)
  75                 return get_value(chip, sf);
  76         else
  77                 return UNKNOWN_DBL_VALUE;
  78 }
  79
  80 void lmsensor_psensor_list_update(struct psensor **sensors)
  81 {
  82         struct psensor **s_ptr = sensors;
  83
  84         if (!init_done)
  85                 return ;
  86
  87         while (*s_ptr) {
  88                 struct psensor *sensor = *s_ptr;
  89
  90                 if (sensor->type == SENSOR_TYPE_LMSENSOR_TEMP)
  91                         psensor_set_current_value
  92                             (sensor, get_temp_input(sensor));
  93                 else if (sensor->type == SENSOR_TYPE_LMSENSOR_FAN)
  94                         psensor_set_current_value(sensor,
  95                                                   get_fan_input(sensor));
  96
  97                 s_ptr++;
  98         }
  99 }
 100
 101 static struct psensor *
 102 lmsensor_psensor_create(const sensors_chip_name *chip,
 103                         const sensors_feature *feature,
 104                         int values_max_length)
 105 {
 106         char name[200];
 107         const sensors_subfeature *sf;
 108         char *label;
 109         int type;
 110         char *id;
 111         struct psensor *psensor;
 112         sensors_subfeature_type fault_subfeature;
 113
 114         if (sensors_snprintf_chip_name(name, 200, chip) < 0)
 115                 return NULL;
 116
 117         if (feature->type == SENSORS_FEATURE_TEMP) {
 118                 fault_subfeature = SENSORS_SUBFEATURE_TEMP_FAULT;
 119
 120         } else if (feature->type == SENSORS_FEATURE_FAN) {
 121                 fault_subfeature = SENSORS_SUBFEATURE_FAN_FAULT;
 122
 123         } else {
 124                 fprintf(stderr,
 125                         _("ERROR: create_sensor, wrong feature type\n"));
 126                 return NULL;
 127         }
 128
 129         sf = sensors_get_subfeature(chip, feature, fault_subfeature);
 130         if (sf && get_value(chip, sf))
 131                 return NULL;
 132
 133         label = sensors_get_label(chip, feature);
 134         if (!label)
 135                 return NULL;
 136
 137         type = 0;
 138         if (feature->type == SENSORS_FEATURE_TEMP)
 139                 type = SENSOR_TYPE_LMSENSOR_TEMP;
 140         else if (feature->type == SENSORS_FEATURE_FAN)
 141                 type = SENSOR_TYPE_LMSENSOR_FAN;
 142         else
 143                 return NULL;
 144
 145         id = malloc(strlen("lmsensor ") + 1 + strlen(name) + 1 + strlen(label) +
 146                     1);
 147         sprintf(id, "lmsensor %s %s", name, label);
 148
 149         psensor = psensor_create(id, label, type, values_max_length);
 150
 151         psensor->iname = chip;
 152         psensor->feature = feature;
 153
 154         if (feature->type == SENSORS_FEATURE_TEMP
 155             && (get_temp_input(psensor) == UNKNOWN_DBL_VALUE)) {
 156                 free(psensor);
 157                 return NULL;
 158         }
 159
 160         return psensor;
 161 }
 162
 163 struct psensor **lmsensor_psensor_list_add(struct psensor **sensors,
 164                                            int vn)
 165 {
 166         const sensors_chip_name *chip;
 167         int chip_nr = 0;
 168         struct psensor **tmp, **result;
 169         const sensors_feature *feature;
 170         struct psensor *s;
 171         int i;
 172
 173         if (!init_done)
 174                 return NULL;
 175
 176         result = sensors;
 177         while ((chip = sensors_get_detected_chips(NULL, &chip_nr))) {
 178
 179                 i = 0;
 180                 while ((feature = sensors_get_features(chip, &i))) {
 181
 182                         if (feature->type == SENSORS_FEATURE_TEMP
 183                             || feature->type == SENSORS_FEATURE_FAN) {
 184
 185                                 s = lmsensor_psensor_create(chip, feature, vn);
 186
 187                                 if (s) {
 188                                         tmp = psensor_list_add(result, s);
 189
 190                                         if (tmp != sensors)
 191                                                 free(result);
 192
 193                                         result = tmp;
 194                                 }
 195                         }
 196                 }
 197         }
 198
 199         return result;
 200 }
 201
 202 void lmsensor_init()
 203 {
 204         int err = sensors_init(NULL);
 205
 206         if (err) {
 207                 fprintf(stderr,
 208                         _("ERROR: lm-sensors initialization failure: %s\n"),
 209                         sensors_strerror(err));
 210                 init_done = 0;
 211         } else {
 212                 init_done = 1;
 213         }
 214 }
 215
 216 void lmsensor_cleanup()
 217 {
 218         if (init_done)
 219                 sensors_cleanup();
 220 }