src/lib/lmsensor.c

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