?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
hwmon: (w83795) Clean up probe function
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / hwmon / w83795.c
blobb797b9ce2907648e5ddbded083c20052b96da9df
1 /*
2 * w83795.c - Linux kernel driver for hardware monitoring
3 * Copyright (C) 2008 Nuvoton Technology Corp.
4 * Wei Song
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation - version 2.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
18 * 02110-1301 USA.
19 *
20 * Supports following chips:
21 *
22 * Chip #vin #fanin #pwm #temp #dts wchipid vendid i2c ISA
23 * w83795g 21 14 8 6 8 0x79 0x5ca3 yes no
24 * w83795adg 18 14 2 6 8 0x79 0x5ca3 yes no
25 */
26
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/init.h>
30 #include <linux/slab.h>
31 #include <linux/i2c.h>
32 #include <linux/hwmon.h>
33 #include <linux/hwmon-sysfs.h>
34 #include <linux/err.h>
35 #include <linux/mutex.h>
36 #include <linux/delay.h>
37
38 /* Addresses to scan */
39 static const unsigned short normal_i2c[] = {
40 0x2c, 0x2d, 0x2e, 0x2f, I2C_CLIENT_END
41 };
42
43
44 static int reset;
45 module_param(reset, bool, 0);
46 MODULE_PARM_DESC(reset, "Set to 1 to reset chip, not recommended");
47
48
49 #define W83795_REG_BANKSEL 0x00
50 #define W83795_REG_VENDORID 0xfd
51 #define W83795_REG_CHIPID 0xfe
52 #define W83795_REG_DEVICEID 0xfb
53 #define W83795_REG_DEVICEID_A 0xff
54
55 #define W83795_REG_I2C_ADDR 0xfc
56 #define W83795_REG_CONFIG 0x01
57 #define W83795_REG_CONFIG_CONFIG48 0x04
58 #define W83795_REG_CONFIG_START 0x01
59
60 /* Multi-Function Pin Ctrl Registers */
61 #define W83795_REG_VOLT_CTRL1 0x02
62 #define W83795_REG_VOLT_CTRL2 0x03
63 #define W83795_REG_TEMP_CTRL1 0x04
64 #define W83795_REG_TEMP_CTRL2 0x05
65 #define W83795_REG_FANIN_CTRL1 0x06
66 #define W83795_REG_FANIN_CTRL2 0x07
67 #define W83795_REG_VMIGB_CTRL 0x08
68
69 #define TEMP_CTRL_DISABLE 0
70 #define TEMP_CTRL_TD 1
71 #define TEMP_CTRL_VSEN 2
72 #define TEMP_CTRL_TR 3
73 #define TEMP_CTRL_SHIFT 4
74 #define TEMP_CTRL_HASIN_SHIFT 5
75 /* temp mode may effect VSEN17-12 (in20-15) */
76 static const u16 W83795_REG_TEMP_CTRL[][6] = {
77 /* Disable, TD, VSEN, TR, register shift value, has_in shift num */
78 {0x00, 0x01, 0x02, 0x03, 0, 17}, /* TR1 */
79 {0x00, 0x04, 0x08, 0x0C, 2, 18}, /* TR2 */
80 {0x00, 0x10, 0x20, 0x30, 4, 19}, /* TR3 */
81 {0x00, 0x40, 0x80, 0xC0, 6, 20}, /* TR4 */
82 {0x00, 0x00, 0x02, 0x03, 0, 15}, /* TR5 */
83 {0x00, 0x00, 0x08, 0x0C, 2, 16}, /* TR6 */
84 };
85
86 #define TEMP_READ 0
87 #define TEMP_CRIT 1
88 #define TEMP_CRIT_HYST 2
89 #define TEMP_WARN 3
90 #define TEMP_WARN_HYST 4
91 /* only crit and crit_hyst affect real-time alarm status
92 * current crit crit_hyst warn warn_hyst */
93 static const u16 W83795_REG_TEMP[][5] = {
94 {0x21, 0x96, 0x97, 0x98, 0x99}, /* TD1/TR1 */
95 {0x22, 0x9a, 0x9b, 0x9c, 0x9d}, /* TD2/TR2 */
96 {0x23, 0x9e, 0x9f, 0xa0, 0xa1}, /* TD3/TR3 */
97 {0x24, 0xa2, 0xa3, 0xa4, 0xa5}, /* TD4/TR4 */
98 {0x1f, 0xa6, 0xa7, 0xa8, 0xa9}, /* TR5 */
99 {0x20, 0xaa, 0xab, 0xac, 0xad}, /* TR6 */
100 };
101
102 #define IN_READ 0
103 #define IN_MAX 1
104 #define IN_LOW 2
105 static const u16 W83795_REG_IN[][3] = {
106 /* Current, HL, LL */
107 {0x10, 0x70, 0x71}, /* VSEN1 */
108 {0x11, 0x72, 0x73}, /* VSEN2 */
109 {0x12, 0x74, 0x75}, /* VSEN3 */
110 {0x13, 0x76, 0x77}, /* VSEN4 */
111 {0x14, 0x78, 0x79}, /* VSEN5 */
112 {0x15, 0x7a, 0x7b}, /* VSEN6 */
113 {0x16, 0x7c, 0x7d}, /* VSEN7 */
114 {0x17, 0x7e, 0x7f}, /* VSEN8 */
115 {0x18, 0x80, 0x81}, /* VSEN9 */
116 {0x19, 0x82, 0x83}, /* VSEN10 */
117 {0x1A, 0x84, 0x85}, /* VSEN11 */
118 {0x1B, 0x86, 0x87}, /* VTT */
119 {0x1C, 0x88, 0x89}, /* 3VDD */
120 {0x1D, 0x8a, 0x8b}, /* 3VSB */
121 {0x1E, 0x8c, 0x8d}, /* VBAT */
122 {0x1F, 0xa6, 0xa7}, /* VSEN12 */
123 {0x20, 0xaa, 0xab}, /* VSEN13 */
124 {0x21, 0x96, 0x97}, /* VSEN14 */
125 {0x22, 0x9a, 0x9b}, /* VSEN15 */
126 {0x23, 0x9e, 0x9f}, /* VSEN16 */
127 {0x24, 0xa2, 0xa3}, /* VSEN17 */
128 };
129 #define W83795_REG_VRLSB 0x3C
130 #define VRLSB_SHIFT 6
131
132 static const u8 W83795_REG_IN_HL_LSB[] = {
133 0x8e, /* VSEN1-4 */
134 0x90, /* VSEN5-8 */
135 0x92, /* VSEN9-11 */
136 0x94, /* VTT, 3VDD, 3VSB, 3VBAT */
137 0xa8, /* VSEN12 */
138 0xac, /* VSEN13 */
139 0x98, /* VSEN14 */
140 0x9c, /* VSEN15 */
141 0xa0, /* VSEN16 */
142 0xa4, /* VSEN17 */
143 };
144
145 #define IN_LSB_REG(index, type) \
146 (((type) == 1) ? W83795_REG_IN_HL_LSB[(index)] \
147 : (W83795_REG_IN_HL_LSB[(index)] + 1))
148
149 #define IN_LSB_REG_NUM 10
150
151 #define IN_LSB_SHIFT 0
152 #define IN_LSB_IDX 1
153 static const u8 IN_LSB_SHIFT_IDX[][2] = {
154 /* High/Low LSB shift, LSB No. */
155 {0x00, 0x00}, /* VSEN1 */
156 {0x02, 0x00}, /* VSEN2 */
157 {0x04, 0x00}, /* VSEN3 */
158 {0x06, 0x00}, /* VSEN4 */
159 {0x00, 0x01}, /* VSEN5 */
160 {0x02, 0x01}, /* VSEN6 */
161 {0x04, 0x01}, /* VSEN7 */
162 {0x06, 0x01}, /* VSEN8 */
163 {0x00, 0x02}, /* VSEN9 */
164 {0x02, 0x02}, /* VSEN10 */
165 {0x04, 0x02}, /* VSEN11 */
166 {0x00, 0x03}, /* VTT */
167 {0x02, 0x03}, /* 3VDD */
168 {0x04, 0x03}, /* 3VSB */
169 {0x06, 0x03}, /* VBAT */
170 {0x06, 0x04}, /* VSEN12 */
171 {0x06, 0x05}, /* VSEN13 */
172 {0x06, 0x06}, /* VSEN14 */
173 {0x06, 0x07}, /* VSEN15 */
174 {0x06, 0x08}, /* VSEN16 */
175 {0x06, 0x09}, /* VSEN17 */
176 };
177
178
179 /* 3VDD, 3VSB, VBAT * 0.006 */
180 #define REST_VLT_BEGIN 12 /* the 13th volt to 15th */
181 #define REST_VLT_END 14 /* the 13th volt to 15th */
182
183 #define W83795_REG_FAN(index) (0x2E + (index))
184 #define W83795_REG_FAN_MIN_HL(index) (0xB6 + (index))
185 #define W83795_REG_FAN_MIN_LSB(index) (0xC4 + (index) / 2)
186 #define W83795_REG_FAN_MIN_LSB_SHIFT(index) \
187 (((index) % 1) ? 4 : 0)
188
189 #define W83795_REG_VID_CTRL 0x6A
190
191 #define ALARM_BEEP_REG_NUM 6
192 #define W83795_REG_ALARM(index) (0x41 + (index))
193 #define W83795_REG_BEEP(index) (0x50 + (index))
194
195 #define W83795_REG_CLR_CHASSIS 0x4D
196
197
198 #define W83795_REG_TEMP_NUM 6
199 #define W83795_REG_FCMS1 0x201
200 #define W83795_REG_FCMS2 0x208
201 #define W83795_REG_TFMR(index) (0x202 + (index))
202 #define W83795_REG_FOMC 0x20F
203 #define W83795_REG_FOPFP(index) (0x218 + (index))
204
205 #define W83795_REG_TSS(index) (0x209 + (index))
206
207 #define PWM_OUTPUT 0
208 #define PWM_START 1
209 #define PWM_NONSTOP 2
210 #define PWM_STOP_TIME 3
211 #define PWM_DIV 4
212 #define W83795_REG_PWM(index, nr) \
213 (((nr) == 0 ? 0x210 : \
214 (nr) == 1 ? 0x220 : \
215 (nr) == 2 ? 0x228 : \
216 (nr) == 3 ? 0x230 : 0x218) + (index))
217
218 #define W83795_REG_FOPFP_DIV(index) \
219 (((index) < 8) ? ((index) + 1) : \
220 ((index) == 8) ? 12 : \
221 (16 << ((index) - 9)))
222
223 #define W83795_REG_FTSH(index) (0x240 + (index) * 2)
224 #define W83795_REG_FTSL(index) (0x241 + (index) * 2)
225 #define W83795_REG_TFTS 0x250
226
227 #define TEMP_PWM_TTTI 0
228 #define TEMP_PWM_CTFS 1
229 #define TEMP_PWM_HCT 2
230 #define TEMP_PWM_HOT 3
231 #define W83795_REG_TTTI(index) (0x260 + (index))
232 #define W83795_REG_CTFS(index) (0x268 + (index))
233 #define W83795_REG_HT(index) (0x270 + (index))
234
235 #define SF4_TEMP 0
236 #define SF4_PWM 1
237 #define W83795_REG_SF4_TEMP(temp_num, index) \
238 (0x280 + 0x10 * (temp_num) + (index))
239 #define W83795_REG_SF4_PWM(temp_num, index) \
240 (0x288 + 0x10 * (temp_num) + (index))
241
242 #define W83795_REG_DTSC 0x301
243 #define W83795_REG_DTSE 0x302
244 #define W83795_REG_DTS(index) (0x26 + (index))
245
246 #define DTS_CRIT 0
247 #define DTS_CRIT_HYST 1
248 #define DTS_WARN 2
249 #define DTS_WARN_HYST 3
250 #define W83795_REG_DTS_EXT(index) (0xB2 + (index))
251
252 #define SETUP_PWM_DEFAULT 0
253 #define SETUP_PWM_UPTIME 1
254 #define SETUP_PWM_DOWNTIME 2
255 #define W83795_REG_SETUP_PWM(index) (0x20C + (index))
256
257 static inline u16 in_from_reg(u8 index, u16 val)
258 {
259 if ((index >= REST_VLT_BEGIN) && (index <= REST_VLT_END))
260 return val * 6;
261 else
262 return val * 2;
263 }
264
265 static inline u16 in_to_reg(u8 index, u16 val)
266 {
267 if ((index >= REST_VLT_BEGIN) && (index <= REST_VLT_END))
268 return val / 6;
269 else
270 return val / 2;
271 }
272
273 static inline unsigned long fan_from_reg(u16 val)
274 {
275 if ((val >= 0xff0) || (val == 0))
276 return 0;
277 return 1350000UL / val;
278 }
279
280 static inline u16 fan_to_reg(long rpm)
281 {
282 if (rpm <= 0)
283 return 0x0fff;
284 return SENSORS_LIMIT((1350000 + (rpm >> 1)) / rpm, 1, 0xffe);
285 }
286
287 static inline unsigned long time_from_reg(u8 reg)
288 {
289 return reg * 100;
290 }
291
292 static inline u8 time_to_reg(unsigned long val)
293 {
294 return SENSORS_LIMIT((val + 50) / 100, 0, 0xff);
295 }
296
297 static inline long temp_from_reg(s8 reg)
298 {
299 return reg * 1000;
300 }
301
302 static inline s8 temp_to_reg(long val, s8 min, s8 max)
303 {
304 return SENSORS_LIMIT((val < 0 ? -val : val) / 1000, min, max);
305 }
306
307
308 enum chip_types {w83795g, w83795adg};
309
310 struct w83795_data {
311 struct device *hwmon_dev;
312 struct mutex update_lock;
313 unsigned long last_updated; /* In jiffies */
314 enum chip_types chip_type;
315
316 u8 bank;
317
318 u32 has_in; /* Enable monitor VIN or not */
319 u16 in[21][3]; /* Register value, read/high/low */
320 u8 in_lsb[10][3]; /* LSB Register value, high/low */
321 u8 has_gain; /* has gain: in17-20 * 8 */
322
323 u16 has_fan; /* Enable fan14-1 or not */
324 u16 fan[14]; /* Register value combine */
325 u16 fan_min[14]; /* Register value combine */
326
327 u8 has_temp; /* Enable monitor temp6-1 or not */
328 u8 temp[6][5]; /* current, crit, crit_hyst, warn, warn_hyst */
329 u8 temp_read_vrlsb[6];
330 u8 temp_mode; /* bit 0: TR mode, bit 1: TD mode */
331 u8 temp_src[3]; /* Register value */
332
333 u8 enable_dts; /* Enable PECI and SB-TSI,
334 * bit 0: =1 enable, =0 disable,
335 * bit 1: =1 AMD SB-TSI, =0 Intel PECI */
336 u8 has_dts; /* Enable monitor DTS temp */
337 u8 dts[8]; /* Register value */
338 u8 dts_read_vrlsb[8]; /* Register value */
339 u8 dts_ext[4]; /* Register value */
340
341 u8 has_pwm; /* 795g supports 8 pwm, 795adg only supports 2,
342 * no config register, only affected by chip
343 * type */
344 u8 pwm[8][5]; /* Register value, output, start, non stop, stop
345 * time, div */
346 u8 pwm_fcms[2]; /* Register value */
347 u8 pwm_tfmr[6]; /* Register value */
348 u8 pwm_fomc; /* Register value */
349
350 u16 target_speed[8]; /* Register value, target speed for speed
351 * cruise */
352 u8 tol_speed; /* tolerance of target speed */
353 u8 pwm_temp[6][4]; /* TTTI, CTFS, HCT, HOT */
354 u8 sf4_reg[6][2][7]; /* 6 temp, temp/dcpwm, 7 registers */
355
356 u8 setup_pwm[3]; /* Register value */
357
358 u8 alarms[6]; /* Register value */
359 u8 beeps[6]; /* Register value */
360 u8 beep_enable;
361
362 char valid;
363 };
364
365 /*
366 * Hardware access
367 * We assume that nobdody can change the bank outside the driver.
368 */
369
370 /* Must be called with data->update_lock held, except during initialization */
371 static int w83795_set_bank(struct i2c_client *client, u8 bank)
372 {
373 struct w83795_data *data = i2c_get_clientdata(client);
374 int err;
375
376 /* If the same bank is already set, nothing to do */
377 if ((data->bank & 0x07) == bank)
378 return 0;
379
380 /* Change to new bank, preserve all other bits */
381 bank |= data->bank & ~0x07;
382 err = i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL, bank);
383 if (err < 0) {
384 dev_err(&client->dev,
385 "Failed to set bank to %d, err %d\n",
386 (int)bank, err);
387 return err;
388 }
389 data->bank = bank;
390
391 return 0;
392 }
393
394 /* Must be called with data->update_lock held, except during initialization */
395 static u8 w83795_read(struct i2c_client *client, u16 reg)
396 {
397 int err;
398
399 err = w83795_set_bank(client, reg >> 8);
400 if (err < 0)
401 return 0x00; /* Arbitrary */
402
403 err = i2c_smbus_read_byte_data(client, reg & 0xff);
404 if (err < 0) {
405 dev_err(&client->dev,
406 "Failed to read from register 0x%03x, err %d\n",
407 (int)reg, err);
408 return 0x00; /* Arbitrary */
409 }
410 return err;
411 }
412
413 /* Must be called with data->update_lock held, except during initialization */
414 static int w83795_write(struct i2c_client *client, u16 reg, u8 value)
415 {
416 int err;
417
418 err = w83795_set_bank(client, reg >> 8);
419 if (err < 0)
420 return err;
421
422 err = i2c_smbus_write_byte_data(client, reg & 0xff, value);
423 if (err < 0)
424 dev_err(&client->dev,
425 "Failed to write to register 0x%03x, err %d\n",
426 (int)reg, err);
427 return err;
428 }
429
430 static struct w83795_data *w83795_update_device(struct device *dev)
431 {
432 struct i2c_client *client = to_i2c_client(dev);
433 struct w83795_data *data = i2c_get_clientdata(client);
434 u16 tmp;
435 int i;
436
437 mutex_lock(&data->update_lock);
438
439 if (!(time_after(jiffies, data->last_updated + HZ * 2)
440 || !data->valid))
441 goto END;
442
443 /* Update the voltages value */
444 for (i = 0; i < ARRAY_SIZE(data->in); i++) {
445 if (!(data->has_in & (1 << i)))
446 continue;
447 tmp = w83795_read(client, W83795_REG_IN[i][IN_READ]) << 2;
448 tmp |= (w83795_read(client, W83795_REG_VRLSB)
449 >> VRLSB_SHIFT) & 0x03;
450 data->in[i][IN_READ] = tmp;
451 }
452
453 /* Update fan */
454 for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
455 if (!(data->has_fan & (1 << i)))
456 continue;
457 data->fan[i] = w83795_read(client, W83795_REG_FAN(i)) << 4;
458 data->fan[i] |=
459 (w83795_read(client, W83795_REG_VRLSB >> 4)) & 0x0F;
460 }
461
462 /* Update temperature */
463 for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
464 /* even stop monitor, register still keep value, just read out
465 * it */
466 if (!(data->has_temp & (1 << i))) {
467 data->temp[i][TEMP_READ] = 0;
468 data->temp_read_vrlsb[i] = 0;
469 continue;
470 }
471 data->temp[i][TEMP_READ] =
472 w83795_read(client, W83795_REG_TEMP[i][TEMP_READ]);
473 data->temp_read_vrlsb[i] =
474 w83795_read(client, W83795_REG_VRLSB);
475 }
476
477 /* Update dts temperature */
478 if (data->enable_dts != 0) {
479 for (i = 0; i < ARRAY_SIZE(data->dts); i++) {
480 if (!(data->has_dts & (1 << i)))
481 continue;
482 data->dts[i] =
483 w83795_read(client, W83795_REG_DTS(i));
484 data->dts_read_vrlsb[i] =
485 w83795_read(client, W83795_REG_VRLSB);
486 }
487 }
488
489 /* Update pwm output */
490 for (i = 0; i < data->has_pwm; i++) {
491 data->pwm[i][PWM_OUTPUT] =
492 w83795_read(client, W83795_REG_PWM(i, PWM_OUTPUT));
493 }
494
495 /* update alarm */
496 for (i = 0; i < ALARM_BEEP_REG_NUM; i++)
497 data->alarms[i] = w83795_read(client, W83795_REG_ALARM(i));
498
499 data->last_updated = jiffies;
500 data->valid = 1;
501
502 END:
503 mutex_unlock(&data->update_lock);
504 return data;
505 }
506
507 /*
508 * Sysfs attributes
509 */
510
511 #define ALARM_STATUS 0
512 #define BEEP_ENABLE 1
513 static ssize_t
514 show_alarm_beep(struct device *dev, struct device_attribute *attr, char *buf)
515 {
516 struct w83795_data *data = w83795_update_device(dev);
517 struct sensor_device_attribute_2 *sensor_attr =
518 to_sensor_dev_attr_2(attr);
519 int nr = sensor_attr->nr;
520 int index = sensor_attr->index >> 3;
521 int bit = sensor_attr->index & 0x07;
522 u8 val;
523
524 if (ALARM_STATUS == nr) {
525 val = (data->alarms[index] >> (bit)) & 1;
526 } else { /* BEEP_ENABLE */
527 val = (data->beeps[index] >> (bit)) & 1;
528 }
529
530 return sprintf(buf, "%u\n", val);
531 }
532
533 static ssize_t
534 store_beep(struct device *dev, struct device_attribute *attr,
535 const char *buf, size_t count)
536 {
537 struct i2c_client *client = to_i2c_client(dev);
538 struct w83795_data *data = i2c_get_clientdata(client);
539 struct sensor_device_attribute_2 *sensor_attr =
540 to_sensor_dev_attr_2(attr);
541 int index = sensor_attr->index >> 3;
542 int shift = sensor_attr->index & 0x07;
543 u8 beep_bit = 1 << shift;
544 unsigned long val;
545
546 if (strict_strtoul(buf, 10, &val) < 0)
547 return -EINVAL;
548 if (val != 0 && val != 1)
549 return -EINVAL;
550
551 mutex_lock(&data->update_lock);
552 data->beeps[index] = w83795_read(client, W83795_REG_BEEP(index));
553 data->beeps[index] &= ~beep_bit;
554 data->beeps[index] |= val << shift;
555 w83795_write(client, W83795_REG_BEEP(index), data->beeps[index]);
556 mutex_unlock(&data->update_lock);
557
558 return count;
559 }
560
561 static ssize_t
562 show_beep_enable(struct device *dev, struct device_attribute *attr, char *buf)
563 {
564 struct i2c_client *client = to_i2c_client(dev);
565 struct w83795_data *data = i2c_get_clientdata(client);
566 return sprintf(buf, "%u\n", data->beep_enable);
567 }
568
569 static ssize_t
570 store_beep_enable(struct device *dev, struct device_attribute *attr,
571 const char *buf, size_t count)
572 {
573 struct i2c_client *client = to_i2c_client(dev);
574 struct w83795_data *data = i2c_get_clientdata(client);
575 unsigned long val;
576 u8 tmp;
577
578 if (strict_strtoul(buf, 10, &val) < 0)
579 return -EINVAL;
580 if (val != 0 && val != 1)
581 return -EINVAL;
582
583 mutex_lock(&data->update_lock);
584 data->beep_enable = val;
585 tmp = w83795_read(client, W83795_REG_BEEP(5));
586 tmp &= 0x7f;
587 tmp |= val << 7;
588 w83795_write(client, W83795_REG_BEEP(5), tmp);
589 mutex_unlock(&data->update_lock);
590
591 return count;
592 }
593
594 /* Write any value to clear chassis alarm */
595 static ssize_t
596 store_chassis_clear(struct device *dev,
597 struct device_attribute *attr, const char *buf,
598 size_t count)
599 {
600 struct i2c_client *client = to_i2c_client(dev);
601 struct w83795_data *data = i2c_get_clientdata(client);
602 u8 val;
603
604 mutex_lock(&data->update_lock);
605 val = w83795_read(client, W83795_REG_CLR_CHASSIS);
606 val |= 0x80;
607 w83795_write(client, W83795_REG_CLR_CHASSIS, val);
608 mutex_unlock(&data->update_lock);
609 return count;
610 }
611
612 #define FAN_INPUT 0
613 #define FAN_MIN 1
614 static ssize_t
615 show_fan(struct device *dev, struct device_attribute *attr, char *buf)
616 {
617 struct sensor_device_attribute_2 *sensor_attr =
618 to_sensor_dev_attr_2(attr);
619 int nr = sensor_attr->nr;
620 int index = sensor_attr->index;
621 struct w83795_data *data = w83795_update_device(dev);
622 u16 val;
623
624 if (FAN_INPUT == nr)
625 val = data->fan[index] & 0x0fff;
626 else
627 val = data->fan_min[index] & 0x0fff;
628
629 return sprintf(buf, "%lu\n", fan_from_reg(val));
630 }
631
632 static ssize_t
633 store_fan_min(struct device *dev, struct device_attribute *attr,
634 const char *buf, size_t count)
635 {
636 struct sensor_device_attribute_2 *sensor_attr =
637 to_sensor_dev_attr_2(attr);
638 int index = sensor_attr->index;
639 struct i2c_client *client = to_i2c_client(dev);
640 struct w83795_data *data = i2c_get_clientdata(client);
641 unsigned long val;
642
643 if (strict_strtoul(buf, 10, &val))
644 return -EINVAL;
645 val = fan_to_reg(val);
646
647 mutex_lock(&data->update_lock);
648 data->fan_min[index] = val;
649 w83795_write(client, W83795_REG_FAN_MIN_HL(index), (val >> 4) & 0xff);
650 val &= 0x0f;
651 if (index % 1) {
652 val <<= 4;
653 val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
654 & 0x0f;
655 } else {
656 val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
657 & 0xf0;
658 }
659 w83795_write(client, W83795_REG_FAN_MIN_LSB(index), val & 0xff);
660 mutex_unlock(&data->update_lock);
661
662 return count;
663 }
664
665 static ssize_t
666 show_pwm(struct device *dev, struct device_attribute *attr, char *buf)
667 {
668 struct w83795_data *data = w83795_update_device(dev);
669 struct sensor_device_attribute_2 *sensor_attr =
670 to_sensor_dev_attr_2(attr);
671 int nr = sensor_attr->nr;
672 int index = sensor_attr->index;
673 u16 val;
674
675 switch (nr) {
676 case PWM_STOP_TIME:
677 val = time_from_reg(data->pwm[index][nr]);
678 break;
679 case PWM_DIV:
680 val = W83795_REG_FOPFP_DIV(data->pwm[index][nr] & 0x0f);
681 break;
682 default:
683 val = data->pwm[index][nr];
684 break;
685 }
686
687 return sprintf(buf, "%u\n", val);
688 }
689
690 static ssize_t
691 store_pwm(struct device *dev, struct device_attribute *attr,
692 const char *buf, size_t count)
693 {
694 struct i2c_client *client = to_i2c_client(dev);
695 struct w83795_data *data = i2c_get_clientdata(client);
696 struct sensor_device_attribute_2 *sensor_attr =
697 to_sensor_dev_attr_2(attr);
698 int nr = sensor_attr->nr;
699 int index = sensor_attr->index;
700 unsigned long val;
701 int i;
702
703 if (strict_strtoul(buf, 10, &val) < 0)
704 return -EINVAL;
705
706 mutex_lock(&data->update_lock);
707 switch (nr) {
708 case PWM_STOP_TIME:
709 val = time_to_reg(val);
710 break;
711 case PWM_DIV:
712 for (i = 0; i < 16; i++) {
713 if (W83795_REG_FOPFP_DIV(i) == val) {
714 val = i;
715 break;
716 }
717 }
718 if (i >= 16)
719 goto err_end;
720 val |= w83795_read(client, W83795_REG_PWM(index, nr)) & 0x80;
721 break;
722 default:
723 val = SENSORS_LIMIT(val, 0, 0xff);
724 break;
725 }
726 w83795_write(client, W83795_REG_PWM(index, nr), val);
727 data->pwm[index][nr] = val & 0xff;
728 mutex_unlock(&data->update_lock);
729 return count;
730 err_end:
731 mutex_unlock(&data->update_lock);
732 return -EINVAL;
733 }
734
735 static ssize_t
736 show_pwm_enable(struct device *dev, struct device_attribute *attr, char *buf)
737 {
738 struct sensor_device_attribute_2 *sensor_attr =
739 to_sensor_dev_attr_2(attr);
740 struct i2c_client *client = to_i2c_client(dev);
741 struct w83795_data *data = i2c_get_clientdata(client);
742 int index = sensor_attr->index;
743 u8 tmp;
744
745 if (1 == (data->pwm_fcms[0] & (1 << index))) {
746 tmp = 2;
747 goto out;
748 }
749 for (tmp = 0; tmp < 6; tmp++) {
750 if (data->pwm_tfmr[tmp] & (1 << index)) {
751 tmp = 3;
752 goto out;
753 }
754 }
755 if (data->pwm_fomc & (1 << index))
756 tmp = 0;
757 else
758 tmp = 1;
759
760 out:
761 return sprintf(buf, "%u\n", tmp);
762 }
763
764 static ssize_t
765 store_pwm_enable(struct device *dev, struct device_attribute *attr,
766 const char *buf, size_t count)
767 {
768 struct i2c_client *client = to_i2c_client(dev);
769 struct w83795_data *data = i2c_get_clientdata(client);
770 struct sensor_device_attribute_2 *sensor_attr =
771 to_sensor_dev_attr_2(attr);
772 int index = sensor_attr->index;
773 unsigned long val;
774 int i;
775
776 if (strict_strtoul(buf, 10, &val) < 0)
777 return -EINVAL;
778 if (val > 2)
779 return -EINVAL;
780
781 mutex_lock(&data->update_lock);
782 switch (val) {
783 case 0:
784 case 1:
785 data->pwm_fcms[0] &= ~(1 << index);
786 w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
787 for (i = 0; i < 6; i++) {
788 data->pwm_tfmr[i] &= ~(1 << index);
789 w83795_write(client, W83795_REG_TFMR(i),
790 data->pwm_tfmr[i]);
791 }
792 data->pwm_fomc |= 1 << index;
793 data->pwm_fomc ^= val << index;
794 w83795_write(client, W83795_REG_FOMC, data->pwm_fomc);
795 break;
796 case 2:
797 data->pwm_fcms[0] |= (1 << index);
798 w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
799 break;
800 }
801 mutex_unlock(&data->update_lock);
802 return count;
803 }
804
805 static ssize_t
806 show_temp_src(struct device *dev, struct device_attribute *attr, char *buf)
807 {
808 struct sensor_device_attribute_2 *sensor_attr =
809 to_sensor_dev_attr_2(attr);
810 struct i2c_client *client = to_i2c_client(dev);
811 struct w83795_data *data = i2c_get_clientdata(client);
812 int index = sensor_attr->index;
813 u8 val = index / 2;
814 u8 tmp = data->temp_src[val];
815
816 if (index % 1)
817 val = 4;
818 else
819 val = 0;
820 tmp >>= val;
821 tmp &= 0x0f;
822
823 return sprintf(buf, "%u\n", tmp);
824 }
825
826 static ssize_t
827 store_temp_src(struct device *dev, struct device_attribute *attr,
828 const char *buf, size_t count)
829 {
830 struct i2c_client *client = to_i2c_client(dev);
831 struct w83795_data *data = i2c_get_clientdata(client);
832 struct sensor_device_attribute_2 *sensor_attr =
833 to_sensor_dev_attr_2(attr);
834 int index = sensor_attr->index;
835 unsigned long tmp;
836 u8 val = index / 2;
837
838 if (strict_strtoul(buf, 10, &tmp) < 0)
839 return -EINVAL;
840 tmp = SENSORS_LIMIT(tmp, 0, 15);
841
842 mutex_lock(&data->update_lock);
843 if (index % 1) {
844 tmp <<= 4;
845 data->temp_src[val] &= 0x0f;
846 } else {
847 data->temp_src[val] &= 0xf0;
848 }
849 data->temp_src[val] |= tmp;
850 w83795_write(client, W83795_REG_TSS(val), data->temp_src[val]);
851 mutex_unlock(&data->update_lock);
852
853 return count;
854 }
855
856 #define TEMP_PWM_ENABLE 0
857 #define TEMP_PWM_FAN_MAP 1
858 static ssize_t
859 show_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
860 char *buf)
861 {
862 struct i2c_client *client = to_i2c_client(dev);
863 struct w83795_data *data = i2c_get_clientdata(client);
864 struct sensor_device_attribute_2 *sensor_attr =
865 to_sensor_dev_attr_2(attr);
866 int nr = sensor_attr->nr;
867 int index = sensor_attr->index;
868 u8 tmp = 0xff;
869
870 switch (nr) {
871 case TEMP_PWM_ENABLE:
872 tmp = (data->pwm_fcms[1] >> index) & 1;
873 if (tmp)
874 tmp = 4;
875 else
876 tmp = 3;
877 break;
878 case TEMP_PWM_FAN_MAP:
879 tmp = data->pwm_tfmr[index];
880 break;
881 }
882
883 return sprintf(buf, "%u\n", tmp);
884 }
885
886 static ssize_t
887 store_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
888 const char *buf, size_t count)
889 {
890 struct i2c_client *client = to_i2c_client(dev);
891 struct w83795_data *data = i2c_get_clientdata(client);
892 struct sensor_device_attribute_2 *sensor_attr =
893 to_sensor_dev_attr_2(attr);
894 int nr = sensor_attr->nr;
895 int index = sensor_attr->index;
896 unsigned long tmp;
897
898 if (strict_strtoul(buf, 10, &tmp) < 0)
899 return -EINVAL;
900
901 switch (nr) {
902 case TEMP_PWM_ENABLE:
903 if ((tmp != 3) && (tmp != 4))
904 return -EINVAL;
905 tmp -= 3;
906 mutex_lock(&data->update_lock);
907 data->pwm_fcms[1] &= ~(1 << index);
908 data->pwm_fcms[1] |= tmp << index;
909 w83795_write(client, W83795_REG_FCMS2, data->pwm_fcms[1]);
910 mutex_unlock(&data->update_lock);
911 break;
912 case TEMP_PWM_FAN_MAP:
913 mutex_lock(&data->update_lock);
914 tmp = SENSORS_LIMIT(tmp, 0, 0xff);
915 w83795_write(client, W83795_REG_TFMR(index), tmp);
916 data->pwm_tfmr[index] = tmp;
917 mutex_unlock(&data->update_lock);
918 break;
919 }
920 return count;
921 }
922
923 #define FANIN_TARGET 0
924 #define FANIN_TOL 1
925 static ssize_t
926 show_fanin(struct device *dev, struct device_attribute *attr, char *buf)
927 {
928 struct i2c_client *client = to_i2c_client(dev);
929 struct w83795_data *data = i2c_get_clientdata(client);
930 struct sensor_device_attribute_2 *sensor_attr =
931 to_sensor_dev_attr_2(attr);
932 int nr = sensor_attr->nr;
933 int index = sensor_attr->index;
934 u16 tmp = 0;
935
936 switch (nr) {
937 case FANIN_TARGET:
938 tmp = fan_from_reg(data->target_speed[index]);
939 break;
940 case FANIN_TOL:
941 tmp = data->tol_speed;
942 break;
943 }
944
945 return sprintf(buf, "%u\n", tmp);
946 }
947
948 static ssize_t
949 store_fanin(struct device *dev, struct device_attribute *attr,
950 const char *buf, size_t count)
951 {
952 struct i2c_client *client = to_i2c_client(dev);
953 struct w83795_data *data = i2c_get_clientdata(client);
954 struct sensor_device_attribute_2 *sensor_attr =
955 to_sensor_dev_attr_2(attr);
956 int nr = sensor_attr->nr;
957 int index = sensor_attr->index;
958 unsigned long val;
959
960 if (strict_strtoul(buf, 10, &val) < 0)
961 return -EINVAL;
962
963 mutex_lock(&data->update_lock);
964 switch (nr) {
965 case FANIN_TARGET:
966 val = fan_to_reg(SENSORS_LIMIT(val, 0, 0xfff));
967 w83795_write(client, W83795_REG_FTSH(index), (val >> 4) & 0xff);
968 w83795_write(client, W83795_REG_FTSL(index), (val << 4) & 0xf0);
969 data->target_speed[index] = val;
970 break;
971 case FANIN_TOL:
972 val = SENSORS_LIMIT(val, 0, 0x3f);
973 w83795_write(client, W83795_REG_TFTS, val);
974 data->tol_speed = val;
975 break;
976 }
977 mutex_unlock(&data->update_lock);
978
979 return count;
980 }
981
982
983 static ssize_t
984 show_temp_pwm(struct device *dev, struct device_attribute *attr, char *buf)
985 {
986 struct i2c_client *client = to_i2c_client(dev);
987 struct w83795_data *data = i2c_get_clientdata(client);
988 struct sensor_device_attribute_2 *sensor_attr =
989 to_sensor_dev_attr_2(attr);
990 int nr = sensor_attr->nr;
991 int index = sensor_attr->index;
992 long tmp = temp_from_reg(data->pwm_temp[index][nr]);
993
994 return sprintf(buf, "%ld\n", tmp);
995 }
996
997 static ssize_t
998 store_temp_pwm(struct device *dev, struct device_attribute *attr,
999 const char *buf, size_t count)
1000 {
1001 struct i2c_client *client = to_i2c_client(dev);
1002 struct w83795_data *data = i2c_get_clientdata(client);
1003 struct sensor_device_attribute_2 *sensor_attr =
1004 to_sensor_dev_attr_2(attr);
1005 int nr = sensor_attr->nr;
1006 int index = sensor_attr->index;
1007 unsigned long val;
1008 u8 tmp;
1009
1010 if (strict_strtoul(buf, 10, &val) < 0)
1011 return -EINVAL;
1012 val /= 1000;
1013
1014 mutex_lock(&data->update_lock);
1015 switch (nr) {
1016 case TEMP_PWM_TTTI:
1017 val = SENSORS_LIMIT(val, 0, 0x7f);
1018 w83795_write(client, W83795_REG_TTTI(index), val);
1019 break;
1020 case TEMP_PWM_CTFS:
1021 val = SENSORS_LIMIT(val, 0, 0x7f);
1022 w83795_write(client, W83795_REG_CTFS(index), val);
1023 break;
1024 case TEMP_PWM_HCT:
1025 val = SENSORS_LIMIT(val, 0, 0x0f);
1026 tmp = w83795_read(client, W83795_REG_HT(index));
1027 tmp &= 0x0f;
1028 tmp |= (val << 4) & 0xf0;
1029 w83795_write(client, W83795_REG_HT(index), tmp);
1030 break;
1031 case TEMP_PWM_HOT:
1032 val = SENSORS_LIMIT(val, 0, 0x0f);
1033 tmp = w83795_read(client, W83795_REG_HT(index));
1034 tmp &= 0xf0;
1035 tmp |= val & 0x0f;
1036 w83795_write(client, W83795_REG_HT(index), tmp);
1037 break;
1038 }
1039 data->pwm_temp[index][nr] = val;
1040 mutex_unlock(&data->update_lock);
1041
1042 return count;
1043 }
1044
1045 static ssize_t
1046 show_sf4_pwm(struct device *dev, struct device_attribute *attr, char *buf)
1047 {
1048 struct i2c_client *client = to_i2c_client(dev);
1049 struct w83795_data *data = i2c_get_clientdata(client);
1050 struct sensor_device_attribute_2 *sensor_attr =
1051 to_sensor_dev_attr_2(attr);
1052 int nr = sensor_attr->nr;
1053 int index = sensor_attr->index;
1054
1055 return sprintf(buf, "%u\n", data->sf4_reg[index][SF4_PWM][nr]);
1056 }
1057
1058 static ssize_t
1059 store_sf4_pwm(struct device *dev, struct device_attribute *attr,
1060 const char *buf, size_t count)
1061 {
1062 struct i2c_client *client = to_i2c_client(dev);
1063 struct w83795_data *data = i2c_get_clientdata(client);
1064 struct sensor_device_attribute_2 *sensor_attr =
1065 to_sensor_dev_attr_2(attr);
1066 int nr = sensor_attr->nr;
1067 int index = sensor_attr->index;
1068 unsigned long val;
1069
1070 if (strict_strtoul(buf, 10, &val) < 0)
1071 return -EINVAL;
1072
1073 mutex_lock(&data->update_lock);
1074 w83795_write(client, W83795_REG_SF4_PWM(index, nr), val);
1075 data->sf4_reg[index][SF4_PWM][nr] = val;
1076 mutex_unlock(&data->update_lock);
1077
1078 return count;
1079 }
1080
1081 static ssize_t
1082 show_sf4_temp(struct device *dev, struct device_attribute *attr, char *buf)
1083 {
1084 struct i2c_client *client = to_i2c_client(dev);
1085 struct w83795_data *data = i2c_get_clientdata(client);
1086 struct sensor_device_attribute_2 *sensor_attr =
1087 to_sensor_dev_attr_2(attr);
1088 int nr = sensor_attr->nr;
1089 int index = sensor_attr->index;
1090
1091 return sprintf(buf, "%u\n",
1092 (data->sf4_reg[index][SF4_TEMP][nr]) * 1000);
1093 }
1094
1095 static ssize_t
1096 store_sf4_temp(struct device *dev, struct device_attribute *attr,
1097 const char *buf, size_t count)
1098 {
1099 struct i2c_client *client = to_i2c_client(dev);
1100 struct w83795_data *data = i2c_get_clientdata(client);
1101 struct sensor_device_attribute_2 *sensor_attr =
1102 to_sensor_dev_attr_2(attr);
1103 int nr = sensor_attr->nr;
1104 int index = sensor_attr->index;
1105 unsigned long val;
1106
1107 if (strict_strtoul(buf, 10, &val) < 0)
1108 return -EINVAL;
1109 val /= 1000;
1110
1111 mutex_lock(&data->update_lock);
1112 w83795_write(client, W83795_REG_SF4_TEMP(index, nr), val);
1113 data->sf4_reg[index][SF4_TEMP][nr] = val;
1114 mutex_unlock(&data->update_lock);
1115
1116 return count;
1117 }
1118
1119
1120 static ssize_t
1121 show_temp(struct device *dev, struct device_attribute *attr, char *buf)
1122 {
1123 struct sensor_device_attribute_2 *sensor_attr =
1124 to_sensor_dev_attr_2(attr);
1125 int nr = sensor_attr->nr;
1126 int index = sensor_attr->index;
1127 struct w83795_data *data = w83795_update_device(dev);
1128 long temp = temp_from_reg(data->temp[index][nr] & 0x7f);
1129
1130 if (TEMP_READ == nr)
1131 temp += ((data->temp_read_vrlsb[index] >> VRLSB_SHIFT) & 0x03)
1132 * 250;
1133 if (data->temp[index][nr] & 0x80)
1134 temp = -temp;
1135 return sprintf(buf, "%ld\n", temp);
1136 }
1137
1138 static ssize_t
1139 store_temp(struct device *dev, struct device_attribute *attr,
1140 const char *buf, size_t count)
1141 {
1142 struct sensor_device_attribute_2 *sensor_attr =
1143 to_sensor_dev_attr_2(attr);
1144 int nr = sensor_attr->nr;
1145 int index = sensor_attr->index;
1146 struct i2c_client *client = to_i2c_client(dev);
1147 struct w83795_data *data = i2c_get_clientdata(client);
1148 long tmp;
1149
1150 if (strict_strtol(buf, 10, &tmp) < 0)
1151 return -EINVAL;
1152
1153 mutex_lock(&data->update_lock);
1154 data->temp[index][nr] = temp_to_reg(tmp, -128, 127);
1155 w83795_write(client, W83795_REG_TEMP[index][nr], data->temp[index][nr]);
1156 mutex_unlock(&data->update_lock);
1157 return count;
1158 }
1159
1160
1161 static ssize_t
1162 show_dts_mode(struct device *dev, struct device_attribute *attr, char *buf)
1163 {
1164 struct i2c_client *client = to_i2c_client(dev);
1165 struct w83795_data *data = i2c_get_clientdata(client);
1166 struct sensor_device_attribute_2 *sensor_attr =
1167 to_sensor_dev_attr_2(attr);
1168 int index = sensor_attr->index;
1169 u8 tmp;
1170
1171 if (data->enable_dts == 0)
1172 return sprintf(buf, "%d\n", 0);
1173
1174 if ((data->has_dts >> index) & 0x01) {
1175 if (data->enable_dts & 2)
1176 tmp = 5;
1177 else
1178 tmp = 6;
1179 } else {
1180 tmp = 0;
1181 }
1182
1183 return sprintf(buf, "%d\n", tmp);
1184 }
1185
1186 static ssize_t
1187 show_dts(struct device *dev, struct device_attribute *attr, char *buf)
1188 {
1189 struct sensor_device_attribute_2 *sensor_attr =
1190 to_sensor_dev_attr_2(attr);
1191 int index = sensor_attr->index;
1192 struct w83795_data *data = w83795_update_device(dev);
1193 long temp = temp_from_reg(data->dts[index] & 0x7f);
1194
1195 temp += ((data->dts_read_vrlsb[index] >> VRLSB_SHIFT) & 0x03) * 250;
1196 if (data->dts[index] & 0x80)
1197 temp = -temp;
1198 return sprintf(buf, "%ld\n", temp);
1199 }
1200
1201 static ssize_t
1202 show_dts_ext(struct device *dev, struct device_attribute *attr, char *buf)
1203 {
1204 struct sensor_device_attribute_2 *sensor_attr =
1205 to_sensor_dev_attr_2(attr);
1206 int nr = sensor_attr->nr;
1207 struct i2c_client *client = to_i2c_client(dev);
1208 struct w83795_data *data = i2c_get_clientdata(client);
1209 long temp = temp_from_reg(data->dts_ext[nr] & 0x7f);
1210
1211 if (data->dts_ext[nr] & 0x80)
1212 temp = -temp;
1213 return sprintf(buf, "%ld\n", temp);
1214 }
1215
1216 static ssize_t
1217 store_dts_ext(struct device *dev, struct device_attribute *attr,
1218 const char *buf, size_t count)
1219 {
1220 struct sensor_device_attribute_2 *sensor_attr =
1221 to_sensor_dev_attr_2(attr);
1222 int nr = sensor_attr->nr;
1223 struct i2c_client *client = to_i2c_client(dev);
1224 struct w83795_data *data = i2c_get_clientdata(client);
1225 long tmp;
1226
1227 if (strict_strtol(buf, 10, &tmp) < 0)
1228 return -EINVAL;
1229
1230 mutex_lock(&data->update_lock);
1231 data->dts_ext[nr] = temp_to_reg(tmp, -128, 127);
1232 w83795_write(client, W83795_REG_DTS_EXT(nr), data->dts_ext[nr]);
1233 mutex_unlock(&data->update_lock);
1234 return count;
1235 }
1236
1237
1238 /*
1239 Type 3: Thermal diode
1240 Type 4: Thermistor
1241
1242 Temp5-6, default TR
1243 Temp1-4, default TD
1244 */
1245
1246 static ssize_t
1247 show_temp_mode(struct device *dev, struct device_attribute *attr, char *buf)
1248 {
1249 struct i2c_client *client = to_i2c_client(dev);
1250 struct w83795_data *data = i2c_get_clientdata(client);
1251 struct sensor_device_attribute_2 *sensor_attr =
1252 to_sensor_dev_attr_2(attr);
1253 int index = sensor_attr->index;
1254 u8 tmp;
1255
1256 if (data->has_temp >> index & 0x01) {
1257 if (data->temp_mode >> index & 0x01)
1258 tmp = 3;
1259 else
1260 tmp = 4;
1261 } else {
1262 tmp = 0;
1263 }
1264
1265 return sprintf(buf, "%d\n", tmp);
1266 }
1267
1268 static ssize_t
1269 store_temp_mode(struct device *dev, struct device_attribute *attr,
1270 const char *buf, size_t count)
1271 {
1272 struct i2c_client *client = to_i2c_client(dev);
1273 struct w83795_data *data = i2c_get_clientdata(client);
1274 struct sensor_device_attribute_2 *sensor_attr =
1275 to_sensor_dev_attr_2(attr);
1276 int index = sensor_attr->index;
1277 unsigned long val;
1278 u8 tmp;
1279 u32 mask;
1280
1281 if (strict_strtoul(buf, 10, &val) < 0)
1282 return -EINVAL;
1283 if ((val != 4) && (val != 3))
1284 return -EINVAL;
1285 if ((index > 3) && (val == 3))
1286 return -EINVAL;
1287
1288 mutex_lock(&data->update_lock);
1289 if (val == 3) {
1290 val = TEMP_CTRL_TD;
1291 data->has_temp |= 1 << index;
1292 data->temp_mode |= 1 << index;
1293 } else if (val == 4) {
1294 val = TEMP_CTRL_TR;
1295 data->has_temp |= 1 << index;
1296 tmp = 1 << index;
1297 data->temp_mode &= ~tmp;
1298 }
1299
1300 if (index > 3)
1301 tmp = w83795_read(client, W83795_REG_TEMP_CTRL1);
1302 else
1303 tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
1304
1305 mask = 0x03 << W83795_REG_TEMP_CTRL[index][TEMP_CTRL_SHIFT];
1306 tmp &= ~mask;
1307 tmp |= W83795_REG_TEMP_CTRL[index][val];
1308
1309 mask = 1 << W83795_REG_TEMP_CTRL[index][TEMP_CTRL_HASIN_SHIFT];
1310 data->has_in &= ~mask;
1311
1312 if (index > 3)
1313 w83795_write(client, W83795_REG_TEMP_CTRL1, tmp);
1314 else
1315 w83795_write(client, W83795_REG_TEMP_CTRL2, tmp);
1316
1317 mutex_unlock(&data->update_lock);
1318 return count;
1319 }
1320
1321
1322 /* show/store VIN */
1323 static ssize_t
1324 show_in(struct device *dev, struct device_attribute *attr, char *buf)
1325 {
1326 struct sensor_device_attribute_2 *sensor_attr =
1327 to_sensor_dev_attr_2(attr);
1328 int nr = sensor_attr->nr;
1329 int index = sensor_attr->index;
1330 struct w83795_data *data = w83795_update_device(dev);
1331 u16 val = data->in[index][nr];
1332 u8 lsb_idx;
1333
1334 switch (nr) {
1335 case IN_READ:
1336 /* calculate this value again by sensors as sensors3.conf */
1337 if ((index >= 17) &&
1338 !((data->has_gain >> (index - 17)) & 1))
1339 val *= 8;
1340 break;
1341 case IN_MAX:
1342 case IN_LOW:
1343 lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1344 val <<= 2;
1345 val |= (data->in_lsb[lsb_idx][nr] >>
1346 IN_LSB_SHIFT_IDX[lsb_idx][IN_LSB_SHIFT]) & 0x03;
1347 if ((index >= 17) &&
1348 !((data->has_gain >> (index - 17)) & 1))
1349 val *= 8;
1350 break;
1351 }
1352 val = in_from_reg(index, val);
1353
1354 return sprintf(buf, "%d\n", val);
1355 }
1356
1357 static ssize_t
1358 store_in(struct device *dev, struct device_attribute *attr,
1359 const char *buf, size_t count)
1360 {
1361 struct sensor_device_attribute_2 *sensor_attr =
1362 to_sensor_dev_attr_2(attr);
1363 int nr = sensor_attr->nr;
1364 int index = sensor_attr->index;
1365 struct i2c_client *client = to_i2c_client(dev);
1366 struct w83795_data *data = i2c_get_clientdata(client);
1367 unsigned long val;
1368 u8 tmp;
1369 u8 lsb_idx;
1370
1371 if (strict_strtoul(buf, 10, &val) < 0)
1372 return -EINVAL;
1373 val = in_to_reg(index, val);
1374
1375 if ((index >= 17) &&
1376 !((data->has_gain >> (index - 17)) & 1))
1377 val /= 8;
1378 val = SENSORS_LIMIT(val, 0, 0x3FF);
1379 mutex_lock(&data->update_lock);
1380
1381 lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1382 tmp = w83795_read(client, IN_LSB_REG(lsb_idx, nr));
1383 tmp &= ~(0x03 << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT]);
1384 tmp |= (val & 0x03) << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT];
1385 w83795_write(client, IN_LSB_REG(lsb_idx, nr), tmp);
1386 data->in_lsb[lsb_idx][nr] = tmp;
1387
1388 tmp = (val >> 2) & 0xff;
1389 w83795_write(client, W83795_REG_IN[index][nr], tmp);
1390 data->in[index][nr] = tmp;
1391
1392 mutex_unlock(&data->update_lock);
1393 return count;
1394 }
1395
1396
1397 static ssize_t
1398 show_sf_setup(struct device *dev, struct device_attribute *attr, char *buf)
1399 {
1400 struct sensor_device_attribute_2 *sensor_attr =
1401 to_sensor_dev_attr_2(attr);
1402 int nr = sensor_attr->nr;
1403 struct i2c_client *client = to_i2c_client(dev);
1404 struct w83795_data *data = i2c_get_clientdata(client);
1405 u16 val = data->setup_pwm[nr];
1406
1407 switch (nr) {
1408 case SETUP_PWM_UPTIME:
1409 case SETUP_PWM_DOWNTIME:
1410 val = time_from_reg(val);
1411 break;
1412 }
1413
1414 return sprintf(buf, "%d\n", val);
1415 }
1416
1417 static ssize_t
1418 store_sf_setup(struct device *dev, struct device_attribute *attr,
1419 const char *buf, size_t count)
1420 {
1421 struct sensor_device_attribute_2 *sensor_attr =
1422 to_sensor_dev_attr_2(attr);
1423 int nr = sensor_attr->nr;
1424 struct i2c_client *client = to_i2c_client(dev);
1425 struct w83795_data *data = i2c_get_clientdata(client);
1426 unsigned long val;
1427
1428 if (strict_strtoul(buf, 10, &val) < 0)
1429 return -EINVAL;
1430
1431 switch (nr) {
1432 case SETUP_PWM_DEFAULT:
1433 val = SENSORS_LIMIT(val, 0, 0xff);
1434 break;
1435 case SETUP_PWM_UPTIME:
1436 case SETUP_PWM_DOWNTIME:
1437 val = time_to_reg(val);
1438 if (val == 0)
1439 return -EINVAL;
1440 break;
1441 }
1442
1443 mutex_lock(&data->update_lock);
1444 data->setup_pwm[nr] = val;
1445 w83795_write(client, W83795_REG_SETUP_PWM(nr), val);
1446 mutex_unlock(&data->update_lock);
1447 return count;
1448 }
1449
1450
1451 #define NOT_USED -1
1452
1453 #define SENSOR_ATTR_IN(index) { \
1454 SENSOR_ATTR_2(in##index##_input, S_IRUGO, show_in, NULL, \
1455 IN_READ, index), \
1456 SENSOR_ATTR_2(in##index##_max, S_IRUGO | S_IWUSR, show_in, \
1457 store_in, IN_MAX, index), \
1458 SENSOR_ATTR_2(in##index##_min, S_IRUGO | S_IWUSR, show_in, \
1459 store_in, IN_LOW, index), \
1460 SENSOR_ATTR_2(in##index##_alarm, S_IRUGO, show_alarm_beep, \
1461 NULL, ALARM_STATUS, index + ((index > 14) ? 1 : 0)), \
1462 SENSOR_ATTR_2(in##index##_beep, S_IWUSR | S_IRUGO, \
1463 show_alarm_beep, store_beep, BEEP_ENABLE, \
1464 index + ((index > 14) ? 1 : 0)) }
1465
1466 #define SENSOR_ATTR_FAN(index) { \
1467 SENSOR_ATTR_2(fan##index##_input, S_IRUGO, show_fan, \
1468 NULL, FAN_INPUT, index - 1), \
1469 SENSOR_ATTR_2(fan##index##_min, S_IWUSR | S_IRUGO, \
1470 show_fan, store_fan_min, FAN_MIN, index - 1), \
1471 SENSOR_ATTR_2(fan##index##_alarm, S_IRUGO, show_alarm_beep, \
1472 NULL, ALARM_STATUS, index + 31), \
1473 SENSOR_ATTR_2(fan##index##_beep, S_IWUSR | S_IRUGO, \
1474 show_alarm_beep, store_beep, BEEP_ENABLE, index + 31) }
1475
1476 #define SENSOR_ATTR_PWM(index) { \
1477 SENSOR_ATTR_2(pwm##index, S_IWUSR | S_IRUGO, show_pwm, \
1478 store_pwm, PWM_OUTPUT, index - 1), \
1479 SENSOR_ATTR_2(pwm##index##_nonstop, S_IWUSR | S_IRUGO, \
1480 show_pwm, store_pwm, PWM_NONSTOP, index - 1), \
1481 SENSOR_ATTR_2(pwm##index##_start, S_IWUSR | S_IRUGO, \
1482 show_pwm, store_pwm, PWM_START, index - 1), \
1483 SENSOR_ATTR_2(pwm##index##_stop_time, S_IWUSR | S_IRUGO, \
1484 show_pwm, store_pwm, PWM_STOP_TIME, index - 1), \
1485 SENSOR_ATTR_2(fan##index##_div, S_IWUSR | S_IRUGO, \
1486 show_pwm, store_pwm, PWM_DIV, index - 1), \
1487 SENSOR_ATTR_2(pwm##index##_enable, S_IWUSR | S_IRUGO, \
1488 show_pwm_enable, store_pwm_enable, NOT_USED, index - 1), \
1489 SENSOR_ATTR_2(fan##index##_target, S_IWUSR | S_IRUGO, \
1490 show_fanin, store_fanin, FANIN_TARGET, index - 1) }
1491
1492 #define SENSOR_ATTR_DTS(index) { \
1493 SENSOR_ATTR_2(temp##index##_type, S_IRUGO , \
1494 show_dts_mode, NULL, NOT_USED, index - 7), \
1495 SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_dts, \
1496 NULL, NOT_USED, index - 7), \
1497 SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_dts_ext, \
1498 store_dts_ext, DTS_CRIT, NOT_USED), \
1499 SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR, \
1500 show_dts_ext, store_dts_ext, DTS_CRIT_HYST, NOT_USED), \
1501 SENSOR_ATTR_2(temp##index##_warn, S_IRUGO | S_IWUSR, show_dts_ext, \
1502 store_dts_ext, DTS_WARN, NOT_USED), \
1503 SENSOR_ATTR_2(temp##index##_warn_hyst, S_IRUGO | S_IWUSR, \
1504 show_dts_ext, store_dts_ext, DTS_WARN_HYST, NOT_USED), \
1505 SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO, \
1506 show_alarm_beep, NULL, ALARM_STATUS, index + 17), \
1507 SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO, \
1508 show_alarm_beep, store_beep, BEEP_ENABLE, index + 17) }
1509
1510 #define SENSOR_ATTR_TEMP(index) { \
1511 SENSOR_ATTR_2(temp##index##_type, S_IRUGO | S_IWUSR, \
1512 show_temp_mode, store_temp_mode, NOT_USED, index - 1), \
1513 SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_temp, \
1514 NULL, TEMP_READ, index - 1), \
1515 SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_temp, \
1516 store_temp, TEMP_CRIT, index - 1), \
1517 SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR, \
1518 show_temp, store_temp, TEMP_CRIT_HYST, index - 1), \
1519 SENSOR_ATTR_2(temp##index##_warn, S_IRUGO | S_IWUSR, show_temp, \
1520 store_temp, TEMP_WARN, index - 1), \
1521 SENSOR_ATTR_2(temp##index##_warn_hyst, S_IRUGO | S_IWUSR, \
1522 show_temp, store_temp, TEMP_WARN_HYST, index - 1), \
1523 SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO, \
1524 show_alarm_beep, NULL, ALARM_STATUS, \
1525 index + (index > 4 ? 11 : 17)), \
1526 SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO, \
1527 show_alarm_beep, store_beep, BEEP_ENABLE, \
1528 index + (index > 4 ? 11 : 17)), \
1529 SENSOR_ATTR_2(temp##index##_source_sel, S_IWUSR | S_IRUGO, \
1530 show_temp_src, store_temp_src, NOT_USED, index - 1), \
1531 SENSOR_ATTR_2(temp##index##_pwm_enable, S_IWUSR | S_IRUGO, \
1532 show_temp_pwm_enable, store_temp_pwm_enable, \
1533 TEMP_PWM_ENABLE, index - 1), \
1534 SENSOR_ATTR_2(temp##index##_auto_channels_pwm, S_IWUSR | S_IRUGO, \
1535 show_temp_pwm_enable, store_temp_pwm_enable, \
1536 TEMP_PWM_FAN_MAP, index - 1), \
1537 SENSOR_ATTR_2(thermal_cruise##index, S_IWUSR | S_IRUGO, \
1538 show_temp_pwm, store_temp_pwm, TEMP_PWM_TTTI, index - 1), \
1539 SENSOR_ATTR_2(temp##index##_crit, S_IWUSR | S_IRUGO, \
1540 show_temp_pwm, store_temp_pwm, TEMP_PWM_CTFS, index - 1), \
1541 SENSOR_ATTR_2(temp##index##_crit_hyst, S_IWUSR | S_IRUGO, \
1542 show_temp_pwm, store_temp_pwm, TEMP_PWM_HCT, index - 1), \
1543 SENSOR_ATTR_2(temp##index##_operation_hyst, S_IWUSR | S_IRUGO, \
1544 show_temp_pwm, store_temp_pwm, TEMP_PWM_HOT, index - 1), \
1545 SENSOR_ATTR_2(temp##index##_auto_point1_pwm, S_IRUGO | S_IWUSR, \
1546 show_sf4_pwm, store_sf4_pwm, 0, index - 1), \
1547 SENSOR_ATTR_2(temp##index##_auto_point2_pwm, S_IRUGO | S_IWUSR, \
1548 show_sf4_pwm, store_sf4_pwm, 1, index - 1), \
1549 SENSOR_ATTR_2(temp##index##_auto_point3_pwm, S_IRUGO | S_IWUSR, \
1550 show_sf4_pwm, store_sf4_pwm, 2, index - 1), \
1551 SENSOR_ATTR_2(temp##index##_auto_point4_pwm, S_IRUGO | S_IWUSR, \
1552 show_sf4_pwm, store_sf4_pwm, 3, index - 1), \
1553 SENSOR_ATTR_2(temp##index##_auto_point5_pwm, S_IRUGO | S_IWUSR, \
1554 show_sf4_pwm, store_sf4_pwm, 4, index - 1), \
1555 SENSOR_ATTR_2(temp##index##_auto_point6_pwm, S_IRUGO | S_IWUSR, \
1556 show_sf4_pwm, store_sf4_pwm, 5, index - 1), \
1557 SENSOR_ATTR_2(temp##index##_auto_point7_pwm, S_IRUGO | S_IWUSR, \
1558 show_sf4_pwm, store_sf4_pwm, 6, index - 1), \
1559 SENSOR_ATTR_2(temp##index##_auto_point1_temp, S_IRUGO | S_IWUSR,\
1560 show_sf4_temp, store_sf4_temp, 0, index - 1), \
1561 SENSOR_ATTR_2(temp##index##_auto_point2_temp, S_IRUGO | S_IWUSR,\
1562 show_sf4_temp, store_sf4_temp, 1, index - 1), \
1563 SENSOR_ATTR_2(temp##index##_auto_point3_temp, S_IRUGO | S_IWUSR,\
1564 show_sf4_temp, store_sf4_temp, 2, index - 1), \
1565 SENSOR_ATTR_2(temp##index##_auto_point4_temp, S_IRUGO | S_IWUSR,\
1566 show_sf4_temp, store_sf4_temp, 3, index - 1), \
1567 SENSOR_ATTR_2(temp##index##_auto_point5_temp, S_IRUGO | S_IWUSR,\
1568 show_sf4_temp, store_sf4_temp, 4, index - 1), \
1569 SENSOR_ATTR_2(temp##index##_auto_point6_temp, S_IRUGO | S_IWUSR,\
1570 show_sf4_temp, store_sf4_temp, 5, index - 1), \
1571 SENSOR_ATTR_2(temp##index##_auto_point7_temp, S_IRUGO | S_IWUSR,\
1572 show_sf4_temp, store_sf4_temp, 6, index - 1) }
1573
1574
1575 static struct sensor_device_attribute_2 w83795_in[][5] = {
1576 SENSOR_ATTR_IN(0),
1577 SENSOR_ATTR_IN(1),
1578 SENSOR_ATTR_IN(2),
1579 SENSOR_ATTR_IN(3),
1580 SENSOR_ATTR_IN(4),
1581 SENSOR_ATTR_IN(5),
1582 SENSOR_ATTR_IN(6),
1583 SENSOR_ATTR_IN(7),
1584 SENSOR_ATTR_IN(8),
1585 SENSOR_ATTR_IN(9),
1586 SENSOR_ATTR_IN(10),
1587 SENSOR_ATTR_IN(11),
1588 SENSOR_ATTR_IN(12),
1589 SENSOR_ATTR_IN(13),
1590 SENSOR_ATTR_IN(14),
1591 SENSOR_ATTR_IN(15),
1592 SENSOR_ATTR_IN(16),
1593 SENSOR_ATTR_IN(17),
1594 SENSOR_ATTR_IN(18),
1595 SENSOR_ATTR_IN(19),
1596 SENSOR_ATTR_IN(20),
1597 };
1598
1599 static const struct sensor_device_attribute_2 w83795_fan[][4] = {
1600 SENSOR_ATTR_FAN(1),
1601 SENSOR_ATTR_FAN(2),
1602 SENSOR_ATTR_FAN(3),
1603 SENSOR_ATTR_FAN(4),
1604 SENSOR_ATTR_FAN(5),
1605 SENSOR_ATTR_FAN(6),
1606 SENSOR_ATTR_FAN(7),
1607 SENSOR_ATTR_FAN(8),
1608 SENSOR_ATTR_FAN(9),
1609 SENSOR_ATTR_FAN(10),
1610 SENSOR_ATTR_FAN(11),
1611 SENSOR_ATTR_FAN(12),
1612 SENSOR_ATTR_FAN(13),
1613 SENSOR_ATTR_FAN(14),
1614 };
1615
1616 static const struct sensor_device_attribute_2 w83795_temp[][29] = {
1617 SENSOR_ATTR_TEMP(1),
1618 SENSOR_ATTR_TEMP(2),
1619 SENSOR_ATTR_TEMP(3),
1620 SENSOR_ATTR_TEMP(4),
1621 SENSOR_ATTR_TEMP(5),
1622 SENSOR_ATTR_TEMP(6),
1623 };
1624
1625 static const struct sensor_device_attribute_2 w83795_dts[][8] = {
1626 SENSOR_ATTR_DTS(7),
1627 SENSOR_ATTR_DTS(8),
1628 SENSOR_ATTR_DTS(9),
1629 SENSOR_ATTR_DTS(10),
1630 SENSOR_ATTR_DTS(11),
1631 SENSOR_ATTR_DTS(12),
1632 SENSOR_ATTR_DTS(13),
1633 SENSOR_ATTR_DTS(14),
1634 };
1635
1636 static const struct sensor_device_attribute_2 w83795_pwm[][7] = {
1637 SENSOR_ATTR_PWM(1),
1638 SENSOR_ATTR_PWM(2),
1639 SENSOR_ATTR_PWM(3),
1640 SENSOR_ATTR_PWM(4),
1641 SENSOR_ATTR_PWM(5),
1642 SENSOR_ATTR_PWM(6),
1643 SENSOR_ATTR_PWM(7),
1644 SENSOR_ATTR_PWM(8),
1645 };
1646
1647 static const struct sensor_device_attribute_2 sda_single_files[] = {
1648 SENSOR_ATTR_2(chassis, S_IWUSR | S_IRUGO, show_alarm_beep,
1649 store_chassis_clear, ALARM_STATUS, 46),
1650 SENSOR_ATTR_2(beep_enable, S_IWUSR | S_IRUGO, show_beep_enable,
1651 store_beep_enable, NOT_USED, NOT_USED),
1652 SENSOR_ATTR_2(speed_cruise_tolerance, S_IWUSR | S_IRUGO, show_fanin,
1653 store_fanin, FANIN_TOL, NOT_USED),
1654 SENSOR_ATTR_2(pwm_default, S_IWUSR | S_IRUGO, show_sf_setup,
1655 store_sf_setup, SETUP_PWM_DEFAULT, NOT_USED),
1656 SENSOR_ATTR_2(pwm_uptime, S_IWUSR | S_IRUGO, show_sf_setup,
1657 store_sf_setup, SETUP_PWM_UPTIME, NOT_USED),
1658 SENSOR_ATTR_2(pwm_downtime, S_IWUSR | S_IRUGO, show_sf_setup,
1659 store_sf_setup, SETUP_PWM_DOWNTIME, NOT_USED),
1660 };
1661
1662 /*
1663 * Driver interface
1664 */
1665
1666 static void w83795_init_client(struct i2c_client *client)
1667 {
1668 u8 config;
1669
1670 if (reset)
1671 w83795_write(client, W83795_REG_CONFIG, 0x80);
1672
1673 /* Start monitoring if needed */
1674 config = w83795_read(client, W83795_REG_CONFIG);
1675 if (!(config & W83795_REG_CONFIG_START)) {
1676 dev_info(&client->dev, "Enabling monitoring operations\n");
1677 w83795_write(client, W83795_REG_CONFIG,
1678 config | W83795_REG_CONFIG_START);
1679 }
1680 }
1681
1682 static int w83795_get_device_id(struct i2c_client *client)
1683 {
1684 int device_id;
1685
1686 device_id = i2c_smbus_read_byte_data(client, W83795_REG_DEVICEID);
1687
1688 /* Special case for rev. A chips; can't be checked first because later
1689 revisions emulate this for compatibility */
1690 if (device_id < 0 || (device_id & 0xf0) != 0x50) {
1691 int alt_id;
1692
1693 alt_id = i2c_smbus_read_byte_data(client,
1694 W83795_REG_DEVICEID_A);
1695 if (alt_id == 0x50)
1696 device_id = alt_id;
1697 }
1698
1699 return device_id;
1700 }
1701
1702 /* Return 0 if detection is successful, -ENODEV otherwise */
1703 static int w83795_detect(struct i2c_client *client,
1704 struct i2c_board_info *info)
1705 {
1706 int bank, vendor_id, device_id, expected, i2c_addr, config;
1707 struct i2c_adapter *adapter = client->adapter;
1708 unsigned short address = client->addr;
1709 const char *chip_name;
1710
1711 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1712 return -ENODEV;
1713 bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
1714 if (bank < 0 || (bank & 0x7c)) {
1715 dev_dbg(&adapter->dev,
1716 "w83795: Detection failed at addr 0x%02hx, check %s\n",
1717 address, "bank");
1718 return -ENODEV;
1719 }
1720
1721 /* Check Nuvoton vendor ID */
1722 vendor_id = i2c_smbus_read_byte_data(client, W83795_REG_VENDORID);
1723 expected = bank & 0x80 ? 0x5c : 0xa3;
1724 if (vendor_id != expected) {
1725 dev_dbg(&adapter->dev,
1726 "w83795: Detection failed at addr 0x%02hx, check %s\n",
1727 address, "vendor id");
1728 return -ENODEV;
1729 }
1730
1731 /* Check device ID */
1732 device_id = w83795_get_device_id(client) |
1733 (i2c_smbus_read_byte_data(client, W83795_REG_CHIPID) << 8);
1734 if ((device_id >> 4) != 0x795) {
1735 dev_dbg(&adapter->dev,
1736 "w83795: Detection failed at addr 0x%02hx, check %s\n",
1737 address, "device id\n");
1738 return -ENODEV;
1739 }
1740
1741 /* If Nuvoton chip, address of chip and W83795_REG_I2C_ADDR
1742 should match */
1743 if ((bank & 0x07) == 0) {
1744 i2c_addr = i2c_smbus_read_byte_data(client,
1745 W83795_REG_I2C_ADDR);
1746 if ((i2c_addr & 0x7f) != address) {
1747 dev_dbg(&adapter->dev,
1748 "w83795: Detection failed at addr 0x%02hx, "
1749 "check %s\n", address, "i2c addr");
1750 return -ENODEV;
1751 }
1752 }
1753
1754 /* Check 795 chip type: 795G or 795ADG
1755 Usually we don't write to chips during detection, but here we don't
1756 quite have the choice; hopefully it's OK, we are about to return
1757 success anyway */
1758 if ((bank & 0x07) != 0)
1759 i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL,
1760 bank & ~0x07);
1761 config = i2c_smbus_read_byte_data(client, W83795_REG_CONFIG);
1762 if (config & W83795_REG_CONFIG_CONFIG48)
1763 chip_name = "w83795adg";
1764 else
1765 chip_name = "w83795g";
1766
1767 strlcpy(info->type, chip_name, I2C_NAME_SIZE);
1768 dev_info(&adapter->dev, "Found %s rev. %c at 0x%02hx\n", chip_name,
1769 'A' + (device_id & 0xf), address);
1770
1771 return 0;
1772 }
1773
1774 static int w83795_handle_files(struct device *dev, int (*fn)(struct device *,
1775 const struct device_attribute *))
1776 {
1777 struct w83795_data *data = dev_get_drvdata(dev);
1778 int err, i, j;
1779
1780 for (i = 0; i < ARRAY_SIZE(w83795_in); i++) {
1781 if (!(data->has_in & (1 << i)))
1782 continue;
1783 for (j = 0; j < ARRAY_SIZE(w83795_in[0]); j++) {
1784 err = fn(dev, &w83795_in[i][j].dev_attr);
1785 if (err)
1786 return err;
1787 }
1788 }
1789
1790 for (i = 0; i < ARRAY_SIZE(w83795_fan); i++) {
1791 if (!(data->has_fan & (1 << i)))
1792 continue;
1793 for (j = 0; j < ARRAY_SIZE(w83795_fan[0]); j++) {
1794 err = fn(dev, &w83795_fan[i][j].dev_attr);
1795 if (err)
1796 return err;
1797 }
1798 }
1799
1800 for (i = 0; i < ARRAY_SIZE(sda_single_files); i++) {
1801 err = fn(dev, &sda_single_files[i].dev_attr);
1802 if (err)
1803 return err;
1804 }
1805
1806 for (i = 0; i < data->has_pwm; i++) {
1807 for (j = 0; j < ARRAY_SIZE(w83795_pwm[0]); j++) {
1808 err = fn(dev, &w83795_pwm[i][j].dev_attr);
1809 if (err)
1810 return err;
1811 }
1812 }
1813
1814 for (i = 0; i < ARRAY_SIZE(w83795_temp); i++) {
1815 if (!(data->has_temp & (1 << i)))
1816 continue;
1817 for (j = 0; j < ARRAY_SIZE(w83795_temp[0]); j++) {
1818 err = fn(dev, &w83795_temp[i][j].dev_attr);
1819 if (err)
1820 return err;
1821 }
1822 }
1823
1824 if (data->enable_dts != 0) {
1825 for (i = 0; i < ARRAY_SIZE(w83795_dts); i++) {
1826 if (!(data->has_dts & (1 << i)))
1827 continue;
1828 for (j = 0; j < ARRAY_SIZE(w83795_dts[0]); j++) {
1829 err = fn(dev, &w83795_dts[i][j].dev_attr);
1830 if (err)
1831 return err;
1832 }
1833 }
1834 }
1835
1836 return 0;
1837 }
1838
1839 /* We need a wrapper that fits in w83795_handle_files */
1840 static int device_remove_file_wrapper(struct device *dev,
1841 const struct device_attribute *attr)
1842 {
1843 device_remove_file(dev, attr);
1844 return 0;
1845 }
1846
1847 /* Check pins that can be used for either temperature or voltage monitoring */
1848 static void w83795_apply_temp_config(struct w83795_data *data, u8 config,
1849 int temp_chan, int in_chan)
1850 {
1851 /* config is a 2-bit value */
1852 switch (config) {
1853 case 0x2: /* Voltage monitoring */
1854 data->has_in |= 1 << in_chan;
1855 break;
1856 case 0x1: /* Thermal diode */
1857 if (temp_chan >= 4)
1858 break;
1859 data->temp_mode |= 1 << temp_chan;
1860 /* fall through */
1861 case 0x3: /* Thermistor */
1862 data->has_temp |= 1 << temp_chan;
1863 break;
1864 }
1865 }
1866
1867 static int w83795_probe(struct i2c_client *client,
1868 const struct i2c_device_id *id)
1869 {
1870 int i;
1871 u8 tmp;
1872 struct device *dev = &client->dev;
1873 struct w83795_data *data;
1874 int err;
1875
1876 data = kzalloc(sizeof(struct w83795_data), GFP_KERNEL);
1877 if (!data) {
1878 err = -ENOMEM;
1879 goto exit;
1880 }
1881
1882 i2c_set_clientdata(client, data);
1883 data->chip_type = id->driver_data;
1884 data->bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
1885 mutex_init(&data->update_lock);
1886
1887 /* Initialize the chip */
1888 w83795_init_client(client);
1889
1890 /* Check which voltages and fans are present */
1891 data->has_in = w83795_read(client, W83795_REG_VOLT_CTRL1)
1892 | (w83795_read(client, W83795_REG_VOLT_CTRL2) << 8);
1893 data->has_fan = w83795_read(client, W83795_REG_FANIN_CTRL1)
1894 | (w83795_read(client, W83795_REG_FANIN_CTRL2) << 8);
1895
1896 /* Check which analog temperatures and extra voltages are present */
1897 tmp = w83795_read(client, W83795_REG_TEMP_CTRL1);
1898 if (tmp & 0x20)
1899 data->enable_dts = 1;
1900 w83795_apply_temp_config(data, (tmp >> 2) & 0x3, 5, 16);
1901 w83795_apply_temp_config(data, tmp & 0x3, 4, 15);
1902 tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
1903 w83795_apply_temp_config(data, tmp >> 6, 3, 20);
1904 w83795_apply_temp_config(data, (tmp >> 4) & 0x3, 2, 19);
1905 w83795_apply_temp_config(data, (tmp >> 2) & 0x3, 1, 18);
1906 w83795_apply_temp_config(data, tmp & 0x3, 0, 17);
1907
1908 /* Check DTS enable status */
1909 if (data->enable_dts) {
1910 if (1 & w83795_read(client, W83795_REG_DTSC))
1911 data->enable_dts |= 2;
1912 data->has_dts = w83795_read(client, W83795_REG_DTSE);
1913 }
1914
1915 /* First update the voltages measured value and limits */
1916 for (i = 0; i < ARRAY_SIZE(data->in); i++) {
1917 if (!(data->has_in & (1 << i)))
1918 continue;
1919 data->in[i][IN_MAX] =
1920 w83795_read(client, W83795_REG_IN[i][IN_MAX]);
1921 data->in[i][IN_LOW] =
1922 w83795_read(client, W83795_REG_IN[i][IN_LOW]);
1923 tmp = w83795_read(client, W83795_REG_IN[i][IN_READ]) << 2;
1924 tmp |= (w83795_read(client, W83795_REG_VRLSB)
1925 >> VRLSB_SHIFT) & 0x03;
1926 data->in[i][IN_READ] = tmp;
1927 }
1928 for (i = 0; i < IN_LSB_REG_NUM; i++) {
1929 data->in_lsb[i][IN_MAX] =
1930 w83795_read(client, IN_LSB_REG(i, IN_MAX));
1931 data->in_lsb[i][IN_LOW] =
1932 w83795_read(client, IN_LSB_REG(i, IN_LOW));
1933 }
1934 data->has_gain = w83795_read(client, W83795_REG_VMIGB_CTRL) & 0x0f;
1935
1936 /* First update fan and limits */
1937 for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
1938 if (!(data->has_fan & (1 << i)))
1939 continue;
1940 data->fan_min[i] =
1941 w83795_read(client, W83795_REG_FAN_MIN_HL(i)) << 4;
1942 data->fan_min[i] |=
1943 (w83795_read(client, W83795_REG_FAN_MIN_LSB(i) >>
1944 W83795_REG_FAN_MIN_LSB_SHIFT(i))) & 0x0F;
1945 data->fan[i] = w83795_read(client, W83795_REG_FAN(i)) << 4;
1946 data->fan[i] |=
1947 (w83795_read(client, W83795_REG_VRLSB >> 4)) & 0x0F;
1948 }
1949
1950 /* temperature and limits */
1951 for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
1952 if (!(data->has_temp & (1 << i)))
1953 continue;
1954 data->temp[i][TEMP_CRIT] =
1955 w83795_read(client, W83795_REG_TEMP[i][TEMP_CRIT]);
1956 data->temp[i][TEMP_CRIT_HYST] =
1957 w83795_read(client, W83795_REG_TEMP[i][TEMP_CRIT_HYST]);
1958 data->temp[i][TEMP_WARN] =
1959 w83795_read(client, W83795_REG_TEMP[i][TEMP_WARN]);
1960 data->temp[i][TEMP_WARN_HYST] =
1961 w83795_read(client, W83795_REG_TEMP[i][TEMP_WARN_HYST]);
1962 data->temp[i][TEMP_READ] =
1963 w83795_read(client, W83795_REG_TEMP[i][TEMP_READ]);
1964 data->temp_read_vrlsb[i] =
1965 w83795_read(client, W83795_REG_VRLSB);
1966 }
1967
1968 /* dts temperature and limits */
1969 if (data->enable_dts != 0) {
1970 data->dts_ext[DTS_CRIT] =
1971 w83795_read(client, W83795_REG_DTS_EXT(DTS_CRIT));
1972 data->dts_ext[DTS_CRIT_HYST] =
1973 w83795_read(client, W83795_REG_DTS_EXT(DTS_CRIT_HYST));
1974 data->dts_ext[DTS_WARN] =
1975 w83795_read(client, W83795_REG_DTS_EXT(DTS_WARN));
1976 data->dts_ext[DTS_WARN_HYST] =
1977 w83795_read(client, W83795_REG_DTS_EXT(DTS_WARN_HYST));
1978 for (i = 0; i < ARRAY_SIZE(data->dts); i++) {
1979 if (!(data->has_dts & (1 << i)))
1980 continue;
1981 data->dts[i] = w83795_read(client, W83795_REG_DTS(i));
1982 data->dts_read_vrlsb[i] =
1983 w83795_read(client, W83795_REG_VRLSB);
1984 }
1985 }
1986
1987 /* First update temp source selction */
1988 for (i = 0; i < 3; i++)
1989 data->temp_src[i] = w83795_read(client, W83795_REG_TSS(i));
1990
1991 /* pwm and smart fan */
1992 if (data->chip_type == w83795g)
1993 data->has_pwm = 8;
1994 else
1995 data->has_pwm = 2;
1996 data->pwm_fcms[0] = w83795_read(client, W83795_REG_FCMS1);
1997 data->pwm_fcms[1] = w83795_read(client, W83795_REG_FCMS2);
1998 for (i = 0; i < W83795_REG_TEMP_NUM; i++)
1999 data->pwm_tfmr[i] = w83795_read(client, W83795_REG_TFMR(i));
2000 data->pwm_fomc = w83795_read(client, W83795_REG_FOMC);
2001 for (i = 0; i < data->has_pwm; i++) {
2002 for (tmp = 0; tmp < 5; tmp++) {
2003 data->pwm[i][tmp] =
2004 w83795_read(client, W83795_REG_PWM(i, tmp));
2005 }
2006 }
2007 for (i = 0; i < 8; i++) {
2008 data->target_speed[i] =
2009 w83795_read(client, W83795_REG_FTSH(i)) << 4;
2010 data->target_speed[i] |=
2011 w83795_read(client, W83795_REG_FTSL(i)) >> 4;
2012 }
2013 data->tol_speed = w83795_read(client, W83795_REG_TFTS) & 0x3f;
2014
2015 for (i = 0; i < W83795_REG_TEMP_NUM; i++) {
2016 data->pwm_temp[i][TEMP_PWM_TTTI] =
2017 w83795_read(client, W83795_REG_TTTI(i)) & 0x7f;
2018 data->pwm_temp[i][TEMP_PWM_CTFS] =
2019 w83795_read(client, W83795_REG_CTFS(i));
2020 tmp = w83795_read(client, W83795_REG_HT(i));
2021 data->pwm_temp[i][TEMP_PWM_HCT] = (tmp >> 4) & 0x0f;
2022 data->pwm_temp[i][TEMP_PWM_HOT] = tmp & 0x0f;
2023 }
2024 for (i = 0; i < W83795_REG_TEMP_NUM; i++) {
2025 for (tmp = 0; tmp < 7; tmp++) {
2026 data->sf4_reg[i][SF4_TEMP][tmp] =
2027 w83795_read(client,
2028 W83795_REG_SF4_TEMP(i, tmp));
2029 data->sf4_reg[i][SF4_PWM][tmp] =
2030 w83795_read(client, W83795_REG_SF4_PWM(i, tmp));
2031 }
2032 }
2033
2034 /* Setup PWM Register */
2035 for (i = 0; i < 3; i++) {
2036 data->setup_pwm[i] =
2037 w83795_read(client, W83795_REG_SETUP_PWM(i));
2038 }
2039
2040 /* alarm and beep */
2041 for (i = 0; i < ALARM_BEEP_REG_NUM; i++) {
2042 data->alarms[i] = w83795_read(client, W83795_REG_ALARM(i));
2043 data->beeps[i] = w83795_read(client, W83795_REG_BEEP(i));
2044 }
2045 data->beep_enable =
2046 (w83795_read(client, W83795_REG_BEEP(5)) >> 7) & 0x01;
2047
2048 err = w83795_handle_files(dev, device_create_file);
2049 if (err)
2050 goto exit_remove;
2051
2052 data->hwmon_dev = hwmon_device_register(dev);
2053 if (IS_ERR(data->hwmon_dev)) {
2054 err = PTR_ERR(data->hwmon_dev);
2055 goto exit_remove;
2056 }
2057
2058 return 0;
2059
2060 exit_remove:
2061 w83795_handle_files(dev, device_remove_file_wrapper);
2062 kfree(data);
2063 exit:
2064 return err;
2065 }
2066
2067 static int w83795_remove(struct i2c_client *client)
2068 {
2069 struct w83795_data *data = i2c_get_clientdata(client);
2070
2071 hwmon_device_unregister(data->hwmon_dev);
2072 w83795_handle_files(&client->dev, device_remove_file_wrapper);
2073 kfree(data);
2074
2075 return 0;
2076 }
2077
2078
2079 static const struct i2c_device_id w83795_id[] = {
2080 { "w83795g", w83795g },
2081 { "w83795adg", w83795adg },
2082 { }
2083 };
2084 MODULE_DEVICE_TABLE(i2c, w83795_id);
2085
2086 static struct i2c_driver w83795_driver = {
2087 .driver = {
2088 .name = "w83795",
2089 },
2090 .probe = w83795_probe,
2091 .remove = w83795_remove,
2092 .id_table = w83795_id,
2093
2094 .class = I2C_CLASS_HWMON,
2095 .detect = w83795_detect,
2096 .address_list = normal_i2c,
2097 };
2098
2099 static int __init sensors_w83795_init(void)
2100 {
2101 return i2c_add_driver(&w83795_driver);
2102 }
2103
2104 static void __exit sensors_w83795_exit(void)
2105 {
2106 i2c_del_driver(&w83795_driver);
2107 }
2108
2109 MODULE_AUTHOR("Wei Song");
2110 MODULE_DESCRIPTION("W83795G/ADG hardware monitoring driver");
2111 MODULE_LICENSE("GPL");
2112
2113 module_init(sensors_w83795_init);
2114 module_exit(sensors_w83795_exit);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree