OpenCores
URL https://opencores.org/ocsvn/test_project/test_project/trunk

Subversion Repositories test_project

[/] [test_project/] [trunk/] [linux_sd_driver/] [drivers/] [hwmon/] [adm1031.c] - Blame information for rev 62

Details | Compare with Previous | View Log

Line No. Rev Author Line
1 62 marcus.erl 
/*
2 
  adm1031.c - Part of lm_sensors, Linux kernel modules for hardware
3 
  monitoring
4 
  Based on lm75.c and lm85.c
5 
  Supports adm1030 / adm1031
6 
  Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org>
7 
  Reworked by Jean Delvare <khali@linux-fr.org>
8 
 
9 
  This program is free software; you can redistribute it and/or modify
10 
  it under the terms of the GNU General Public License as published by
11 
  the Free Software Foundation; either version 2 of the License, or
12 
  (at your option) any later version.
13 
 
14 
  This program is distributed in the hope that it will be useful,
15 
  but WITHOUT ANY WARRANTY; without even the implied warranty of
16 
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17 
  GNU General Public License for more details.
18 
 
19 
  You should have received a copy of the GNU General Public License
20 
  along with this program; if not, write to the Free Software
21 
  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 
*/
23 
 
24 
#include <linux/module.h>
25 
#include <linux/init.h>
26 
#include <linux/slab.h>
27 
#include <linux/jiffies.h>
28 
#include <linux/i2c.h>
29 
#include <linux/hwmon.h>
30 
#include <linux/err.h>
31 
#include <linux/mutex.h>
32 
 
33 
/* Following macros takes channel parameter starting from 0 to 2 */
34 
#define ADM1031_REG_FAN_SPEED(nr)       (0x08 + (nr))
35 
#define ADM1031_REG_FAN_DIV(nr)         (0x20  + (nr))
36 
#define ADM1031_REG_PWM                 (0x22)
37 
#define ADM1031_REG_FAN_MIN(nr)         (0x10 + (nr))
38 
 
39 
#define ADM1031_REG_TEMP_MAX(nr)        (0x14  + 4*(nr))
40 
#define ADM1031_REG_TEMP_MIN(nr)        (0x15  + 4*(nr))
41 
#define ADM1031_REG_TEMP_CRIT(nr)       (0x16  + 4*(nr))
42 
 
43 
#define ADM1031_REG_TEMP(nr)            (0xa + (nr))
44 
#define ADM1031_REG_AUTO_TEMP(nr)       (0x24 + (nr))
45 
 
46 
#define ADM1031_REG_STATUS(nr)          (0x2 + (nr))
47 
 
48 
#define ADM1031_REG_CONF1               0x0
49 
#define ADM1031_REG_CONF2               0x1
50 
#define ADM1031_REG_EXT_TEMP            0x6
51 
 
52 
#define ADM1031_CONF1_MONITOR_ENABLE    0x01    /* Monitoring enable */
53 
#define ADM1031_CONF1_PWM_INVERT        0x08    /* PWM Invert */
54 
#define ADM1031_CONF1_AUTO_MODE         0x80    /* Auto FAN */
55 
 
56 
#define ADM1031_CONF2_PWM1_ENABLE       0x01
57 
#define ADM1031_CONF2_PWM2_ENABLE       0x02
58 
#define ADM1031_CONF2_TACH1_ENABLE      0x04
59 
#define ADM1031_CONF2_TACH2_ENABLE      0x08
60 
#define ADM1031_CONF2_TEMP_ENABLE(chan) (0x10 << (chan))
61 
 
62 
/* Addresses to scan */
63 
static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
64 
 
65 
/* Insmod parameters */
66 
I2C_CLIENT_INSMOD_2(adm1030, adm1031);
67 
 
68 
typedef u8 auto_chan_table_t[8][2];
69 
 
70 
/* Each client has this additional data */
71 
struct adm1031_data {
72 
        struct i2c_client client;
73 
        struct device *hwmon_dev;
74 
        struct mutex update_lock;
75 
        int chip_type;
76 
        char valid;             /* !=0 if following fields are valid */
77 
        unsigned long last_updated;     /* In jiffies */
78 
        /* The chan_select_table contains the possible configurations for
79 
         * auto fan control.
80 
         */
81 
        auto_chan_table_t *chan_select_table;
82 
        u16 alarm;
83 
        u8 conf1;
84 
        u8 conf2;
85 
        u8 fan[2];
86 
        u8 fan_div[2];
87 
        u8 fan_min[2];
88 
        u8 pwm[2];
89 
        u8 old_pwm[2];
90 
        s8 temp[3];
91 
        u8 ext_temp[3];
92 
        u8 auto_temp[3];
93 
        u8 auto_temp_min[3];
94 
        u8 auto_temp_off[3];
95 
        u8 auto_temp_max[3];
96 
        s8 temp_min[3];
97 
        s8 temp_max[3];
98 
        s8 temp_crit[3];
99 
};
100 
 
101 
static int adm1031_attach_adapter(struct i2c_adapter *adapter);
102 
static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind);
103 
static void adm1031_init_client(struct i2c_client *client);
104 
static int adm1031_detach_client(struct i2c_client *client);
105 
static struct adm1031_data *adm1031_update_device(struct device *dev);
106 
 
107 
/* This is the driver that will be inserted */
108 
static struct i2c_driver adm1031_driver = {
109 
        .driver = {
110 
                .name = "adm1031",
111 
        },
112 
        .attach_adapter = adm1031_attach_adapter,
113 
        .detach_client = adm1031_detach_client,
114 
};
115 
 
116 
static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg)
117 
{
118 
        return i2c_smbus_read_byte_data(client, reg);
119 
}
120 
 
121 
static inline int
122 
adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value)
123 
{
124 
        return i2c_smbus_write_byte_data(client, reg, value);
125 
}
126 
 
127 
 
128 
#define TEMP_TO_REG(val)                (((val) < 0 ? ((val - 500) / 1000) : \
129 
                                        ((val + 500) / 1000)))
130 
 
131 
#define TEMP_FROM_REG(val)              ((val) * 1000)
132 
 
133 
#define TEMP_FROM_REG_EXT(val, ext)     (TEMP_FROM_REG(val) + (ext) * 125)
134 
 
135 
#define FAN_FROM_REG(reg, div)          ((reg) ? (11250 * 60) / ((reg) * (div)) : 0)
136 
 
137 
static int FAN_TO_REG(int reg, int div)
138 
{
139 
        int tmp;
140 
        tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div);
141 
        return tmp > 255 ? 255 : tmp;
142 
}
143 
 
144 
#define FAN_DIV_FROM_REG(reg)           (1<<(((reg)&0xc0)>>6))
145 
 
146 
#define PWM_TO_REG(val)                 (SENSORS_LIMIT((val), 0, 255) >> 4)
147 
#define PWM_FROM_REG(val)               ((val) << 4)
148 
 
149 
#define FAN_CHAN_FROM_REG(reg)          (((reg) >> 5) & 7)
150 
#define FAN_CHAN_TO_REG(val, reg)       \
151 
        (((reg) & 0x1F) | (((val) << 5) & 0xe0))
152 
 
153 
#define AUTO_TEMP_MIN_TO_REG(val, reg)  \
154 
        ((((val)/500) & 0xf8)|((reg) & 0x7))
155 
#define AUTO_TEMP_RANGE_FROM_REG(reg)   (5000 * (1<< ((reg)&0x7)))
156 
#define AUTO_TEMP_MIN_FROM_REG(reg)     (1000 * ((((reg) >> 3) & 0x1f) << 2))
157 
 
158 
#define AUTO_TEMP_MIN_FROM_REG_DEG(reg) ((((reg) >> 3) & 0x1f) << 2)
159 
 
160 
#define AUTO_TEMP_OFF_FROM_REG(reg)             \
161 
        (AUTO_TEMP_MIN_FROM_REG(reg) - 5000)
162 
 
163 
#define AUTO_TEMP_MAX_FROM_REG(reg)             \
164 
        (AUTO_TEMP_RANGE_FROM_REG(reg) +        \
165 
        AUTO_TEMP_MIN_FROM_REG(reg))
166 
 
167 
static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm)
168 
{
169 
        int ret;
170 
        int range = val - AUTO_TEMP_MIN_FROM_REG(reg);
171 
 
172 
        range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm);
173 
        ret = ((reg & 0xf8) |
174 
               (range < 10000 ? 0 :
175 
                range < 20000 ? 1 :
176 
                range < 40000 ? 2 : range < 80000 ? 3 : 4));
177 
        return ret;
178 
}
179 
 
180 
/* FAN auto control */
181 
#define GET_FAN_AUTO_BITFIELD(data, idx)        \
182 
        (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2]
183 
 
184 
/* The tables below contains the possible values for the auto fan
185 
 * control bitfields. the index in the table is the register value.
186 
 * MSb is the auto fan control enable bit, so the four first entries
187 
 * in the table disables auto fan control when both bitfields are zero.
188 
 */
189 
static auto_chan_table_t auto_channel_select_table_adm1031 = {
190 
        {0, 0}, {0, 0}, {0, 0}, {0, 0},
191 
        {2 /*0b010 */ , 4 /*0b100 */ },
192 
        {2 /*0b010 */ , 2 /*0b010 */ },
193 
        {4 /*0b100 */ , 4 /*0b100 */ },
194 
        {7 /*0b111 */ , 7 /*0b111 */ },
195 
};
196 
 
197 
static auto_chan_table_t auto_channel_select_table_adm1030 = {
198 
        {0, 0}, {0, 0}, {0, 0}, {0, 0},
199 
        {2 /*0b10 */            , 0},
200 
        {0xff /*invalid */      , 0},
201 
        {0xff /*invalid */      , 0},
202 
        {3 /*0b11 */            , 0},
203 
};
204 
 
205 
/* That function checks if a bitfield is valid and returns the other bitfield
206 
 * nearest match if no exact match where found.
207 
 */
208 
static int
209 
get_fan_auto_nearest(struct adm1031_data *data,
210 
                     int chan, u8 val, u8 reg, u8 * new_reg)
211 
{
212 
        int i;
213 
        int first_match = -1, exact_match = -1;
214 
        u8 other_reg_val =
215 
            (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1];
216 
 
217 
        if (val == 0) {
218 
                *new_reg = 0;
219 
                return 0;
220 
        }
221 
 
222 
        for (i = 0; i < 8; i++) {
223 
                if ((val == (*data->chan_select_table)[i][chan]) &&
224 
                    ((*data->chan_select_table)[i][chan ? 0 : 1] ==
225 
                     other_reg_val)) {
226 
                        /* We found an exact match */
227 
                        exact_match = i;
228 
                        break;
229 
                } else if (val == (*data->chan_select_table)[i][chan] &&
230 
                           first_match == -1) {
231 
                        /* Save the first match in case of an exact match has not been
232 
                         * found
233 
                         */
234 
                        first_match = i;
235 
                }
236 
        }
237 
 
238 
        if (exact_match >= 0) {
239 
                *new_reg = exact_match;
240 
        } else if (first_match >= 0) {
241 
                *new_reg = first_match;
242 
        } else {
243 
                return -EINVAL;
244 
        }
245 
        return 0;
246 
}
247 
 
248 
static ssize_t show_fan_auto_channel(struct device *dev, char *buf, int nr)
249 
{
250 
        struct adm1031_data *data = adm1031_update_device(dev);
251 
        return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr));
252 
}
253 
 
254 
static ssize_t
255 
set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr)
256 
{
257 
        struct i2c_client *client = to_i2c_client(dev);
258 
        struct adm1031_data *data = i2c_get_clientdata(client);
259 
        int val = simple_strtol(buf, NULL, 10);
260 
        u8 reg;
261 
        int ret;
262 
        u8 old_fan_mode;
263 
 
264 
        old_fan_mode = data->conf1;
265 
 
266 
        mutex_lock(&data->update_lock);
267 
 
268 
        if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, &reg))) {
269 
                mutex_unlock(&data->update_lock);
270 
                return ret;
271 
        }
272 
        if (((data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1)) & ADM1031_CONF1_AUTO_MODE) ^
273 
            (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) {
274 
                if (data->conf1 & ADM1031_CONF1_AUTO_MODE){
275 
                        /* Switch to Auto Fan Mode
276 
                         * Save PWM registers
277 
                         * Set PWM registers to 33% Both */
278 
                        data->old_pwm[0] = data->pwm[0];
279 
                        data->old_pwm[1] = data->pwm[1];
280 
                        adm1031_write_value(client, ADM1031_REG_PWM, 0x55);
281 
                } else {
282 
                        /* Switch to Manual Mode */
283 
                        data->pwm[0] = data->old_pwm[0];
284 
                        data->pwm[1] = data->old_pwm[1];
285 
                        /* Restore PWM registers */
286 
                        adm1031_write_value(client, ADM1031_REG_PWM,
287 
                                            data->pwm[0] | (data->pwm[1] << 4));
288 
                }
289 
        }
290 
        data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
291 
        adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1);
292 
        mutex_unlock(&data->update_lock);
293 
        return count;
294 
}
295 
 
296 
#define fan_auto_channel_offset(offset)                                         \
297 
static ssize_t show_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, char *buf)    \
298 
{                                                                               \
299 
        return show_fan_auto_channel(dev, buf, offset - 1);                     \
300 
}                                                                               \
301 
static ssize_t set_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr,                \
302 
        const char *buf, size_t count)                                          \
303 
{                                                                               \
304 
        return set_fan_auto_channel(dev, buf, count, offset - 1);               \
305 
}                                                                               \
306 
static DEVICE_ATTR(auto_fan##offset##_channel, S_IRUGO | S_IWUSR,               \
307 
                   show_fan_auto_channel_##offset,                              \
308 
                   set_fan_auto_channel_##offset)
309 
 
310 
fan_auto_channel_offset(1);
311 
fan_auto_channel_offset(2);
312 
 
313 
/* Auto Temps */
314 
static ssize_t show_auto_temp_off(struct device *dev, char *buf, int nr)
315 
{
316 
        struct adm1031_data *data = adm1031_update_device(dev);
317 
        return sprintf(buf, "%d\n",
318 
                       AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr]));
319 
}
320 
static ssize_t show_auto_temp_min(struct device *dev, char *buf, int nr)
321 
{
322 
        struct adm1031_data *data = adm1031_update_device(dev);
323 
        return sprintf(buf, "%d\n",
324 
                       AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr]));
325 
}
326 
static ssize_t
327 
set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr)
328 
{
329 
        struct i2c_client *client = to_i2c_client(dev);
330 
        struct adm1031_data *data = i2c_get_clientdata(client);
331 
        int val = simple_strtol(buf, NULL, 10);
332 
 
333 
        mutex_lock(&data->update_lock);
334 
        data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]);
335 
        adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
336 
                            data->auto_temp[nr]);
337 
        mutex_unlock(&data->update_lock);
338 
        return count;
339 
}
340 
static ssize_t show_auto_temp_max(struct device *dev, char *buf, int nr)
341 
{
342 
        struct adm1031_data *data = adm1031_update_device(dev);
343 
        return sprintf(buf, "%d\n",
344 
                       AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr]));
345 
}
346 
static ssize_t
347 
set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr)
348 
{
349 
        struct i2c_client *client = to_i2c_client(dev);
350 
        struct adm1031_data *data = i2c_get_clientdata(client);
351 
        int val = simple_strtol(buf, NULL, 10);
352 
 
353 
        mutex_lock(&data->update_lock);
354 
        data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]);
355 
        adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
356 
                            data->temp_max[nr]);
357 
        mutex_unlock(&data->update_lock);
358 
        return count;
359 
}
360 
 
361 
#define auto_temp_reg(offset)                                                   \
362 
static ssize_t show_auto_temp_##offset##_off (struct device *dev, struct device_attribute *attr, char *buf)     \
363 
{                                                                               \
364 
        return show_auto_temp_off(dev, buf, offset - 1);                        \
365 
}                                                                               \
366 
static ssize_t show_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)     \
367 
{                                                                               \
368 
        return show_auto_temp_min(dev, buf, offset - 1);                        \
369 
}                                                                               \
370 
static ssize_t show_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)     \
371 
{                                                                               \
372 
        return show_auto_temp_max(dev, buf, offset - 1);                        \
373 
}                                                                               \
374 
static ssize_t set_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr,         \
375 
                                             const char *buf, size_t count)     \
376 
{                                                                               \
377 
        return set_auto_temp_min(dev, buf, count, offset - 1);          \
378 
}                                                                               \
379 
static ssize_t set_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr,         \
380 
                                             const char *buf, size_t count)     \
381 
{                                                                               \
382 
        return set_auto_temp_max(dev, buf, count, offset - 1);          \
383 
}                                                                               \
384 
static DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO,                            \
385 
                   show_auto_temp_##offset##_off, NULL);                        \
386 
static DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR,                  \
387 
                   show_auto_temp_##offset##_min, set_auto_temp_##offset##_min);\
388 
static DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR,                  \
389 
                   show_auto_temp_##offset##_max, set_auto_temp_##offset##_max)
390 
 
391 
auto_temp_reg(1);
392 
auto_temp_reg(2);
393 
auto_temp_reg(3);
394 
 
395 
/* pwm */
396 
static ssize_t show_pwm(struct device *dev, char *buf, int nr)
397 
{
398 
        struct adm1031_data *data = adm1031_update_device(dev);
399 
        return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr]));
400 
}
401 
static ssize_t
402 
set_pwm(struct device *dev, const char *buf, size_t count, int nr)
403 
{
404 
        struct i2c_client *client = to_i2c_client(dev);
405 
        struct adm1031_data *data = i2c_get_clientdata(client);
406 
        int val = simple_strtol(buf, NULL, 10);
407 
        int reg;
408 
 
409 
        mutex_lock(&data->update_lock);
410 
        if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) &&
411 
            (((val>>4) & 0xf) != 5)) {
412 
                /* In automatic mode, the only PWM accepted is 33% */
413 
                mutex_unlock(&data->update_lock);
414 
                return -EINVAL;
415 
        }
416 
        data->pwm[nr] = PWM_TO_REG(val);
417 
        reg = adm1031_read_value(client, ADM1031_REG_PWM);
418 
        adm1031_write_value(client, ADM1031_REG_PWM,
419 
                            nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf)
420 
                            : (data->pwm[nr] & 0xf) | (reg & 0xf0));
421 
        mutex_unlock(&data->update_lock);
422 
        return count;
423 
}
424 
 
425 
#define pwm_reg(offset)                                                 \
426 
static ssize_t show_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
427 
{                                                                       \
428 
        return show_pwm(dev, buf, offset - 1);                  \
429 
}                                                                       \
430 
static ssize_t set_pwm_##offset (struct device *dev, struct device_attribute *attr,                     \
431 
                                 const char *buf, size_t count)         \
432 
{                                                                       \
433 
        return set_pwm(dev, buf, count, offset - 1);            \
434 
}                                                                       \
435 
static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR,                      \
436 
                   show_pwm_##offset, set_pwm_##offset)
437 
 
438 
pwm_reg(1);
439 
pwm_reg(2);
440 
 
441 
/* Fans */
442 
 
443 
/*
444 
 * That function checks the cases where the fan reading is not
445 
 * relevant.  It is used to provide 0 as fan reading when the fan is
446 
 * not supposed to run
447 
 */
448 
static int trust_fan_readings(struct adm1031_data *data, int chan)
449 
{
450 
        int res = 0;
451 
 
452 
        if (data->conf1 & ADM1031_CONF1_AUTO_MODE) {
453 
                switch (data->conf1 & 0x60) {
454 
                case 0x00:      /* remote temp1 controls fan1 remote temp2 controls fan2 */
455 
                        res = data->temp[chan+1] >=
456 
                              AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]);
457 
                        break;
458 
                case 0x20:      /* remote temp1 controls both fans */
459 
                        res =
460 
                            data->temp[1] >=
461 
                            AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]);
462 
                        break;
463 
                case 0x40:      /* remote temp2 controls both fans */
464 
                        res =
465 
                            data->temp[2] >=
466 
                            AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]);
467 
                        break;
468 
                case 0x60:      /* max controls both fans */
469 
                        res =
470 
                            data->temp[0] >=
471 
                            AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0])
472 
                            || data->temp[1] >=
473 
                            AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1])
474 
                            || (data->chip_type == adm1031
475 
                                && data->temp[2] >=
476 
                                AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]));
477 
                        break;
478 
                }
479 
        } else {
480 
                res = data->pwm[chan] > 0;
481 
        }
482 
        return res;
483 
}
484 
 
485 
 
486 
static ssize_t show_fan(struct device *dev, char *buf, int nr)
487 
{
488 
        struct adm1031_data *data = adm1031_update_device(dev);
489 
        int value;
490 
 
491 
        value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr],
