?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
RT-AC66 3.0.0.4.374.130 core
[tomato.git] / release / src-rt-6.x / linux / linux-2.6 / drivers / hwmon / w83791d.c
blob9e5f885368b4e3f8e697be2ef0138f9bc8eb03f0
1 /*
2 w83791d.c - Part of lm_sensors, Linux kernel modules for hardware
3 monitoring
4
5 Copyright (C) 2006 Charles Spirakis <bezaur@gmail.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License as published by
9 the Free Software Foundation; either version 2 of the License, or
10 (at your option) any later version.
11
12 This program is distributed in the hope that it will be useful,
13 but WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 GNU General Public License for more details.
16
17 You should have received a copy of the GNU General Public License
18 along with this program; if not, write to the Free Software
19 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 */
21
22 /*
23 Supports following chips:
24
25 Chip #vin #fanin #pwm #temp wchipid vendid i2c ISA
26 w83791d 10 5 3 3 0x71 0x5ca3 yes no
27
28 The w83791d chip appears to be part way between the 83781d and the
29 83792d. Thus, this file is derived from both the w83792d.c and
30 w83781d.c files.
31
32 The w83791g chip is the same as the w83791d but lead-free.
33 */
34
35 #include <linux/module.h>
36 #include <linux/init.h>
37 #include <linux/slab.h>
38 #include <linux/i2c.h>
39 #include <linux/hwmon.h>
40 #include <linux/hwmon-vid.h>
41 #include <linux/hwmon-sysfs.h>
42 #include <linux/err.h>
43 #include <linux/mutex.h>
44
45 #define NUMBER_OF_VIN 10
46 #define NUMBER_OF_FANIN 5
47 #define NUMBER_OF_TEMPIN 3
48
49 /* Addresses to scan */
50 static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, 0x2f, I2C_CLIENT_END };
51
52 /* Insmod parameters */
53 I2C_CLIENT_INSMOD_1(w83791d);
54 I2C_CLIENT_MODULE_PARM(force_subclients, "List of subclient addresses: "
55 "{bus, clientaddr, subclientaddr1, subclientaddr2}");
56
57 static int reset;
58 module_param(reset, bool, 0);
59 MODULE_PARM_DESC(reset, "Set to one to force a hardware chip reset");
60
61 static int init;
62 module_param(init, bool, 0);
63 MODULE_PARM_DESC(init, "Set to one to force extra software initialization");
64
65 /* The W83791D registers */
66 static const u8 W83791D_REG_IN[NUMBER_OF_VIN] = {
67 0x20, /* VCOREA in DataSheet */
68 0x21, /* VINR0 in DataSheet */
69 0x22, /* +3.3VIN in DataSheet */
70 0x23, /* VDD5V in DataSheet */
71 0x24, /* +12VIN in DataSheet */
72 0x25, /* -12VIN in DataSheet */
73 0x26, /* -5VIN in DataSheet */
74 0xB0, /* 5VSB in DataSheet */
75 0xB1, /* VBAT in DataSheet */
76 0xB2 /* VINR1 in DataSheet */
77 };
78
79 static const u8 W83791D_REG_IN_MAX[NUMBER_OF_VIN] = {
80 0x2B, /* VCOREA High Limit in DataSheet */
81 0x2D, /* VINR0 High Limit in DataSheet */
82 0x2F, /* +3.3VIN High Limit in DataSheet */
83 0x31, /* VDD5V High Limit in DataSheet */
84 0x33, /* +12VIN High Limit in DataSheet */
85 0x35, /* -12VIN High Limit in DataSheet */
86 0x37, /* -5VIN High Limit in DataSheet */
87 0xB4, /* 5VSB High Limit in DataSheet */
88 0xB6, /* VBAT High Limit in DataSheet */
89 0xB8 /* VINR1 High Limit in DataSheet */
90 };
91 static const u8 W83791D_REG_IN_MIN[NUMBER_OF_VIN] = {
92 0x2C, /* VCOREA Low Limit in DataSheet */
93 0x2E, /* VINR0 Low Limit in DataSheet */
94 0x30, /* +3.3VIN Low Limit in DataSheet */
95 0x32, /* VDD5V Low Limit in DataSheet */
96 0x34, /* +12VIN Low Limit in DataSheet */
97 0x36, /* -12VIN Low Limit in DataSheet */
98 0x38, /* -5VIN Low Limit in DataSheet */
99 0xB5, /* 5VSB Low Limit in DataSheet */
100 0xB7, /* VBAT Low Limit in DataSheet */
101 0xB9 /* VINR1 Low Limit in DataSheet */
102 };
103 static const u8 W83791D_REG_FAN[NUMBER_OF_FANIN] = {
104 0x28, /* FAN 1 Count in DataSheet */
105 0x29, /* FAN 2 Count in DataSheet */
106 0x2A, /* FAN 3 Count in DataSheet */
107 0xBA, /* FAN 4 Count in DataSheet */
108 0xBB, /* FAN 5 Count in DataSheet */
109 };
110 static const u8 W83791D_REG_FAN_MIN[NUMBER_OF_FANIN] = {
111 0x3B, /* FAN 1 Count Low Limit in DataSheet */
112 0x3C, /* FAN 2 Count Low Limit in DataSheet */
113 0x3D, /* FAN 3 Count Low Limit in DataSheet */
114 0xBC, /* FAN 4 Count Low Limit in DataSheet */
115 0xBD, /* FAN 5 Count Low Limit in DataSheet */
116 };
117
118 static const u8 W83791D_REG_FAN_CFG[2] = {
119 0x84, /* FAN 1/2 configuration */
120 0x95, /* FAN 3 configuration */
121 };
122
123 static const u8 W83791D_REG_FAN_DIV[3] = {
124 0x47, /* contains FAN1 and FAN2 Divisor */
125 0x4b, /* contains FAN3 Divisor */
126 0x5C, /* contains FAN4 and FAN5 Divisor */
127 };
128
129 #define W83791D_REG_BANK 0x4E
130 #define W83791D_REG_TEMP2_CONFIG 0xC2
131 #define W83791D_REG_TEMP3_CONFIG 0xCA
132
133 static const u8 W83791D_REG_TEMP1[3] = {
134 0x27, /* TEMP 1 in DataSheet */
135 0x39, /* TEMP 1 Over in DataSheet */
136 0x3A, /* TEMP 1 Hyst in DataSheet */
137 };
138
139 static const u8 W83791D_REG_TEMP_ADD[2][6] = {
140 {0xC0, /* TEMP 2 in DataSheet */
141 0xC1, /* TEMP 2(0.5 deg) in DataSheet */
142 0xC5, /* TEMP 2 Over High part in DataSheet */
143 0xC6, /* TEMP 2 Over Low part in DataSheet */
144 0xC3, /* TEMP 2 Thyst High part in DataSheet */
145 0xC4}, /* TEMP 2 Thyst Low part in DataSheet */
146 {0xC8, /* TEMP 3 in DataSheet */
147 0xC9, /* TEMP 3(0.5 deg) in DataSheet */
148 0xCD, /* TEMP 3 Over High part in DataSheet */
149 0xCE, /* TEMP 3 Over Low part in DataSheet */
150 0xCB, /* TEMP 3 Thyst High part in DataSheet */
151 0xCC} /* TEMP 3 Thyst Low part in DataSheet */
152 };
153
154 #define W83791D_REG_BEEP_CONFIG 0x4D
155
156 static const u8 W83791D_REG_BEEP_CTRL[3] = {
157 0x56, /* BEEP Control Register 1 */
158 0x57, /* BEEP Control Register 2 */
159 0xA3, /* BEEP Control Register 3 */
160 };
161
162 #define W83791D_REG_CONFIG 0x40
163 #define W83791D_REG_VID_FANDIV 0x47
164 #define W83791D_REG_DID_VID4 0x49
165 #define W83791D_REG_WCHIPID 0x58
166 #define W83791D_REG_CHIPMAN 0x4F
167 #define W83791D_REG_PIN 0x4B
168 #define W83791D_REG_I2C_SUBADDR 0x4A
169
170 #define W83791D_REG_ALARM1 0xA9 /* realtime status register1 */
171 #define W83791D_REG_ALARM2 0xAA /* realtime status register2 */
172 #define W83791D_REG_ALARM3 0xAB /* realtime status register3 */
173
174 #define W83791D_REG_VBAT 0x5D
175 #define W83791D_REG_I2C_ADDR 0x48
176
177 /* The SMBus locks itself. The Winbond W83791D has a bank select register
178 (index 0x4e), but the driver only accesses registers in bank 0. Since
179 we don't switch banks, we don't need any special code to handle
180 locking access between bank switches */
181 static inline int w83791d_read(struct i2c_client *client, u8 reg)
182 {
183 return i2c_smbus_read_byte_data(client, reg);
184 }
185
186 static inline int w83791d_write(struct i2c_client *client, u8 reg, u8 value)
187 {
188 return i2c_smbus_write_byte_data(client, reg, value);
189 }
190
191 /* The analog voltage inputs have 16mV LSB. Since the sysfs output is
192 in mV as would be measured on the chip input pin, need to just
193 multiply/divide by 16 to translate from/to register values. */
194 #define IN_TO_REG(val) (SENSORS_LIMIT((((val) + 8) / 16), 0, 255))
195 #define IN_FROM_REG(val) ((val) * 16)
196
197 static u8 fan_to_reg(long rpm, int div)
198 {
199 if (rpm == 0)
200 return 255;
201 rpm = SENSORS_LIMIT(rpm, 1, 1000000);
202 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
203 }
204
205 #define FAN_FROM_REG(val,div) ((val) == 0 ? -1 : \
206 ((val) == 255 ? 0 : \
207 1350000 / ((val) * (div))))
208
209 /* for temp1 which is 8-bit resolution, LSB = 1 degree Celsius */
210 #define TEMP1_FROM_REG(val) ((val) * 1000)
211 #define TEMP1_TO_REG(val) ((val) <= -128000 ? -128 : \
212 (val) >= 127000 ? 127 : \
213 (val) < 0 ? ((val) - 500) / 1000 : \
214 ((val) + 500) / 1000)
215
216 /* for temp2 and temp3 which are 9-bit resolution, LSB = 0.5 degree Celsius
217 Assumes the top 8 bits are the integral amount and the bottom 8 bits
218 are the fractional amount. Since we only have 0.5 degree resolution,
219 the bottom 7 bits will always be zero */
220 #define TEMP23_FROM_REG(val) ((val) / 128 * 500)
221 #define TEMP23_TO_REG(val) ((val) <= -128000 ? 0x8000 : \
222 (val) >= 127500 ? 0x7F80 : \
223 (val) < 0 ? ((val) - 250) / 500 * 128 : \
224 ((val) + 250) / 500 * 128)
225
226
227 #define BEEP_MASK_TO_REG(val) ((val) & 0xffffff)
228 #define BEEP_MASK_FROM_REG(val) ((val) & 0xffffff)
229
230 #define DIV_FROM_REG(val) (1 << (val))
231
232 static u8 div_to_reg(int nr, long val)
233 {
234 int i;
235 int max;
236
237 /* first three fan's divisor max out at 8, rest max out at 128 */
238 max = (nr < 3) ? 8 : 128;
239 val = SENSORS_LIMIT(val, 1, max) >> 1;
240 for (i = 0; i < 7; i++) {
241 if (val == 0)
242 break;
243 val >>= 1;
244 }
245 return (u8) i;
246 }
247
248 struct w83791d_data {
249 struct i2c_client client;
250 struct class_device *class_dev;
251 struct mutex update_lock;
252
253 char valid; /* !=0 if following fields are valid */
254 unsigned long last_updated; /* In jiffies */
255
256 /* array of 2 pointers to subclients */
257 struct i2c_client *lm75[2];
258
259 /* volts */
260 u8 in[NUMBER_OF_VIN]; /* Register value */
261 u8 in_max[NUMBER_OF_VIN]; /* Register value */
262 u8 in_min[NUMBER_OF_VIN]; /* Register value */
263
264 /* fans */
265 u8 fan[NUMBER_OF_FANIN]; /* Register value */
266 u8 fan_min[NUMBER_OF_FANIN]; /* Register value */
267 u8 fan_div[NUMBER_OF_FANIN]; /* Register encoding, shifted right */
268
269 /* Temperature sensors */
270
271 s8 temp1[3]; /* current, over, thyst */
272 s16 temp_add[2][3]; /* fixed point value. Top 8 bits are the
273 integral part, bottom 8 bits are the
274 fractional part. We only use the top
275 9 bits as the resolution is only
276 to the 0.5 degree C...
277 two sensors with three values
278 (cur, over, hyst) */
279
280 /* Misc */
281 u32 alarms; /* realtime status register encoding,combined */
282 u8 beep_enable; /* Global beep enable */
283 u32 beep_mask; /* Mask off specific beeps */
284 u8 vid; /* Register encoding, combined */
285 u8 vrm; /* hwmon-vid */
286 };
287
288 static int w83791d_attach_adapter(struct i2c_adapter *adapter);
289 static int w83791d_detect(struct i2c_adapter *adapter, int address, int kind);
290 static int w83791d_detach_client(struct i2c_client *client);
291
292 static int w83791d_read(struct i2c_client *client, u8 register);
293 static int w83791d_write(struct i2c_client *client, u8 register, u8 value);
294 static struct w83791d_data *w83791d_update_device(struct device *dev);
295
296 #ifdef DEBUG
297 static void w83791d_print_debug(struct w83791d_data *data, struct device *dev);
298 #endif
299
300 static void w83791d_init_client(struct i2c_client *client);
301
302 static struct i2c_driver w83791d_driver = {
303 .driver = {
304 .name = "w83791d",
305 },
306 .attach_adapter = w83791d_attach_adapter,
307 .detach_client = w83791d_detach_client,
308 };
309
310 /* following are the sysfs callback functions */
311 #define show_in_reg(reg) \
312 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
313 char *buf) \
314 { \
315 struct sensor_device_attribute *sensor_attr = \
316 to_sensor_dev_attr(attr); \
317 struct w83791d_data *data = w83791d_update_device(dev); \
318 int nr = sensor_attr->index; \
319 return sprintf(buf,"%d\n", IN_FROM_REG(data->reg[nr])); \
320 }
321
322 show_in_reg(in);
323 show_in_reg(in_min);
324 show_in_reg(in_max);
325
326 #define store_in_reg(REG, reg) \
327 static ssize_t store_in_##reg(struct device *dev, \
328 struct device_attribute *attr, \
329 const char *buf, size_t count) \
330 { \
331 struct sensor_device_attribute *sensor_attr = \
332 to_sensor_dev_attr(attr); \
333 struct i2c_client *client = to_i2c_client(dev); \
334 struct w83791d_data *data = i2c_get_clientdata(client); \
335 unsigned long val = simple_strtoul(buf, NULL, 10); \
336 int nr = sensor_attr->index; \
337 \
338 mutex_lock(&data->update_lock); \
339 data->in_##reg[nr] = IN_TO_REG(val); \
340 w83791d_write(client, W83791D_REG_IN_##REG[nr], data->in_##reg[nr]); \
341 mutex_unlock(&data->update_lock); \
342 \
343 return count; \
344 }
345 store_in_reg(MIN, min);
346 store_in_reg(MAX, max);
347
348 static struct sensor_device_attribute sda_in_input[] = {
349 SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
350 SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
351 SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
352 SENSOR_ATTR(in3_input, S_IRUGO, show_in, NULL, 3),
353 SENSOR_ATTR(in4_input, S_IRUGO, show_in, NULL, 4),
354 SENSOR_ATTR(in5_input, S_IRUGO, show_in, NULL, 5),
355 SENSOR_ATTR(in6_input, S_IRUGO, show_in, NULL, 6),
356 SENSOR_ATTR(in7_input, S_IRUGO, show_in, NULL, 7),
357 SENSOR_ATTR(in8_input, S_IRUGO, show_in, NULL, 8),
358 SENSOR_ATTR(in9_input, S_IRUGO, show_in, NULL, 9),
359 };
360
361 static struct sensor_device_attribute sda_in_min[] = {
362 SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0),
363 SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1),
364 SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2),
365 SENSOR_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 3),
366 SENSOR_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 4),
367 SENSOR_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 5),
368 SENSOR_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 6),
369 SENSOR_ATTR(in7_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 7),
370 SENSOR_ATTR(in8_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 8),
371 SENSOR_ATTR(in9_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 9),
372 };
373
374 static struct sensor_device_attribute sda_in_max[] = {
375 SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0),
376 SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1),
377 SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2),
378 SENSOR_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 3),
379 SENSOR_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 4),
380 SENSOR_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 5),
381 SENSOR_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 6),
382 SENSOR_ATTR(in7_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 7),
383 SENSOR_ATTR(in8_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 8),
384 SENSOR_ATTR(in9_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 9),
385 };
386
387 #define show_fan_reg(reg) \
388 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
389 char *buf) \
390 { \
391 struct sensor_device_attribute *sensor_attr = \
392 to_sensor_dev_attr(attr); \
393 struct w83791d_data *data = w83791d_update_device(dev); \
394 int nr = sensor_attr->index; \
395 return sprintf(buf,"%d\n", \
396 FAN_FROM_REG(data->reg[nr], DIV_FROM_REG(data->fan_div[nr]))); \
397 }
398
399 show_fan_reg(fan);
400 show_fan_reg(fan_min);
401
402 static ssize_t store_fan_min(struct device *dev, struct device_attribute *attr,
403 const char *buf, size_t count)
404 {
405 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
406 struct i2c_client *client = to_i2c_client(dev);
407 struct w83791d_data *data = i2c_get_clientdata(client);
408 unsigned long val = simple_strtoul(buf, NULL, 10);
409 int nr = sensor_attr->index;
410
411 mutex_lock(&data->update_lock);
412 data->fan_min[nr] = fan_to_reg(val, DIV_FROM_REG(data->fan_div[nr]));
413 w83791d_write(client, W83791D_REG_FAN_MIN[nr], data->fan_min[nr]);
414 mutex_unlock(&data->update_lock);
415
416 return count;
417 }
418
419 static ssize_t show_fan_div(struct device *dev, struct device_attribute *attr,
420 char *buf)
421 {
422 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
423 int nr = sensor_attr->index;
424 struct w83791d_data *data = w83791d_update_device(dev);
425 return sprintf(buf, "%u\n", DIV_FROM_REG(data->fan_div[nr]));
426 }
427
428 /* Note: we save and restore the fan minimum here, because its value is
429 determined in part by the fan divisor. This follows the principle of
430 least suprise; the user doesn't expect the fan minimum to change just
431 because the divisor changed. */
432 static ssize_t store_fan_div(struct device *dev, struct device_attribute *attr,
433 const char *buf, size_t count)
434 {
435 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
436 struct i2c_client *client = to_i2c_client(dev);
437 struct w83791d_data *data = i2c_get_clientdata(client);
438 int nr = sensor_attr->index;
439 unsigned long min;
440 u8 tmp_fan_div;
441 u8 fan_div_reg;
442 int indx = 0;
443 u8 keep_mask = 0;
444 u8 new_shift = 0;
445
446 /* Save fan_min */
447 min = FAN_FROM_REG(data->fan_min[nr], DIV_FROM_REG(data->fan_div[nr]));
448
449 mutex_lock(&data->update_lock);
450 data->fan_div[nr] = div_to_reg(nr, simple_strtoul(buf, NULL, 10));
451
452 switch (nr) {
453 case 0:
454 indx = 0;
455 keep_mask = 0xcf;
456 new_shift = 4;
457 break;
458 case 1:
459 indx = 0;
460 keep_mask = 0x3f;
461 new_shift = 6;
462 break;
463 case 2:
464 indx = 1;
465 keep_mask = 0x3f;
466 new_shift = 6;
467 break;
468 case 3:
469 indx = 2;
470 keep_mask = 0xf8;
471 new_shift = 0;
472 break;
473 case 4:
474 indx = 2;
475 keep_mask = 0x8f;
476 new_shift = 4;
477 break;
478 #ifdef DEBUG
479 default:
480 dev_warn(dev, "store_fan_div: Unexpected nr seen: %d\n", nr);
481 count = -EINVAL;
482 goto err_exit;
483 #endif
484 }
485
486 fan_div_reg = w83791d_read(client, W83791D_REG_FAN_DIV[indx])
487 & keep_mask;
488 tmp_fan_div = (data->fan_div[nr] << new_shift) & ~keep_mask;
489
490 w83791d_write(client, W83791D_REG_FAN_DIV[indx],
491 fan_div_reg | tmp_fan_div);
492
493 /* Restore fan_min */
494 data->fan_min[nr] = fan_to_reg(min, DIV_FROM_REG(data->fan_div[nr]));
495 w83791d_write(client, W83791D_REG_FAN_MIN[nr], data->fan_min[nr]);
496
497 #ifdef DEBUG
498 err_exit:
499 #endif
500 mutex_unlock(&data->update_lock);
501
502 return count;
503 }
504
505 static struct sensor_device_attribute sda_fan_input[] = {
506 SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
507 SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
508 SENSOR_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2),
509 SENSOR_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3),
510 SENSOR_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4),
511 };
512
513 static struct sensor_device_attribute sda_fan_min[] = {
514 SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO,
515 show_fan_min, store_fan_min, 0),
516 SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO,
517 show_fan_min, store_fan_min, 1),
518 SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO,
519 show_fan_min, store_fan_min, 2),
520 SENSOR_ATTR(fan4_min, S_IWUSR | S_IRUGO,
521 show_fan_min, store_fan_min, 3),
522 SENSOR_ATTR(fan5_min, S_IWUSR | S_IRUGO,
523 show_fan_min, store_fan_min, 4),
524 };
525
526 static struct sensor_device_attribute sda_fan_div[] = {
527 SENSOR_ATTR(fan1_div, S_IWUSR | S_IRUGO,
528 show_fan_div, store_fan_div, 0),
529 SENSOR_ATTR(fan2_div, S_IWUSR | S_IRUGO,
530 show_fan_div, store_fan_div, 1),
531 SENSOR_ATTR(fan3_div, S_IWUSR | S_IRUGO,
532 show_fan_div, store_fan_div, 2),
533 SENSOR_ATTR(fan4_div, S_IWUSR | S_IRUGO,
534 show_fan_div, store_fan_div, 3),
535 SENSOR_ATTR(fan5_div, S_IWUSR | S_IRUGO,
536 show_fan_div, store_fan_div, 4),
537 };
538
539 /* read/write the temperature1, includes measured value and limits */
540 static ssize_t show_temp1(struct device *dev, struct device_attribute *devattr,
541 char *buf)
542 {
543 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
544 struct w83791d_data *data = w83791d_update_device(dev);
545 return sprintf(buf, "%d\n", TEMP1_FROM_REG(data->temp1[attr->index]));
546 }
547
548 static ssize_t store_temp1(struct device *dev, struct device_attribute *devattr,
549 const char *buf, size_t count)
550 {
551 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
552 struct i2c_client *client = to_i2c_client(dev);
553 struct w83791d_data *data = i2c_get_clientdata(client);
554 long val = simple_strtol(buf, NULL, 10);
555 int nr = attr->index;
556
557 mutex_lock(&data->update_lock);
558 data->temp1[nr] = TEMP1_TO_REG(val);
559 w83791d_write(client, W83791D_REG_TEMP1[nr], data->temp1[nr]);
560 mutex_unlock(&data->update_lock);
561 return count;
562 }
563
564 /* read/write temperature2-3, includes measured value and limits */
565 static ssize_t show_temp23(struct device *dev, struct device_attribute *devattr,
566 char *buf)
567 {
568 struct sensor_device_attribute_2 *attr = to_sensor_dev_attr_2(devattr);
569 struct w83791d_data *data = w83791d_update_device(dev);
570 int nr = attr->nr;
571 int index = attr->index;
572 return sprintf(buf, "%d\n", TEMP23_FROM_REG(data->temp_add[nr][index]));
573 }
574
575 static ssize_t store_temp23(struct device *dev,
576 struct device_attribute *devattr,
577 const char *buf, size_t count)
578 {
579 struct sensor_device_attribute_2 *attr = to_sensor_dev_attr_2(devattr);
580 struct i2c_client *client = to_i2c_client(dev);
581 struct w83791d_data *data = i2c_get_clientdata(client);
582 long val = simple_strtol(buf, NULL, 10);
583 int nr = attr->nr;
584 int index = attr->index;
585
586 mutex_lock(&data->update_lock);
587 data->temp_add[nr][index] = TEMP23_TO_REG(val);
588 w83791d_write(client, W83791D_REG_TEMP_ADD[nr][index * 2],
589 data->temp_add[nr][index] >> 8);
590 w83791d_write(client, W83791D_REG_TEMP_ADD[nr][index * 2 + 1],
591 data->temp_add[nr][index] & 0x80);
592 mutex_unlock(&data->update_lock);
593
594 return count;
595 }
596
597 static struct sensor_device_attribute_2 sda_temp_input[] = {
598 SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp1, NULL, 0, 0),
599 SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp23, NULL, 0, 0),
600 SENSOR_ATTR_2(temp3_input, S_IRUGO, show_temp23, NULL, 1, 0),
601 };
602
603 static struct sensor_device_attribute_2 sda_temp_max[] = {
604 SENSOR_ATTR_2(temp1_max, S_IRUGO | S_IWUSR,
605 show_temp1, store_temp1, 0, 1),
606 SENSOR_ATTR_2(temp2_max, S_IRUGO | S_IWUSR,
607 show_temp23, store_temp23, 0, 1),
608 SENSOR_ATTR_2(temp3_max, S_IRUGO | S_IWUSR,
609 show_temp23, store_temp23, 1, 1),
610 };
611
612 static struct sensor_device_attribute_2 sda_temp_max_hyst[] = {
613 SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO | S_IWUSR,
614 show_temp1, store_temp1, 0, 2),
615 SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO | S_IWUSR,
616 show_temp23, store_temp23, 0, 2),
617 SENSOR_ATTR_2(temp3_max_hyst, S_IRUGO | S_IWUSR,
618 show_temp23, store_temp23, 1, 2),
619 };
620
621
622 /* get reatime status of all sensors items: voltage, temp, fan */
623 static ssize_t show_alarms_reg(struct device *dev,
624 struct device_attribute *attr, char *buf)
625 {
626 struct w83791d_data *data = w83791d_update_device(dev);
627 return sprintf(buf, "%u\n", data->alarms);
628 }
629
630 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL);
631
632 /* Beep control */
633
634 #define GLOBAL_BEEP_ENABLE_SHIFT 15
635 #define GLOBAL_BEEP_ENABLE_MASK (1 << GLOBAL_BEEP_ENABLE_SHIFT)
636
637 static ssize_t show_beep_enable(struct device *dev,
638 struct device_attribute *attr, char *buf)
639 {
640 struct w83791d_data *data = w83791d_update_device(dev);
641 return sprintf(buf, "%d\n", data->beep_enable);
642 }
643
644 static ssize_t show_beep_mask(struct device *dev,
645 struct device_attribute *attr, char *buf)
646 {
647 struct w83791d_data *data = w83791d_update_device(dev);
648 return sprintf(buf, "%d\n", BEEP_MASK_FROM_REG(data->beep_mask));
649 }
650
651
652 static ssize_t store_beep_mask(struct device *dev,
653 struct device_attribute *attr,
654 const char *buf, size_t count)
655 {
656 struct i2c_client *client = to_i2c_client(dev);
657 struct w83791d_data *data = i2c_get_clientdata(client);
658 long val = simple_strtol(buf, NULL, 10);
659 int i;
660
661 mutex_lock(&data->update_lock);
662
663 /* The beep_enable state overrides any enabling request from
664 the masks */
665 data->beep_mask = BEEP_MASK_TO_REG(val) & ~GLOBAL_BEEP_ENABLE_MASK;
666 data->beep_mask |= (data->beep_enable << GLOBAL_BEEP_ENABLE_SHIFT);
667
668 val = data->beep_mask;
669
670 for (i = 0; i < 3; i++) {
671 w83791d_write(client, W83791D_REG_BEEP_CTRL[i], (val & 0xff));
672 val >>= 8;
673 }
674
675 mutex_unlock(&data->update_lock);
676
677 return count;
678 }
679
680 static ssize_t store_beep_enable(struct device *dev,
681 struct device_attribute *attr,
682 const char *buf, size_t count)
683 {
684 struct i2c_client *client = to_i2c_client(dev);
685 struct w83791d_data *data = i2c_get_clientdata(client);
686 long val = simple_strtol(buf, NULL, 10);
687
688 mutex_lock(&data->update_lock);
689
690 data->beep_enable = val ? 1 : 0;
691
692 /* Keep the full mask value in sync with the current enable */
693 data->beep_mask &= ~GLOBAL_BEEP_ENABLE_MASK;
694 data->beep_mask |= (data->beep_enable << GLOBAL_BEEP_ENABLE_SHIFT);
695
696 /* The global control is in the second beep control register
697 so only need to update that register */
698 val = (data->beep_mask >> 8) & 0xff;
699
700 w83791d_write(client, W83791D_REG_BEEP_CTRL[1], val);
701
702 mutex_unlock(&data->update_lock);
703
704 return count;
705 }
706
707 static struct sensor_device_attribute sda_beep_ctrl[] = {
708 SENSOR_ATTR(beep_enable, S_IRUGO | S_IWUSR,
709 show_beep_enable, store_beep_enable, 0),
710 SENSOR_ATTR(beep_mask, S_IRUGO | S_IWUSR,
711 show_beep_mask, store_beep_mask, 1)
712 };
713
714 /* cpu voltage regulation information */
715 static ssize_t show_vid_reg(struct device *dev,
716 struct device_attribute *attr, char *buf)
717 {
718 struct w83791d_data *data = w83791d_update_device(dev);
719 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
720 }
721
722 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL);
723
724 static ssize_t show_vrm_reg(struct device *dev,
725 struct device_attribute *attr, char *buf)
726 {
727 struct w83791d_data *data = w83791d_update_device(dev);
728 return sprintf(buf, "%d\n", data->vrm);
729 }
730
731 static ssize_t store_vrm_reg(struct device *dev,
732 struct device_attribute *attr,
733 const char *buf, size_t count)
734 {
735 struct i2c_client *client = to_i2c_client(dev);
736 struct w83791d_data *data = i2c_get_clientdata(client);
737 unsigned long val = simple_strtoul(buf, NULL, 10);
738
739 /* No lock needed as vrm is internal to the driver
740 (not read from a chip register) and so is not
741 updated in w83791d_update_device() */
742 data->vrm = val;
743
744 return count;
745 }
746
747 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg);
748
749 #define IN_UNIT_ATTRS(X) \
750 &sda_in_input[X].dev_attr.attr, \
751 &sda_in_min[X].dev_attr.attr, \
752 &sda_in_max[X].dev_attr.attr
753
754 #define FAN_UNIT_ATTRS(X) \
755 &sda_fan_input[X].dev_attr.attr, \
756 &sda_fan_min[X].dev_attr.attr, \
757 &sda_fan_div[X].dev_attr.attr
758
759 #define TEMP_UNIT_ATTRS(X) \
760 &sda_temp_input[X].dev_attr.attr, \
761 &sda_temp_max[X].dev_attr.attr, \
762 &sda_temp_max_hyst[X].dev_attr.attr
763
764 static struct attribute *w83791d_attributes[] = {
765 IN_UNIT_ATTRS(0),
766 IN_UNIT_ATTRS(1),
767 IN_UNIT_ATTRS(2),
768 IN_UNIT_ATTRS(3),
769 IN_UNIT_ATTRS(4),
770 IN_UNIT_ATTRS(5),
771 IN_UNIT_ATTRS(6),
772 IN_UNIT_ATTRS(7),
773 IN_UNIT_ATTRS(8),
774 IN_UNIT_ATTRS(9),
775 FAN_UNIT_ATTRS(0),
776 FAN_UNIT_ATTRS(1),
777 FAN_UNIT_ATTRS(2),
778 FAN_UNIT_ATTRS(3),
779 FAN_UNIT_ATTRS(4),
780 TEMP_UNIT_ATTRS(0),
781 TEMP_UNIT_ATTRS(1),
782 TEMP_UNIT_ATTRS(2),
783 &dev_attr_alarms.attr,
784 &sda_beep_ctrl[0].dev_attr.attr,
785 &sda_beep_ctrl[1].dev_attr.attr,
786 &dev_attr_cpu0_vid.attr,
787 &dev_attr_vrm.attr,
788 NULL
789 };
790
791 static const struct attribute_group w83791d_group = {
792 .attrs = w83791d_attributes,
793 };
794
795 /* This function is called when:
796 * w83791d_driver is inserted (when this module is loaded), for each
797 available adapter
798 * when a new adapter is inserted (and w83791d_driver is still present) */
799 static int w83791d_attach_adapter(struct i2c_adapter *adapter)
800 {
801 if (!(adapter->class & I2C_CLASS_HWMON))
802 return 0;
803 return i2c_probe(adapter, &addr_data, w83791d_detect);
804 }
805
806
807 static int w83791d_create_subclient(struct i2c_adapter *adapter,
808 struct i2c_client *client, int addr,
809 struct i2c_client **sub_cli)
810 {
811 int err;
812 struct i2c_client *sub_client;
813
814 (*sub_cli) = sub_client =
815 kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
816 if (!(sub_client)) {
817 return -ENOMEM;
818 }
819 sub_client->addr = 0x48 + addr;
820 i2c_set_clientdata(sub_client, NULL);
821 sub_client->adapter = adapter;
822 sub_client->driver = &w83791d_driver;
823 strlcpy(sub_client->name, "w83791d subclient", I2C_NAME_SIZE);
824 if ((err = i2c_attach_client(sub_client))) {
825 dev_err(&client->dev, "subclient registration "
826 "at address 0x%x failed\n", sub_client->addr);
827 kfree(sub_client);
828 return err;
829 }
830 return 0;
831 }
832
833
834 static int w83791d_detect_subclients(struct i2c_adapter *adapter, int address,
835 int kind, struct i2c_client *client)
836 {
837 struct w83791d_data *data = i2c_get_clientdata(client);
838 int i, id, err;
839 u8 val;
840
841 id = i2c_adapter_id(adapter);
842 if (force_subclients[0] == id && force_subclients[1] == address) {
843 for (i = 2; i <= 3; i++) {
844 if (force_subclients[i] < 0x48 ||
845 force_subclients[i] > 0x4f) {
846 dev_err(&client->dev,
847 "invalid subclient "
848 "address %d; must be 0x48-0x4f\n",
849 force_subclients[i]);
850 err = -ENODEV;
851 goto error_sc_0;
852 }
853 }
854 w83791d_write(client, W83791D_REG_I2C_SUBADDR,
855 (force_subclients[2] & 0x07) |
856 ((force_subclients[3] & 0x07) << 4));
857 }
858
859 val = w83791d_read(client, W83791D_REG_I2C_SUBADDR);
860 if (!(val & 0x08)) {
861 err = w83791d_create_subclient(adapter, client,
862 val & 0x7, &data->lm75[0]);
863 if (err < 0)
864 goto error_sc_0;
865 }
866 if (!(val & 0x80)) {
867 if ((data->lm75[0] != NULL) &&
868 ((val & 0x7) == ((val >> 4) & 0x7))) {
869 dev_err(&client->dev,
870 "duplicate addresses 0x%x, "
871 "use force_subclient\n",
872 data->lm75[0]->addr);
873 err = -ENODEV;
874 goto error_sc_1;
875 }
876 err = w83791d_create_subclient(adapter, client,
877 (val >> 4) & 0x7, &data->lm75[1]);
878 if (err < 0)
879 goto error_sc_1;
880 }
881
882 return 0;
883
884 /* Undo inits in case of errors */
885
886 error_sc_1:
887 if (data->lm75[0] != NULL) {
888 i2c_detach_client(data->lm75[0]);
889 kfree(data->lm75[0]);
890 }
891 error_sc_0:
892 return err;
893 }
894
895
896 static int w83791d_detect(struct i2c_adapter *adapter, int address, int kind)
897 {
898 struct i2c_client *client;
899 struct device *dev;
900 struct w83791d_data *data;
901 int i, val1, val2;
902 int err = 0;
903 const char *client_name = "";
904
905 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
906 goto error0;
907 }
908
909 /* OK. For now, we presume we have a valid client. We now create the
910 client structure, even though we cannot fill it completely yet.
911 But it allows us to access w83791d_{read,write}_value. */
912 if (!(data = kzalloc(sizeof(struct w83791d_data), GFP_KERNEL))) {
913 err = -ENOMEM;
914 goto error0;
915 }
916
917 client = &data->client;
918 dev = &client->dev;
919 i2c_set_clientdata(client, data);
920 client->addr = address;
921 client->adapter = adapter;
922 client->driver = &w83791d_driver;
923 mutex_init(&data->update_lock);
924
925 /* Now, we do the remaining detection. */
926
927 /* The w83791d may be stuck in some other bank than bank 0. This may
928 make reading other information impossible. Specify a force=...
929 parameter, and the Winbond will be reset to the right bank. */
930 if (kind < 0) {
931 if (w83791d_read(client, W83791D_REG_CONFIG) & 0x80) {
932 dev_dbg(dev, "Detection failed at step 1\n");
933 goto error1;
934 }
935 val1 = w83791d_read(client, W83791D_REG_BANK);
936 val2 = w83791d_read(client, W83791D_REG_CHIPMAN);
937 /* Check for Winbond ID if in bank 0 */
938 if (!(val1 & 0x07)) {
939 /* yes it is Bank0 */
940 if (((!(val1 & 0x80)) && (val2 != 0xa3)) ||
941 ((val1 & 0x80) && (val2 != 0x5c))) {
942 dev_dbg(dev, "Detection failed at step 2\n");
943 goto error1;
944 }
945 }
946 /* If Winbond chip, address of chip and W83791D_REG_I2C_ADDR
947 should match */
948 if (w83791d_read(client, W83791D_REG_I2C_ADDR) != address) {
949 dev_dbg(dev, "Detection failed at step 3\n");
950 goto error1;
951 }
952 }
953
954 /* We either have a force parameter or we have reason to
955 believe it is a Winbond chip. Either way, we want bank 0 and
956 Vendor ID high byte */
957 val1 = w83791d_read(client, W83791D_REG_BANK) & 0x78;
958 w83791d_write(client, W83791D_REG_BANK, val1 | 0x80);
959
960 /* Verify it is a Winbond w83791d */
961 if (kind <= 0) {
962 /* get vendor ID */
963 val2 = w83791d_read(client, W83791D_REG_CHIPMAN);
964 if (val2 != 0x5c) { /* the vendor is NOT Winbond */
965 dev_dbg(dev, "Detection failed at step 4\n");
966 goto error1;
967 }
968 val1 = w83791d_read(client, W83791D_REG_WCHIPID);
969 if (val1 == 0x71) {
970 kind = w83791d;
971 } else {
972 if (kind == 0)
973 dev_warn(dev,
974 "w83791d: Ignoring 'force' parameter "
975 "for unknown chip at adapter %d, "
976 "address 0x%02x\n",
977 i2c_adapter_id(adapter), address);
978 goto error1;
979 }
980 }
981
982 if (kind == w83791d) {
983 client_name = "w83791d";
984 } else {
985 dev_err(dev, "w83791d: Internal error: unknown kind (%d)?!?",
986 kind);
987 goto error1;
988 }
989
990 #ifdef DEBUG
991 val1 = w83791d_read(client, W83791D_REG_DID_VID4);
992 dev_dbg(dev, "Device ID version: %d.%d (0x%02x)\n",
993 (val1 >> 5) & 0x07, (val1 >> 1) & 0x0f, val1);
994 #endif
995
996 /* Fill in the remaining client fields and put into the global list */
997 strlcpy(client->name, client_name, I2C_NAME_SIZE);
998
999 /* Tell the I2C layer a new client has arrived */
1000 if ((err = i2c_attach_client(client)))
1001 goto error1;
1002
1003 if ((err = w83791d_detect_subclients(adapter, address, kind, client)))
1004 goto error2;
1005
1006 /* Initialize the chip */
1007 w83791d_init_client(client);
1008
1009 /* If the fan_div is changed, make sure there is a rational
1010 fan_min in place */
1011 for (i = 0; i < NUMBER_OF_FANIN; i++) {
1012 data->fan_min[i] = w83791d_read(client, W83791D_REG_FAN_MIN[i]);
1013 }
1014
1015 /* Register sysfs hooks */
1016 if ((err = sysfs_create_group(&client->dev.kobj, &w83791d_group)))
1017 goto error3;
1018
1019 /* Everything is ready, now register the working device */
1020 data->class_dev = hwmon_device_register(dev);
1021 if (IS_ERR(data->class_dev)) {
1022 err = PTR_ERR(data->class_dev);
1023 goto error4;
1024 }
1025
1026 return 0;
1027
1028 error4:
1029 sysfs_remove_group(&client->dev.kobj, &w83791d_group);
1030 error3:
1031 if (data->lm75[0] != NULL) {
1032 i2c_detach_client(data->lm75[0]);
1033 kfree(data->lm75[0]);
1034 }
1035 if (data->lm75[1] != NULL) {
1036 i2c_detach_client(data->lm75[1]);
1037 kfree(data->lm75[1]);
1038 }
1039 error2:
1040 i2c_detach_client(client);
1041 error1:
1042 kfree(data);
1043 error0:
1044 return err;
1045 }
1046
1047 static int w83791d_detach_client(struct i2c_client *client)
1048 {
1049 struct w83791d_data *data = i2c_get_clientdata(client);
1050 int err;
1051
1052 /* main client */
1053 if (data) {
1054 hwmon_device_unregister(data->class_dev);
1055 sysfs_remove_group(&client->dev.kobj, &w83791d_group);
1056 }
1057
1058 if ((err = i2c_detach_client(client)))
1059 return err;
1060
1061 /* main client */
1062 if (data)
1063 kfree(data);
1064 /* subclient */
1065 else
1066 kfree(client);
1067
1068 return 0;
1069 }
1070
1071 static void w83791d_init_client(struct i2c_client *client)
1072 {
1073 struct w83791d_data *data = i2c_get_clientdata(client);
1074 u8 tmp;
1075 u8 old_beep;
1076
1077 /* The difference between reset and init is that reset
1078 does a hard reset of the chip via index 0x40, bit 7,
1079 but init simply forces certain registers to have "sane"
1080 values. The hope is that the BIOS has done the right
1081 thing (which is why the default is reset=0, init=0),
1082 but if not, reset is the hard hammer and init
1083 is the soft mallet both of which are trying to whack
1084 things into place...
1085 NOTE: The data sheet makes a distinction between
1086 "power on defaults" and "reset by MR". As far as I can tell,
1087 the hard reset puts everything into a power-on state so I'm
1088 not sure what "reset by MR" means or how it can happen.
1089 */
1090 if (reset || init) {
1091 /* keep some BIOS settings when we... */
1092 old_beep = w83791d_read(client, W83791D_REG_BEEP_CONFIG);
1093
1094 if (reset) {
1095 /* ... reset the chip and ... */
1096 w83791d_write(client, W83791D_REG_CONFIG, 0x80);
1097 }
1098
1099 /* ... disable power-on abnormal beep */
1100 w83791d_write(client, W83791D_REG_BEEP_CONFIG, old_beep | 0x80);
1101
1102 /* disable the global beep (not done by hard reset) */
1103 tmp = w83791d_read(client, W83791D_REG_BEEP_CTRL[1]);
1104 w83791d_write(client, W83791D_REG_BEEP_CTRL[1], tmp & 0xef);
1105
1106 if (init) {
1107 /* Make sure monitoring is turned on for add-ons */
1108 tmp = w83791d_read(client, W83791D_REG_TEMP2_CONFIG);
1109 if (tmp & 1) {
1110 w83791d_write(client, W83791D_REG_TEMP2_CONFIG,
1111 tmp & 0xfe);
1112 }
1113
1114 tmp = w83791d_read(client, W83791D_REG_TEMP3_CONFIG);
1115 if (tmp & 1) {
1116 w83791d_write(client, W83791D_REG_TEMP3_CONFIG,
1117 tmp & 0xfe);
1118 }
1119
1120 /* Start monitoring */
1121 tmp = w83791d_read(client, W83791D_REG_CONFIG) & 0xf7;
1122 w83791d_write(client, W83791D_REG_CONFIG, tmp | 0x01);
1123 }
1124 }
1125
1126 data->vrm = vid_which_vrm();
1127 }
1128
1129 static struct w83791d_data *w83791d_update_device(struct device *dev)
1130 {
1131 struct i2c_client *client = to_i2c_client(dev);
1132 struct w83791d_data *data = i2c_get_clientdata(client);
1133 int i, j;
1134 u8 reg_array_tmp[3];
1135
1136 mutex_lock(&data->update_lock);
1137
1138 if (time_after(jiffies, data->last_updated + (HZ * 3))
1139 || !data->valid) {
1140 dev_dbg(dev, "Starting w83791d device update\n");
1141
1142 /* Update the voltages measured value and limits */
1143 for (i = 0; i < NUMBER_OF_VIN; i++) {
1144 data->in[i] = w83791d_read(client,
1145 W83791D_REG_IN[i]);
1146 data->in_max[i] = w83791d_read(client,
1147 W83791D_REG_IN_MAX[i]);
1148 data->in_min[i] = w83791d_read(client,
1149 W83791D_REG_IN_MIN[i]);
1150 }
1151
1152 /* Update the fan counts and limits */
1153 for (i = 0; i < NUMBER_OF_FANIN; i++) {
1154 /* Update the Fan measured value and limits */
1155 data->fan[i] = w83791d_read(client,
1156 W83791D_REG_FAN[i]);
1157 data->fan_min[i] = w83791d_read(client,
1158 W83791D_REG_FAN_MIN[i]);
1159 }
1160
1161 /* Update the fan divisor */
1162 for (i = 0; i < 3; i++) {
1163 reg_array_tmp[i] = w83791d_read(client,
1164 W83791D_REG_FAN_DIV[i]);
1165 }
1166 data->fan_div[0] = (reg_array_tmp[0] >> 4) & 0x03;
1167 data->fan_div[1] = (reg_array_tmp[0] >> 6) & 0x03;
1168 data->fan_div[2] = (reg_array_tmp[1] >> 6) & 0x03;
1169 data->fan_div[3] = reg_array_tmp[2] & 0x07;
1170 data->fan_div[4] = (reg_array_tmp[2] >> 4) & 0x07;
1171
1172 /* Update the first temperature sensor */
1173 for (i = 0; i < 3; i++) {
1174 data->temp1[i] = w83791d_read(client,
1175 W83791D_REG_TEMP1[i]);
1176 }
1177
1178 /* Update the rest of the temperature sensors */
1179 for (i = 0; i < 2; i++) {
1180 for (j = 0; j < 3; j++) {
1181 data->temp_add[i][j] =
1182 (w83791d_read(client,
1183 W83791D_REG_TEMP_ADD[i][j * 2]) << 8) |
1184 w83791d_read(client,
1185 W83791D_REG_TEMP_ADD[i][j * 2 + 1]);
1186 }
1187 }
1188
1189 /* Update the realtime status */
1190 data->alarms =
1191 w83791d_read(client, W83791D_REG_ALARM1) +
1192 (w83791d_read(client, W83791D_REG_ALARM2) << 8) +
1193 (w83791d_read(client, W83791D_REG_ALARM3) << 16);
1194
1195 /* Update the beep configuration information */
1196 data->beep_mask =
1197 w83791d_read(client, W83791D_REG_BEEP_CTRL[0]) +
1198 (w83791d_read(client, W83791D_REG_BEEP_CTRL[1]) << 8) +
1199 (w83791d_read(client, W83791D_REG_BEEP_CTRL[2]) << 16);
1200
1201 /* Extract global beep enable flag */
1202 data->beep_enable =
1203 (data->beep_mask >> GLOBAL_BEEP_ENABLE_SHIFT) & 0x01;
1204
1205 /* Update the cpu voltage information */
1206 i = w83791d_read(client, W83791D_REG_VID_FANDIV);
1207 data->vid = i & 0x0f;
1208 data->vid |= (w83791d_read(client, W83791D_REG_DID_VID4) & 0x01)
1209 << 4;
1210
1211 data->last_updated = jiffies;
1212 data->valid = 1;
1213 }
1214
1215 mutex_unlock(&data->update_lock);
1216
1217 #ifdef DEBUG
1218 w83791d_print_debug(data, dev);
1219 #endif
1220
1221 return data;
1222 }
1223
1224 #ifdef DEBUG
1225 static void w83791d_print_debug(struct w83791d_data *data, struct device *dev)
1226 {
1227 int i = 0, j = 0;
1228
1229 dev_dbg(dev, "======Start of w83791d debug values======\n");
1230 dev_dbg(dev, "%d set of Voltages: ===>\n", NUMBER_OF_VIN);
1231 for (i = 0; i < NUMBER_OF_VIN; i++) {
1232 dev_dbg(dev, "vin[%d] is: 0x%02x\n", i, data->in[i]);
1233 dev_dbg(dev, "vin[%d] min is: 0x%02x\n", i, data->in_min[i]);
1234 dev_dbg(dev, "vin[%d] max is: 0x%02x\n", i, data->in_max[i]);
1235 }
1236 dev_dbg(dev, "%d set of Fan Counts/Divisors: ===>\n", NUMBER_OF_FANIN);
1237 for (i = 0; i < NUMBER_OF_FANIN; i++) {
1238 dev_dbg(dev, "fan[%d] is: 0x%02x\n", i, data->fan[i]);
1239 dev_dbg(dev, "fan[%d] min is: 0x%02x\n", i, data->fan_min[i]);
1240 dev_dbg(dev, "fan_div[%d] is: 0x%02x\n", i, data->fan_div[i]);
1241 }
1242
1243 /* temperature math is signed, but only print out the
1244 bits that matter */
1245 dev_dbg(dev, "%d set of Temperatures: ===>\n", NUMBER_OF_TEMPIN);
1246 for (i = 0; i < 3; i++) {
1247 dev_dbg(dev, "temp1[%d] is: 0x%02x\n", i, (u8) data->temp1[i]);
1248 }
1249 for (i = 0; i < 2; i++) {
1250 for (j = 0; j < 3; j++) {
1251 dev_dbg(dev, "temp_add[%d][%d] is: 0x%04x\n", i, j,
1252 (u16) data->temp_add[i][j]);
1253 }
1254 }
1255
1256 dev_dbg(dev, "Misc Information: ===>\n");
1257 dev_dbg(dev, "alarm is: 0x%08x\n", data->alarms);
1258 dev_dbg(dev, "beep_mask is: 0x%08x\n", data->beep_mask);
1259 dev_dbg(dev, "beep_enable is: %d\n", data->beep_enable);
1260 dev_dbg(dev, "vid is: 0x%02x\n", data->vid);
1261 dev_dbg(dev, "vrm is: 0x%02x\n", data->vrm);
1262 dev_dbg(dev, "=======End of w83791d debug values========\n");
1263 dev_dbg(dev, "\n");
1264 }
1265 #endif
1266
1267 static int __init sensors_w83791d_init(void)
1268 {
1269 return i2c_add_driver(&w83791d_driver);
1270 }
1271
1272 static void __exit sensors_w83791d_exit(void)
1273 {
1274 i2c_del_driver(&w83791d_driver);
1275 }
1276
1277 MODULE_AUTHOR("Charles Spirakis <bezaur@gmail.com>");
1278 MODULE_DESCRIPTION("W83791D driver");
1279 MODULE_LICENSE("GPL");
1280
1281 module_init(sensors_w83791d_init);
1282 module_exit(sensors_w83791d_exit);
Tomato firmware and modifications.