492 
                                 FAN_DIV_FROM_REG(data->fan_div[nr])) : 0;
493 
        return sprintf(buf, "%d\n", value);
494 
}
495 
 
496 
static ssize_t show_fan_div(struct device *dev, char *buf, int nr)
497 
{
498 
        struct adm1031_data *data = adm1031_update_device(dev);
499 
        return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr]));
500 
}
501 
static ssize_t show_fan_min(struct device *dev, char *buf, int nr)
502 
{
503 
        struct adm1031_data *data = adm1031_update_device(dev);
504 
        return sprintf(buf, "%d\n",
505 
                       FAN_FROM_REG(data->fan_min[nr],
506 
                                    FAN_DIV_FROM_REG(data->fan_div[nr])));
507 
}
508 
static ssize_t
509 
set_fan_min(struct device *dev, const char *buf, size_t count, int nr)
510 
{
511 
        struct i2c_client *client = to_i2c_client(dev);
512 
        struct adm1031_data *data = i2c_get_clientdata(client);
513 
        int val = simple_strtol(buf, NULL, 10);
514 
 
515 
        mutex_lock(&data->update_lock);
516 
        if (val) {
517 
                data->fan_min[nr] =
518 
                        FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr]));
519 
        } else {
520 
                data->fan_min[nr] = 0xff;
521 
        }
522 
        adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), data->fan_min[nr]);
523 
        mutex_unlock(&data->update_lock);
524 
        return count;
525 
}
526 
static ssize_t
527 
set_fan_div(struct device *dev, const char *buf, size_t count, int nr)
528 
{
529 
        struct i2c_client *client = to_i2c_client(dev);
530 
        struct adm1031_data *data = i2c_get_clientdata(client);
531 
        int val = simple_strtol(buf, NULL, 10);
532 
        u8 tmp;
533 
        int old_div;
534 
        int new_min;
535 
 
536 
        tmp = val == 8 ? 0xc0 :
537 
              val == 4 ? 0x80 :
538 
              val == 2 ? 0x40 :
539 
              val == 1 ? 0x00 :
540 
              0xff;
541 
        if (tmp == 0xff)
542 
                return -EINVAL;
543 
 
544 
        mutex_lock(&data->update_lock);
545 
        old_div = FAN_DIV_FROM_REG(data->fan_div[nr]);
546 
        data->fan_div[nr] = (tmp & 0xC0) | (0x3f & data->fan_div[nr]);
547 
        new_min = data->fan_min[nr] * old_div /
548 
                FAN_DIV_FROM_REG(data->fan_div[nr]);
549 
        data->fan_min[nr] = new_min > 0xff ? 0xff : new_min;
550 
        data->fan[nr] = data->fan[nr] * old_div /
551 
                FAN_DIV_FROM_REG(data->fan_div[nr]);
552 
 
553 
        adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr),
554 
                            data->fan_div[nr]);
555 
        adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr),
556 
                            data->fan_min[nr]);
557 
        mutex_unlock(&data->update_lock);
558 
        return count;
559 
}
560 
 
561 
#define fan_offset(offset)                                              \
562 
static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
563 
{                                                                       \
564 
        return show_fan(dev, buf, offset - 1);                  \
565 
}                                                                       \
566 
static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)   \
567 
{                                                                       \
568 
        return show_fan_min(dev, buf, offset - 1);                      \
569 
}                                                                       \
570 
static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf)   \
571 
{                                                                       \
572 
        return show_fan_div(dev, buf, offset - 1);                      \
573 
}                                                                       \
574 
static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr,               \
575 
        const char *buf, size_t count)                                  \
576 
{                                                                       \
577 
        return set_fan_min(dev, buf, count, offset - 1);                \
578 
}                                                                       \
579 
static ssize_t set_fan_##offset##_div (struct device *dev, struct device_attribute *attr,               \
580 
        const char *buf, size_t count)                                  \
581 
{                                                                       \
582 
        return set_fan_div(dev, buf, count, offset - 1);                \
583 
}                                                                       \
584 
static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset,     \
585 
                   NULL);                                               \
586 
static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,                \
587 
                   show_fan_##offset##_min, set_fan_##offset##_min);    \
588 
static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,                \
589 
                   show_fan_##offset##_div, set_fan_##offset##_div);    \
590 
static DEVICE_ATTR(auto_fan##offset##_min_pwm, S_IRUGO | S_IWUSR,       \
591 
                   show_pwm_##offset, set_pwm_##offset)
592 
 
593 
fan_offset(1);
594 
fan_offset(2);
595 
 
596 
 
597 
/* Temps */
598 
static ssize_t show_temp(struct device *dev, char *buf, int nr)
599 
{
600 
        struct adm1031_data *data = adm1031_update_device(dev);
601 
        int ext;
602 
        ext = nr == 0 ?
603 
            ((data->ext_temp[nr] >> 6) & 0x3) * 2 :
604 
            (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7));
605 
        return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext));
606 
}
607 
static ssize_t show_temp_min(struct device *dev, char *buf, int nr)
608 
{
609 
        struct adm1031_data *data = adm1031_update_device(dev);
610 
        return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr]));
611 
}
612 
static ssize_t show_temp_max(struct device *dev, char *buf, int nr)
613 
{
614 
        struct adm1031_data *data = adm1031_update_device(dev);
615 
        return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr]));
616 
}
617 
static ssize_t show_temp_crit(struct device *dev, char *buf, int nr)
618 
{
619 
        struct adm1031_data *data = adm1031_update_device(dev);
620 
        return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr]));
621 
}
622 
static ssize_t
623 
set_temp_min(struct device *dev, const char *buf, size_t count, int nr)
624 
{
625 
        struct i2c_client *client = to_i2c_client(dev);
626 
        struct adm1031_data *data = i2c_get_clientdata(client);
627 
        int val;
628 
 
629 
        val = simple_strtol(buf, NULL, 10);
630 
        val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
631 
        mutex_lock(&data->update_lock);
632 
        data->temp_min[nr] = TEMP_TO_REG(val);
633 
        adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr),
634 
                            data->temp_min[nr]);
635 
        mutex_unlock(&data->update_lock);
636 
        return count;
637 
}
638 
static ssize_t
639 
set_temp_max(struct device *dev, const char *buf, size_t count, int nr)
640 
{
641 
        struct i2c_client *client = to_i2c_client(dev);
642 
        struct adm1031_data *data = i2c_get_clientdata(client);
643 
        int val;
644 
 
645 
        val = simple_strtol(buf, NULL, 10);
646 
        val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
647 
        mutex_lock(&data->update_lock);
648 
        data->temp_max[nr] = TEMP_TO_REG(val);
649 
        adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr),
650 
                            data->temp_max[nr]);
651 
        mutex_unlock(&data->update_lock);
652 
        return count;
653 
}
654 
static ssize_t
655 
set_temp_crit(struct device *dev, const char *buf, size_t count, int nr)
656 
{
657 
        struct i2c_client *client = to_i2c_client(dev);
658 
        struct adm1031_data *data = i2c_get_clientdata(client);
659 
        int val;
660 
 
661 
        val = simple_strtol(buf, NULL, 10);
662 
        val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
663 
        mutex_lock(&data->update_lock);
664 
        data->temp_crit[nr] = TEMP_TO_REG(val);
665 
        adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr),
666 
                            data->temp_crit[nr]);
667 
        mutex_unlock(&data->update_lock);
668 
        return count;
669 
}
670 
 
671 
#define temp_reg(offset)                                                        \
672 
static ssize_t show_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf)                \
673 
{                                                                               \
674 
        return show_temp(dev, buf, offset - 1);                         \
675 
}                                                                               \
676 
static ssize_t show_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)          \
677 
{                                                                               \
678 
        return show_temp_min(dev, buf, offset - 1);                             \
679 
}                                                                               \
680 
static ssize_t show_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)          \
681 
{                                                                               \
682 
        return show_temp_max(dev, buf, offset - 1);                             \
683 
}                                                                               \
684 
static ssize_t show_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, char *buf) \
685 
{                                                                               \
686 
        return show_temp_crit(dev, buf, offset - 1);                    \
687 
}                                                                               \
688 
static ssize_t set_temp_##offset##_min (struct device *dev, struct device_attribute *attr,                      \
689 
                                        const char *buf, size_t count)          \
690 
{                                                                               \
691 
        return set_temp_min(dev, buf, count, offset - 1);                       \
692 
}                                                                               \
693 
static ssize_t set_temp_##offset##_max (struct device *dev, struct device_attribute *attr,                      \
694 
                                        const char *buf, size_t count)          \
695 
{                                                                               \
696 
        return set_temp_max(dev, buf, count, offset - 1);                       \
697 
}                                                                               \
698 
static ssize_t set_temp_##offset##_crit (struct device *dev, struct device_attribute *attr,                     \
699 
                                         const char *buf, size_t count)         \
700 
{                                                                               \
701 
        return set_temp_crit(dev, buf, count, offset - 1);                      \
702 
}                                                                               \
703 
static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp_##offset,           \
704 
                   NULL);                                                       \
705 
static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR,                       \
706 
                   show_temp_##offset##_min, set_temp_##offset##_min);          \
707 
static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,                       \
708 
                   show_temp_##offset##_max, set_temp_##offset##_max);          \
709 
static DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR,                      \
710 
                   show_temp_##offset##_crit, set_temp_##offset##_crit)
711 
 
712 
temp_reg(1);
713 
temp_reg(2);
714 
temp_reg(3);
715 
 
716 
/* Alarms */
717 
static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
718 
{
719 
        struct adm1031_data *data = adm1031_update_device(dev);
720 
        return sprintf(buf, "%d\n", data->alarm);
721 
}
722 
 
723 
static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
724 
 
725 
 
726 
static int adm1031_attach_adapter(struct i2c_adapter *adapter)
727 
{
728 
        if (!(adapter->class & I2C_CLASS_HWMON))
729 
                return 0;
730 
        return i2c_probe(adapter, &addr_data, adm1031_detect);
731 
}
732 
 
733 
static struct attribute *adm1031_attributes[] = {
734 
        &dev_attr_fan1_input.attr,
735 
        &dev_attr_fan1_div.attr,
736 
        &dev_attr_fan1_min.attr,
737 
        &dev_attr_pwm1.attr,
738 
        &dev_attr_auto_fan1_channel.attr,
739 
        &dev_attr_temp1_input.attr,
740 
        &dev_attr_temp1_min.attr,
741 
        &dev_attr_temp1_max.attr,
742 
        &dev_attr_temp1_crit.attr,
743 
        &dev_attr_temp2_input.attr,
744 
        &dev_attr_temp2_min.attr,
745 
        &dev_attr_temp2_max.attr,
746 
        &dev_attr_temp2_crit.attr,
747 
 
748 
        &dev_attr_auto_temp1_off.attr,
749 
        &dev_attr_auto_temp1_min.attr,
750 
        &dev_attr_auto_temp1_max.attr,
751 
 
752 
        &dev_attr_auto_temp2_off.attr,
753 
        &dev_attr_auto_temp2_min.attr,
754 
        &dev_attr_auto_temp2_max.attr,
755 
 
756 
        &dev_attr_auto_fan1_min_pwm.attr,
757 
 
758 
        &dev_attr_alarms.attr,
759 
 
760 
        NULL
761 
};
762 
 
763 
static const struct attribute_group adm1031_group = {
764 
        .attrs = adm1031_attributes,
765 
};
766 
 
767 
static struct attribute *adm1031_attributes_opt[] = {
768 
        &dev_attr_fan2_input.attr,
769 
        &dev_attr_fan2_div.attr,
770 
        &dev_attr_fan2_min.attr,
771 
        &dev_attr_pwm2.attr,
772 
        &dev_attr_auto_fan2_channel.attr,
773 
        &dev_attr_temp3_input.attr,
774 
        &dev_attr_temp3_min.attr,
775 
        &dev_attr_temp3_max.attr,
776 
        &dev_attr_temp3_crit.attr,
777 
        &dev_attr_auto_temp3_off.attr,
778 
        &dev_attr_auto_temp3_min.attr,
779 
        &dev_attr_auto_temp3_max.attr,
780 
        &dev_attr_auto_fan2_min_pwm.attr,
781 
        NULL
782 
};
783 
 
784 
static const struct attribute_group adm1031_group_opt = {
785 
        .attrs = adm1031_attributes_opt,
786 
};
787 
 
788 
/* This function is called by i2c_probe */
789 
static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind)
790 
{
791 
        struct i2c_client *new_client;
792 
        struct adm1031_data *data;
793 
        int err = 0;
794 
        const char *name = "";
795 
 
796 
        if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
797 
                goto exit;
798 
 
799 
        if (!(data = kzalloc(sizeof(struct adm1031_data), GFP_KERNEL))) {
800 
                err = -ENOMEM;
801 
                goto exit;
802 
        }
803 
 
804 
        new_client = &data->client;
805 
        i2c_set_clientdata(new_client, data);
806 
        new_client->addr = address;
807 
        new_client->adapter = adapter;
808 
        new_client->driver = &adm1031_driver;
809 
        new_client->flags = 0;
810 
 
811 
        if (kind < 0) {
812 
                int id, co;
813 
                id = i2c_smbus_read_byte_data(new_client, 0x3d);
814 
                co = i2c_smbus_read_byte_data(new_client, 0x3e);
815 
 
816 
                if (!((id == 0x31 || id == 0x30) && co == 0x41))
817 
                        goto exit_free;
818 
                kind = (id == 0x30) ? adm1030 : adm1031;
819 
        }
820 
 
821 
        if (kind <= 0)
822 
                kind = adm1031;
823 
 
824 
        /* Given the detected chip type, set the chip name and the
825 
         * auto fan control helper table. */
826 
        if (kind == adm1030) {
827 
                name = "adm1030";
828 
                data->chan_select_table = &auto_channel_select_table_adm1030;
829 
        } else if (kind == adm1031) {
830 
                name = "adm1031";
831 
                data->chan_select_table = &auto_channel_select_table_adm1031;
832 
        }
833 
        data->chip_type = kind;
834 
 
835 
        strlcpy(new_client->name, name, I2C_NAME_SIZE);
836 
        data->valid = 0;
837 
        mutex_init(&data->update_lock);
838 
 
839 
        /* Tell the I2C layer a new client has arrived */
840 
        if ((err = i2c_attach_client(new_client)))
841 
                goto exit_free;
842 
 
843 
        /* Initialize the ADM1031 chip */
844 
        adm1031_init_client(new_client);
845 
 
846 
        /* Register sysfs hooks */
847 
        if ((err = sysfs_create_group(&new_client->dev.kobj, &adm1031_group)))
848 
                goto exit_detach;
849 
 
850 
        if (kind == adm1031) {
851 
                if ((err = sysfs_create_group(&new_client->dev.kobj,
852 
                                                &adm1031_group_opt)))
853 
                        goto exit_remove;
854 
        }
855 
 
856 
        data->hwmon_dev = hwmon_device_register(&new_client->dev);
857 
        if (IS_ERR(data->hwmon_dev)) {
858 
                err = PTR_ERR(data->hwmon_dev);
859 
                goto exit_remove;
860 
        }
861 
 
862 
        return 0;
863 
 
864 
exit_remove:
865 
        sysfs_remove_group(&new_client->dev.kobj, &adm1031_group);
866 
        sysfs_remove_group(&new_client->dev.kobj, &adm1031_group_opt);
867 
exit_detach:
868 
        i2c_detach_client(new_client);
869 
exit_free:
870 
        kfree(data);
871 
exit:
872 
        return err;
873 
}
874 
 
875 
static int adm1031_detach_client(struct i2c_client *client)
876 
{
877 
        struct adm1031_data *data = i2c_get_clientdata(client);
878 
        int ret;
879 
 
880 
        hwmon_device_unregister(data->hwmon_dev);
881 
        sysfs_remove_group(&client->dev.kobj, &adm1031_group);
882 
        sysfs_remove_group(&client->dev.kobj, &adm1031_group_opt);
883 
        if ((ret = i2c_detach_client(client)) != 0) {
884 
                return ret;
885 
        }
886 
        kfree(data);
887 
        return 0;
888 
}
889 
 
890 
static void adm1031_init_client(struct i2c_client *client)
891 
{
892 
        unsigned int read_val;
893 
        unsigned int mask;
894 
        struct adm1031_data *data = i2c_get_clientdata(client);
895 
 
896 
        mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE);
897 
        if (data->chip_type == adm1031) {
898 
                mask |= (ADM1031_CONF2_PWM2_ENABLE |
899 
                        ADM1031_CONF2_TACH2_ENABLE);
900 
        }
901 
        /* Initialize the ADM1031 chip (enables fan speed reading ) */
902 
        read_val = adm1031_read_value(client, ADM1031_REG_CONF2);
903 
        if ((read_val | mask) != read_val) {
904 
            adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask);
905 
        }
906 
 
907 
        read_val = adm1031_read_value(client, ADM1031_REG_CONF1);
908 
        if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) {
909 
            adm1031_write_value(client, ADM1031_REG_CONF1, read_val |
910 
                                ADM1031_CONF1_MONITOR_ENABLE);
911 
        }
912 
 
913 
}
914 
 
915 
static struct adm1031_data *adm1031_update_device(struct device *dev)
916 
{
917 
        struct i2c_client *client = to_i2c_client(dev);
918 
        struct adm1031_data *data = i2c_get_clientdata(client);
919 
        int chan;
920 
 
921 
        mutex_lock(&data->update_lock);
922 
 
923 
        if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
924 
            || !data->valid) {
925 
 
926 
                dev_dbg(&client->dev, "Starting adm1031 update\n");
927 
                for (chan = 0;
928 
                     chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) {
929 
                        u8 oldh, newh;
930 
 
931 
                        oldh =
932 
                            adm1031_read_value(client, ADM1031_REG_TEMP(chan));
933 
                        data->ext_temp[chan] =
934 
                            adm1031_read_value(client, ADM1031_REG_EXT_TEMP);
935 
                        newh =
936 
                            adm1031_read_value(client, ADM1031_REG_TEMP(chan));
937 
                        if (newh != oldh) {
938 
                                data->ext_temp[chan] =
939 
                                    adm1031_read_value(client,
940 
                                                       ADM1031_REG_EXT_TEMP);
941 
#ifdef DEBUG
942 
                                oldh =
943 
                                    adm1031_read_value(client,
944 
                                                       ADM1031_REG_TEMP(chan));
945 
 
946 
                                /* oldh is actually newer */
947 
                                if (newh != oldh)
948 
                                        dev_warn(&client->dev,
949 
                                                 "Remote temperature may be "
950 
                                                 "wrong.\n");
951 
#endif
952 
                        }
953 
                        data->temp[chan] = newh;
954 
 
955 
                        data->temp_min[chan] =
956 
                            adm1031_read_value(client,
957 
                                               ADM1031_REG_TEMP_MIN(chan));
958 
                        data->temp_max[chan] =
959 
                            adm1031_read_value(client,
960 
                                               ADM1031_REG_TEMP_MAX(chan));
961 
                        data->temp_crit[chan] =
962 
                            adm1031_read_value(client,
963 
                                               ADM1031_REG_TEMP_CRIT(chan));
964 
                        data->auto_temp[chan] =
965 
                            adm1031_read_value(client,
966 
                                               ADM1031_REG_AUTO_TEMP(chan));
967 
 
968 
                }
969 
 
970 
                data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1);
971 
                data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2);
972 
 
973 
                data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0))
974 
                             | (adm1031_read_value(client, ADM1031_REG_STATUS(1))
975 
                                << 8);
976 
                if (data->chip_type == adm1030) {
977 
                        data->alarm &= 0xc0ff;
978 
                }
979 
 
980 
                for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) {
981 
                        data->fan_div[chan] =
982 
                            adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan));
983 
                        data->fan_min[chan] =
984 
                            adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan));
985 
                        data->fan[chan] =
986 
                            adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan));
987 
                        data->pwm[chan] =
988 
                            0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >>
989 
                                   (4*chan));
990 
                }
991 
                data->last_updated = jiffies;
992 
                data->valid = 1;
993 
        }
994 
 
995 
        mutex_unlock(&data->update_lock);
996 
 
997 
        return data;
998 
}
999 
 
1000 
static int __init sensors_adm1031_init(void)
1001 
{
1002 
        return i2c_add_driver(&adm1031_driver);
1003 
}
1004 
 
1005 
static void __exit sensors_adm1031_exit(void)
1006 
{
1007 
        i2c_del_driver(&adm1031_driver);
1008 
}
1009 
 
1010 
MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>");
1011 
MODULE_DESCRIPTION("ADM1031/ADM1030 driver");
1012 
MODULE_LICENSE("GPL");
1013 
 
1014 
module_init(sensors_adm1031_init);
1015 
module_exit(sensors_adm1031_exit);

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.