?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
mac80211: fix virtual interfaces vs. injection
[linux/fpc-iii.git] / drivers / hwmon / pc87360.c
blob9b462bb13fa33b3b9cc67d66e884628a7e2043ba
1 /*
2 * pc87360.c - Part of lm_sensors, Linux kernel modules
3 * for hardware monitoring
4 * Copyright (C) 2004, 2007 Jean Delvare <khali@linux-fr.org>
5 *
6 * Copied from smsc47m1.c:
7 * Copyright (C) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 *
23 * Supports the following chips:
24 *
25 * Chip #vin #fan #pwm #temp devid
26 * PC87360 - 2 2 - 0xE1
27 * PC87363 - 2 2 - 0xE8
28 * PC87364 - 3 3 - 0xE4
29 * PC87365 11 3 3 2 0xE5
30 * PC87366 11 3 3 3-4 0xE9
31 *
32 * This driver assumes that no more than one chip is present, and one of
33 * the standard Super-I/O addresses is used (0x2E/0x2F or 0x4E/0x4F).
34 */
35
36 #include <linux/module.h>
37 #include <linux/init.h>
38 #include <linux/slab.h>
39 #include <linux/jiffies.h>
40 #include <linux/platform_device.h>
41 #include <linux/hwmon.h>
42 #include <linux/hwmon-sysfs.h>
43 #include <linux/hwmon-vid.h>
44 #include <linux/err.h>
45 #include <linux/mutex.h>
46 #include <asm/io.h>
47
48 static u8 devid;
49 static struct platform_device *pdev;
50 static unsigned short extra_isa[3];
51 static u8 confreg[4];
52
53 static int init = 1;
54 module_param(init, int, 0);
55 MODULE_PARM_DESC(init,
56 "Chip initialization level:\n"
57 " 0: None\n"
58 "*1: Forcibly enable internal voltage and temperature channels, except in9\n"
59 " 2: Forcibly enable all voltage and temperature channels, except in9\n"
60 " 3: Forcibly enable all voltage and temperature channels, including in9");
61
62 static unsigned short force_id;
63 module_param(force_id, ushort, 0);
64 MODULE_PARM_DESC(force_id, "Override the detected device ID");
65
66 /*
67 * Super-I/O registers and operations
68 */
69
70 #define DEV 0x07 /* Register: Logical device select */
71 #define DEVID 0x20 /* Register: Device ID */
72 #define ACT 0x30 /* Register: Device activation */
73 #define BASE 0x60 /* Register: Base address */
74
75 #define FSCM 0x09 /* Logical device: fans */
76 #define VLM 0x0d /* Logical device: voltages */
77 #define TMS 0x0e /* Logical device: temperatures */
78 static const u8 logdev[3] = { FSCM, VLM, TMS };
79
80 #define LD_FAN 0
81 #define LD_IN 1
82 #define LD_TEMP 2
83
84 static inline void superio_outb(int sioaddr, int reg, int val)
85 {
86 outb(reg, sioaddr);
87 outb(val, sioaddr+1);
88 }
89
90 static inline int superio_inb(int sioaddr, int reg)
91 {
92 outb(reg, sioaddr);
93 return inb(sioaddr+1);
94 }
95
96 static inline void superio_exit(int sioaddr)
97 {
98 outb(0x02, sioaddr);
99 outb(0x02, sioaddr+1);
100 }
101
102 /*
103 * Logical devices
104 */
105
106 #define PC87360_EXTENT 0x10
107 #define PC87365_REG_BANK 0x09
108 #define NO_BANK 0xff
109
110 /*
111 * Fan registers and conversions
112 */
113
114 /* nr has to be 0 or 1 (PC87360/87363) or 2 (PC87364/87365/87366) */
115 #define PC87360_REG_PRESCALE(nr) (0x00 + 2 * (nr))
116 #define PC87360_REG_PWM(nr) (0x01 + 2 * (nr))
117 #define PC87360_REG_FAN_MIN(nr) (0x06 + 3 * (nr))
118 #define PC87360_REG_FAN(nr) (0x07 + 3 * (nr))
119 #define PC87360_REG_FAN_STATUS(nr) (0x08 + 3 * (nr))
120
121 #define FAN_FROM_REG(val,div) ((val) == 0 ? 0: \
122 480000 / ((val)*(div)))
123 #define FAN_TO_REG(val,div) ((val) <= 100 ? 0 : \
124 480000 / ((val)*(div)))
125 #define FAN_DIV_FROM_REG(val) (1 << ((val >> 5) & 0x03))
126 #define FAN_STATUS_FROM_REG(val) ((val) & 0x07)
127
128 #define FAN_CONFIG_MONITOR(val,nr) (((val) >> (2 + nr * 3)) & 1)
129 #define FAN_CONFIG_CONTROL(val,nr) (((val) >> (3 + nr * 3)) & 1)
130 #define FAN_CONFIG_INVERT(val,nr) (((val) >> (4 + nr * 3)) & 1)
131
132 #define PWM_FROM_REG(val,inv) ((inv) ? 255 - (val) : (val))
133 static inline u8 PWM_TO_REG(int val, int inv)
134 {
135 if (inv)
136 val = 255 - val;
137 if (val < 0)
138 return 0;
139 if (val > 255)
140 return 255;
141 return val;
142 }
143
144 /*
145 * Voltage registers and conversions
146 */
147
148 #define PC87365_REG_IN_CONVRATE 0x07
149 #define PC87365_REG_IN_CONFIG 0x08
150 #define PC87365_REG_IN 0x0B
151 #define PC87365_REG_IN_MIN 0x0D
152 #define PC87365_REG_IN_MAX 0x0C
153 #define PC87365_REG_IN_STATUS 0x0A
154 #define PC87365_REG_IN_ALARMS1 0x00
155 #define PC87365_REG_IN_ALARMS2 0x01
156 #define PC87365_REG_VID 0x06
157
158 #define IN_FROM_REG(val,ref) (((val) * (ref) + 128) / 256)
159 #define IN_TO_REG(val,ref) ((val) < 0 ? 0 : \
160 (val)*256 >= (ref)*255 ? 255: \
161 ((val) * 256 + (ref)/2) / (ref))
162
163 /*
164 * Temperature registers and conversions
165 */
166
167 #define PC87365_REG_TEMP_CONFIG 0x08
168 #define PC87365_REG_TEMP 0x0B
169 #define PC87365_REG_TEMP_MIN 0x0D
170 #define PC87365_REG_TEMP_MAX 0x0C
171 #define PC87365_REG_TEMP_CRIT 0x0E
172 #define PC87365_REG_TEMP_STATUS 0x0A
173 #define PC87365_REG_TEMP_ALARMS 0x00
174
175 #define TEMP_FROM_REG(val) ((val) * 1000)
176 #define TEMP_TO_REG(val) ((val) < -55000 ? -55 : \
177 (val) > 127000 ? 127 : \
178 (val) < 0 ? ((val) - 500) / 1000 : \
179 ((val) + 500) / 1000)
180
181 /*
182 * Device data
183 */
184
185 struct pc87360_data {
186 const char *name;
187 struct device *hwmon_dev;
188 struct mutex lock;
189 struct mutex update_lock;
190 char valid; /* !=0 if following fields are valid */
191 unsigned long last_updated; /* In jiffies */
192
193 int address[3];
194
195 u8 fannr, innr, tempnr;
196
197 u8 fan[3]; /* Register value */
198 u8 fan_min[3]; /* Register value */
199 u8 fan_status[3]; /* Register value */
200 u8 pwm[3]; /* Register value */
201 u16 fan_conf; /* Configuration register values, combined */
202
203 u16 in_vref; /* 1 mV/bit */
204 u8 in[14]; /* Register value */
205 u8 in_min[14]; /* Register value */
206 u8 in_max[14]; /* Register value */
207 u8 in_crit[3]; /* Register value */
208 u8 in_status[14]; /* Register value */
209 u16 in_alarms; /* Register values, combined, masked */
210 u8 vid_conf; /* Configuration register value */
211 u8 vrm;
212 u8 vid; /* Register value */
213
214 s8 temp[3]; /* Register value */
215 s8 temp_min[3]; /* Register value */
216 s8 temp_max[3]; /* Register value */
217 s8 temp_crit[3]; /* Register value */
218 u8 temp_status[3]; /* Register value */
219 u8 temp_alarms; /* Register value, masked */
220 };
221
222 /*
223 * Functions declaration
224 */
225
226 static int pc87360_probe(struct platform_device *pdev);
227 static int __devexit pc87360_remove(struct platform_device *pdev);
228
229 static int pc87360_read_value(struct pc87360_data *data, u8 ldi, u8 bank,
230 u8 reg);
231 static void pc87360_write_value(struct pc87360_data *data, u8 ldi, u8 bank,
232 u8 reg, u8 value);
233 static void pc87360_init_device(struct platform_device *pdev,
234 int use_thermistors);
235 static struct pc87360_data *pc87360_update_device(struct device *dev);
236
237 /*
238 * Driver data
239 */
240
241 static struct platform_driver pc87360_driver = {
242 .driver = {
243 .owner = THIS_MODULE,
244 .name = "pc87360",
245 },
246 .probe = pc87360_probe,
247 .remove = __devexit_p(pc87360_remove),
248 };
249
250 /*
251 * Sysfs stuff
252 */
253
254 static ssize_t show_fan_input(struct device *dev, struct device_attribute *devattr, char *buf)
255 {
256 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
257 struct pc87360_data *data = pc87360_update_device(dev);
258 return sprintf(buf, "%u\n", FAN_FROM_REG(data->fan[attr->index],
259 FAN_DIV_FROM_REG(data->fan_status[attr->index])));
260 }
261 static ssize_t show_fan_min(struct device *dev, struct device_attribute *devattr, char *buf)
262 {
263 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
264 struct pc87360_data *data = pc87360_update_device(dev);
265 return sprintf(buf, "%u\n", FAN_FROM_REG(data->fan_min[attr->index],
266 FAN_DIV_FROM_REG(data->fan_status[attr->index])));
267 }
268 static ssize_t show_fan_div(struct device *dev, struct device_attribute *devattr, char *buf)
269 {
270 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
271 struct pc87360_data *data = pc87360_update_device(dev);
272 return sprintf(buf, "%u\n",
273 FAN_DIV_FROM_REG(data->fan_status[attr->index]));
274 }
275 static ssize_t show_fan_status(struct device *dev, struct device_attribute *devattr, char *buf)
276 {
277 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
278 struct pc87360_data *data = pc87360_update_device(dev);
279 return sprintf(buf, "%u\n",
280 FAN_STATUS_FROM_REG(data->fan_status[attr->index]));
281 }
282 static ssize_t set_fan_min(struct device *dev, struct device_attribute *devattr, const char *buf,
283 size_t count)
284 {
285 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
286 struct pc87360_data *data = dev_get_drvdata(dev);
287 long fan_min = simple_strtol(buf, NULL, 10);
288
289 mutex_lock(&data->update_lock);
290 fan_min = FAN_TO_REG(fan_min, FAN_DIV_FROM_REG(data->fan_status[attr->index]));
291
292 /* If it wouldn't fit, change clock divisor */
293 while (fan_min > 255
294 && (data->fan_status[attr->index] & 0x60) != 0x60) {
295 fan_min >>= 1;
296 data->fan[attr->index] >>= 1;
297 data->fan_status[attr->index] += 0x20;
298 }
299 data->fan_min[attr->index] = fan_min > 255 ? 255 : fan_min;
300 pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_FAN_MIN(attr->index),
301 data->fan_min[attr->index]);
302
303 /* Write new divider, preserve alarm bits */
304 pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_FAN_STATUS(attr->index),
305 data->fan_status[attr->index] & 0xF9);
306 mutex_unlock(&data->update_lock);
307
308 return count;
309 }
310
311 static struct sensor_device_attribute fan_input[] = {
312 SENSOR_ATTR(fan1_input, S_IRUGO, show_fan_input, NULL, 0),
313 SENSOR_ATTR(fan2_input, S_IRUGO, show_fan_input, NULL, 1),
314 SENSOR_ATTR(fan3_input, S_IRUGO, show_fan_input, NULL, 2),
315 };
316 static struct sensor_device_attribute fan_status[] = {
317 SENSOR_ATTR(fan1_status, S_IRUGO, show_fan_status, NULL, 0),
318 SENSOR_ATTR(fan2_status, S_IRUGO, show_fan_status, NULL, 1),
319 SENSOR_ATTR(fan3_status, S_IRUGO, show_fan_status, NULL, 2),
320 };
321 static struct sensor_device_attribute fan_div[] = {
322 SENSOR_ATTR(fan1_div, S_IRUGO, show_fan_div, NULL, 0),
323 SENSOR_ATTR(fan2_div, S_IRUGO, show_fan_div, NULL, 1),
324 SENSOR_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2),
325 };
326 static struct sensor_device_attribute fan_min[] = {
327 SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min, set_fan_min, 0),
328 SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min, set_fan_min, 1),
329 SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min, set_fan_min, 2),
330 };
331
332 #define FAN_UNIT_ATTRS(X) \
333 &fan_input[X].dev_attr.attr, \
334 &fan_status[X].dev_attr.attr, \
335 &fan_div[X].dev_attr.attr, \
336 &fan_min[X].dev_attr.attr
337
338 static ssize_t show_pwm(struct device *dev, struct device_attribute *devattr, char *buf)
339 {
340 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
341 struct pc87360_data *data = pc87360_update_device(dev);
342 return sprintf(buf, "%u\n",
343 PWM_FROM_REG(data->pwm[attr->index],
344 FAN_CONFIG_INVERT(data->fan_conf,
345 attr->index)));
346 }
347 static ssize_t set_pwm(struct device *dev, struct device_attribute *devattr, const char *buf,
348 size_t count)
349 {
350 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
351 struct pc87360_data *data = dev_get_drvdata(dev);
352 long val = simple_strtol(buf, NULL, 10);
353
354 mutex_lock(&data->update_lock);
355 data->pwm[attr->index] = PWM_TO_REG(val,
356 FAN_CONFIG_INVERT(data->fan_conf, attr->index));
357 pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_PWM(attr->index),
358 data->pwm[attr->index]);
359 mutex_unlock(&data->update_lock);
360 return count;
361 }
362
363 static struct sensor_device_attribute pwm[] = {
364 SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 0),
365 SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 1),
366 SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 2),
367 };
368
369 static struct attribute * pc8736x_fan_attr_array[] = {
370 FAN_UNIT_ATTRS(0),
371 FAN_UNIT_ATTRS(1),
372 FAN_UNIT_ATTRS(2),
373 &pwm[0].dev_attr.attr,
374 &pwm[1].dev_attr.attr,
375 &pwm[2].dev_attr.attr,
376 NULL
377 };
378 static const struct attribute_group pc8736x_fan_group = {
379 .attrs = pc8736x_fan_attr_array,
380 };
381
382 static ssize_t show_in_input(struct device *dev, struct device_attribute *devattr, char *buf)
383 {
384 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
385 struct pc87360_data *data = pc87360_update_device(dev);
386 return sprintf(buf, "%u\n", IN_FROM_REG(data->in[attr->index],
387 data->in_vref));
388 }
389 static ssize_t show_in_min(struct device *dev, struct device_attribute *devattr, char *buf)
390 {
391 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
392 struct pc87360_data *data = pc87360_update_device(dev);
393 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_min[attr->index],
394 data->in_vref));
395 }
396 static ssize_t show_in_max(struct device *dev, struct device_attribute *devattr, char *buf)
397 {
398 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
399 struct pc87360_data *data = pc87360_update_device(dev);
400 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_max[attr->index],
401 data->in_vref));
402 }
403 static ssize_t show_in_status(struct device *dev, struct device_attribute *devattr, char *buf)
404 {
405 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
406 struct pc87360_data *data = pc87360_update_device(dev);
407 return sprintf(buf, "%u\n", data->in_status[attr->index]);
408 }
409 static ssize_t set_in_min(struct device *dev, struct device_attribute *devattr, const char *buf,
410 size_t count)
411 {
412 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
413 struct pc87360_data *data = dev_get_drvdata(dev);
414 long val = simple_strtol(buf, NULL, 10);
415
416 mutex_lock(&data->update_lock);
417 data->in_min[attr->index] = IN_TO_REG(val, data->in_vref);
418 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_IN_MIN,
419 data->in_min[attr->index]);
420 mutex_unlock(&data->update_lock);
421 return count;
422 }
423 static ssize_t set_in_max(struct device *dev, struct device_attribute *devattr, const char *buf,
424 size_t count)
425 {
426 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
427 struct pc87360_data *data = dev_get_drvdata(dev);
428 long val = simple_strtol(buf, NULL, 10);
429
430 mutex_lock(&data->update_lock);
431 data->in_max[attr->index] = IN_TO_REG(val,
432 data->in_vref);
433 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_IN_MAX,
434 data->in_max[attr->index]);
435 mutex_unlock(&data->update_lock);
436 return count;
437 }
438
439 static struct sensor_device_attribute in_input[] = {
440 SENSOR_ATTR(in0_input, S_IRUGO, show_in_input, NULL, 0),
441 SENSOR_ATTR(in1_input, S_IRUGO, show_in_input, NULL, 1),
442 SENSOR_ATTR(in2_input, S_IRUGO, show_in_input, NULL, 2),
443 SENSOR_ATTR(in3_input, S_IRUGO, show_in_input, NULL, 3),
444 SENSOR_ATTR(in4_input, S_IRUGO, show_in_input, NULL, 4),
445 SENSOR_ATTR(in5_input, S_IRUGO, show_in_input, NULL, 5),
446 SENSOR_ATTR(in6_input, S_IRUGO, show_in_input, NULL, 6),
447 SENSOR_ATTR(in7_input, S_IRUGO, show_in_input, NULL, 7),
448 SENSOR_ATTR(in8_input, S_IRUGO, show_in_input, NULL, 8),
449 SENSOR_ATTR(in9_input, S_IRUGO, show_in_input, NULL, 9),
450 SENSOR_ATTR(in10_input, S_IRUGO, show_in_input, NULL, 10),
451 };
452 static struct sensor_device_attribute in_status[] = {
453 SENSOR_ATTR(in0_status, S_IRUGO, show_in_status, NULL, 0),
454 SENSOR_ATTR(in1_status, S_IRUGO, show_in_status, NULL, 1),
455 SENSOR_ATTR(in2_status, S_IRUGO, show_in_status, NULL, 2),
456 SENSOR_ATTR(in3_status, S_IRUGO, show_in_status, NULL, 3),
457 SENSOR_ATTR(in4_status, S_IRUGO, show_in_status, NULL, 4),
458 SENSOR_ATTR(in5_status, S_IRUGO, show_in_status, NULL, 5),
459 SENSOR_ATTR(in6_status, S_IRUGO, show_in_status, NULL, 6),
460 SENSOR_ATTR(in7_status, S_IRUGO, show_in_status, NULL, 7),
461 SENSOR_ATTR(in8_status, S_IRUGO, show_in_status, NULL, 8),
462 SENSOR_ATTR(in9_status, S_IRUGO, show_in_status, NULL, 9),
463 SENSOR_ATTR(in10_status, S_IRUGO, show_in_status, NULL, 10),
464 };
465 static struct sensor_device_attribute in_min[] = {
466 SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 0),
467 SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 1),
468 SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 2),
469 SENSOR_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 3),
470 SENSOR_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 4),
471 SENSOR_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 5),
472 SENSOR_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 6),
473 SENSOR_ATTR(in7_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 7),
474 SENSOR_ATTR(in8_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 8),
475 SENSOR_ATTR(in9_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 9),
476 SENSOR_ATTR(in10_min, S_IWUSR | S_IRUGO, show_in_min, set_in_min, 10),
477 };
478 static struct sensor_device_attribute in_max[] = {
479 SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 0),
480 SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 1),
481 SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 2),
482 SENSOR_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 3),
483 SENSOR_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 4),
484 SENSOR_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 5),
485 SENSOR_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 6),
486 SENSOR_ATTR(in7_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 7),
487 SENSOR_ATTR(in8_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 8),
488 SENSOR_ATTR(in9_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 9),
489 SENSOR_ATTR(in10_max, S_IWUSR | S_IRUGO, show_in_max, set_in_max, 10),
490 };
491
492 #define VIN_UNIT_ATTRS(X) \
493 &in_input[X].dev_attr.attr, \
494 &in_status[X].dev_attr.attr, \
495 &in_min[X].dev_attr.attr, \
496 &in_max[X].dev_attr.attr
497
498 static ssize_t show_vid(struct device *dev, struct device_attribute *attr, char *buf)
499 {
500 struct pc87360_data *data = pc87360_update_device(dev);
501 return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm));
502 }
503 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
504
505 static ssize_t show_vrm(struct device *dev, struct device_attribute *attr, char *buf)
506 {
507 struct pc87360_data *data = dev_get_drvdata(dev);
508 return sprintf(buf, "%u\n", data->vrm);
509 }
510 static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
511 {
512 struct pc87360_data *data = dev_get_drvdata(dev);
513 data->vrm = simple_strtoul(buf, NULL, 10);
514 return count;
515 }
516 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm, set_vrm);
517
518 static ssize_t show_in_alarms(struct device *dev, struct device_attribute *attr, char *buf)
519 {
520 struct pc87360_data *data = pc87360_update_device(dev);
521 return sprintf(buf, "%u\n", data->in_alarms);
522 }
523 static DEVICE_ATTR(alarms_in, S_IRUGO, show_in_alarms, NULL);
524
525 static struct attribute *pc8736x_vin_attr_array[] = {
526 VIN_UNIT_ATTRS(0),
527 VIN_UNIT_ATTRS(1),
528 VIN_UNIT_ATTRS(2),
529 VIN_UNIT_ATTRS(3),
530 VIN_UNIT_ATTRS(4),
531 VIN_UNIT_ATTRS(5),
532 VIN_UNIT_ATTRS(6),
533 VIN_UNIT_ATTRS(7),
534 VIN_UNIT_ATTRS(8),
535 VIN_UNIT_ATTRS(9),
536 VIN_UNIT_ATTRS(10),
537 &dev_attr_cpu0_vid.attr,
538 &dev_attr_vrm.attr,
539 &dev_attr_alarms_in.attr,
540 NULL
541 };
542 static const struct attribute_group pc8736x_vin_group = {
543 .attrs = pc8736x_vin_attr_array,
544 };
545
546 static ssize_t show_therm_input(struct device *dev, struct device_attribute *devattr, char *buf)
547 {
548 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
549 struct pc87360_data *data = pc87360_update_device(dev);
550 return sprintf(buf, "%u\n", IN_FROM_REG(data->in[attr->index],
551 data->in_vref));
552 }
553 static ssize_t show_therm_min(struct device *dev, struct device_attribute *devattr, char *buf)
554 {
555 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
556 struct pc87360_data *data = pc87360_update_device(dev);
557 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_min[attr->index],
558 data->in_vref));
559 }
560 static ssize_t show_therm_max(struct device *dev, struct device_attribute *devattr, char *buf)
561 {
562 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
563 struct pc87360_data *data = pc87360_update_device(dev);
564 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_max[attr->index],
565 data->in_vref));
566 }
567 static ssize_t show_therm_crit(struct device *dev, struct device_attribute *devattr, char *buf)
568 {
569 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
570 struct pc87360_data *data = pc87360_update_device(dev);
571 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_crit[attr->index-11],
572 data->in_vref));
573 }
574 static ssize_t show_therm_status(struct device *dev, struct device_attribute *devattr, char *buf)
575 {
576 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
577 struct pc87360_data *data = pc87360_update_device(dev);
578 return sprintf(buf, "%u\n", data->in_status[attr->index]);
579 }
580 static ssize_t set_therm_min(struct device *dev, struct device_attribute *devattr, const char *buf,
581 size_t count)
582 {
583 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
584 struct pc87360_data *data = dev_get_drvdata(dev);
585 long val = simple_strtol(buf, NULL, 10);
586
587 mutex_lock(&data->update_lock);
588 data->in_min[attr->index] = IN_TO_REG(val, data->in_vref);
589 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_TEMP_MIN,
590 data->in_min[attr->index]);
591 mutex_unlock(&data->update_lock);
592 return count;
593 }
594 static ssize_t set_therm_max(struct device *dev, struct device_attribute *devattr, const char *buf,
595 size_t count)
596 {
597 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
598 struct pc87360_data *data = dev_get_drvdata(dev);
599 long val = simple_strtol(buf, NULL, 10);
600
601 mutex_lock(&data->update_lock);
602 data->in_max[attr->index] = IN_TO_REG(val, data->in_vref);
603 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_TEMP_MAX,
604 data->in_max[attr->index]);
605 mutex_unlock(&data->update_lock);
606 return count;
607 }
608 static ssize_t set_therm_crit(struct device *dev, struct device_attribute *devattr, const char *buf,
609 size_t count)
610 {
611 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
612 struct pc87360_data *data = dev_get_drvdata(dev);
613 long val = simple_strtol(buf, NULL, 10);
614
615 mutex_lock(&data->update_lock);
616 data->in_crit[attr->index-11] = IN_TO_REG(val, data->in_vref);
617 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_TEMP_CRIT,
618 data->in_crit[attr->index-11]);
619 mutex_unlock(&data->update_lock);
620 return count;
621 }
622
623 /* the +11 term below reflects the fact that VLM units 11,12,13 are
624 used in the chip to measure voltage across the thermistors
625 */
626 static struct sensor_device_attribute therm_input[] = {
627 SENSOR_ATTR(temp4_input, S_IRUGO, show_therm_input, NULL, 0+11),
628 SENSOR_ATTR(temp5_input, S_IRUGO, show_therm_input, NULL, 1+11),
629 SENSOR_ATTR(temp6_input, S_IRUGO, show_therm_input, NULL, 2+11),
630 };
631 static struct sensor_device_attribute therm_status[] = {
632 SENSOR_ATTR(temp4_status, S_IRUGO, show_therm_status, NULL, 0+11),
633 SENSOR_ATTR(temp5_status, S_IRUGO, show_therm_status, NULL, 1+11),
634 SENSOR_ATTR(temp6_status, S_IRUGO, show_therm_status, NULL, 2+11),
635 };
636 static struct sensor_device_attribute therm_min[] = {
637 SENSOR_ATTR(temp4_min, S_IRUGO | S_IWUSR,
638 show_therm_min, set_therm_min, 0+11),
639 SENSOR_ATTR(temp5_min, S_IRUGO | S_IWUSR,
640 show_therm_min, set_therm_min, 1+11),
641 SENSOR_ATTR(temp6_min, S_IRUGO | S_IWUSR,
642 show_therm_min, set_therm_min, 2+11),
643 };
644 static struct sensor_device_attribute therm_max[] = {
645 SENSOR_ATTR(temp4_max, S_IRUGO | S_IWUSR,
646 show_therm_max, set_therm_max, 0+11),
647 SENSOR_ATTR(temp5_max, S_IRUGO | S_IWUSR,
648 show_therm_max, set_therm_max, 1+11),
649 SENSOR_ATTR(temp6_max, S_IRUGO | S_IWUSR,
650 show_therm_max, set_therm_max, 2+11),
651 };
652 static struct sensor_device_attribute therm_crit[] = {
653 SENSOR_ATTR(temp4_crit, S_IRUGO | S_IWUSR,
654 show_therm_crit, set_therm_crit, 0+11),
655 SENSOR_ATTR(temp5_crit, S_IRUGO | S_IWUSR,
656 show_therm_crit, set_therm_crit, 1+11),
657 SENSOR_ATTR(temp6_crit, S_IRUGO | S_IWUSR,
658 show_therm_crit, set_therm_crit, 2+11),
659 };
660
661 #define THERM_UNIT_ATTRS(X) \
662 &therm_input[X].dev_attr.attr, \
663 &therm_status[X].dev_attr.attr, \
664 &therm_min[X].dev_attr.attr, \
665 &therm_max[X].dev_attr.attr, \
666 &therm_crit[X].dev_attr.attr
667
668 static struct attribute * pc8736x_therm_attr_array[] = {
669 THERM_UNIT_ATTRS(0),
670 THERM_UNIT_ATTRS(1),
671 THERM_UNIT_ATTRS(2),
672 NULL
673 };
674 static const struct attribute_group pc8736x_therm_group = {
675 .attrs = pc8736x_therm_attr_array,
676 };
677
678 static ssize_t show_temp_input(struct device *dev, struct device_attribute *devattr, char *buf)
679 {
680 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
681 struct pc87360_data *data = pc87360_update_device(dev);
682 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[attr->index]));
683 }
684 static ssize_t show_temp_min(struct device *dev, struct device_attribute *devattr, char *buf)
685 {
686 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
687 struct pc87360_data *data = pc87360_update_device(dev);
688 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[attr->index]));
689 }
690 static ssize_t show_temp_max(struct device *dev, struct device_attribute *devattr, char *buf)
691 {
692 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
693 struct pc87360_data *data = pc87360_update_device(dev);
694 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[attr->index]));
695 }
696 static ssize_t show_temp_crit(struct device *dev, struct device_attribute *devattr, char *buf)
697 {
698 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
699 struct pc87360_data *data = pc87360_update_device(dev);
700 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[attr->index]));
701 }
702 static ssize_t show_temp_status(struct device *dev, struct device_attribute *devattr, char *buf)
703 {
704 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
705 struct pc87360_data *data = pc87360_update_device(dev);
706 return sprintf(buf, "%d\n", data->temp_status[attr->index]);
707 }
708 static ssize_t set_temp_min(struct device *dev, struct device_attribute *devattr, const char *buf,
709 size_t count)
710 {
711 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
712 struct pc87360_data *data = dev_get_drvdata(dev);
713 long val = simple_strtol(buf, NULL, 10);
714
715 mutex_lock(&data->update_lock);
716 data->temp_min[attr->index] = TEMP_TO_REG(val);
717 pc87360_write_value(data, LD_TEMP, attr->index, PC87365_REG_TEMP_MIN,
718 data->temp_min[attr->index]);
719 mutex_unlock(&data->update_lock);
720 return count;
721 }
722 static ssize_t set_temp_max(struct device *dev, struct device_attribute *devattr, const char *buf,
723 size_t count)
724 {
725 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
726 struct pc87360_data *data = dev_get_drvdata(dev);
727 long val = simple_strtol(buf, NULL, 10);
728
729 mutex_lock(&data->update_lock);
730 data->temp_max[attr->index] = TEMP_TO_REG(val);
731 pc87360_write_value(data, LD_TEMP, attr->index, PC87365_REG_TEMP_MAX,
732 data->temp_max[attr->index]);
733 mutex_unlock(&data->update_lock);
734 return count;
735 }
736 static ssize_t set_temp_crit(struct device *dev, struct device_attribute *devattr, const char *buf,
737 size_t count)
738 {
739 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
740 struct pc87360_data *data = dev_get_drvdata(dev);
741 long val = simple_strtol(buf, NULL, 10);
742
743 mutex_lock(&data->update_lock);
744 data->temp_crit[attr->index] = TEMP_TO_REG(val);
745 pc87360_write_value(data, LD_TEMP, attr->index, PC87365_REG_TEMP_CRIT,
746 data->temp_crit[attr->index]);
747 mutex_unlock(&data->update_lock);
748 return count;
749 }
750
751 static struct sensor_device_attribute temp_input[] = {
752 SENSOR_ATTR(temp1_input, S_IRUGO, show_temp_input, NULL, 0),
753 SENSOR_ATTR(temp2_input, S_IRUGO, show_temp_input, NULL, 1),
754 SENSOR_ATTR(temp3_input, S_IRUGO, show_temp_input, NULL, 2),
755 };
756 static struct sensor_device_attribute temp_status[] = {
757 SENSOR_ATTR(temp1_status, S_IRUGO, show_temp_status, NULL, 0),
758 SENSOR_ATTR(temp2_status, S_IRUGO, show_temp_status, NULL, 1),
759 SENSOR_ATTR(temp3_status, S_IRUGO, show_temp_status, NULL, 2),
760 };
761 static struct sensor_device_attribute temp_min[] = {
762 SENSOR_ATTR(temp1_min, S_IRUGO | S_IWUSR,
763 show_temp_min, set_temp_min, 0),
764 SENSOR_ATTR(temp2_min, S_IRUGO | S_IWUSR,
765 show_temp_min, set_temp_min, 1),
766 SENSOR_ATTR(temp3_min, S_IRUGO | S_IWUSR,
767 show_temp_min, set_temp_min, 2),
768 };
769 static struct sensor_device_attribute temp_max[] = {
770 SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR,
771 show_temp_max, set_temp_max, 0),
772 SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR,
773 show_temp_max, set_temp_max, 1),
774 SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR,
775 show_temp_max, set_temp_max, 2),
776 };
777 static struct sensor_device_attribute temp_crit[] = {
778 SENSOR_ATTR(temp1_crit, S_IRUGO | S_IWUSR,
779 show_temp_crit, set_temp_crit, 0),
780 SENSOR_ATTR(temp2_crit, S_IRUGO | S_IWUSR,
781 show_temp_crit, set_temp_crit, 1),
782 SENSOR_ATTR(temp3_crit, S_IRUGO | S_IWUSR,
783 show_temp_crit, set_temp_crit, 2),
784 };
785
786 static ssize_t show_temp_alarms(struct device *dev, struct device_attribute *attr, char *buf)
787 {
788 struct pc87360_data *data = pc87360_update_device(dev);
789 return sprintf(buf, "%u\n", data->temp_alarms);
790 }
791 static DEVICE_ATTR(alarms_temp, S_IRUGO, show_temp_alarms, NULL);
792
793 #define TEMP_UNIT_ATTRS(X) \
794 &temp_input[X].dev_attr.attr, \
795 &temp_status[X].dev_attr.attr, \
796 &temp_min[X].dev_attr.attr, \
797 &temp_max[X].dev_attr.attr, \
798 &temp_crit[X].dev_attr.attr
799
800 static struct attribute * pc8736x_temp_attr_array[] = {
801 TEMP_UNIT_ATTRS(0),
802 TEMP_UNIT_ATTRS(1),
803 TEMP_UNIT_ATTRS(2),
804 /* include the few miscellaneous atts here */
805 &dev_attr_alarms_temp.attr,
806 NULL
807 };
808 static const struct attribute_group pc8736x_temp_group = {
809 .attrs = pc8736x_temp_attr_array,
810 };
811
812 static ssize_t show_name(struct device *dev, struct device_attribute
813 *devattr, char *buf)
814 {
815 struct pc87360_data *data = dev_get_drvdata(dev);
816 return sprintf(buf, "%s\n", data->name);
817 }
818 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
819
820 /*
821 * Device detection, registration and update
822 */
823
824 static int __init pc87360_find(int sioaddr, u8 *devid, unsigned short *addresses)
825 {
826 u16 val;
827 int i;
828 int nrdev; /* logical device count */
829
830 /* No superio_enter */
831
832 /* Identify device */
833 val = force_id ? force_id : superio_inb(sioaddr, DEVID);
834 switch (val) {
835 case 0xE1: /* PC87360 */
836 case 0xE8: /* PC87363 */
837 case 0xE4: /* PC87364 */
838 nrdev = 1;
839 break;
840 case 0xE5: /* PC87365 */
841 case 0xE9: /* PC87366 */
842 nrdev = 3;
843 break;
844 default:
845 superio_exit(sioaddr);
846 return -ENODEV;
847 }
848 /* Remember the device id */
849 *devid = val;
850
851 for (i = 0; i < nrdev; i++) {
852 /* select logical device */
853 superio_outb(sioaddr, DEV, logdev[i]);
854
855 val = superio_inb(sioaddr, ACT);
856 if (!(val & 0x01)) {
857 printk(KERN_INFO "pc87360: Device 0x%02x not "
858 "activated\n", logdev[i]);
859 continue;
860 }
861
862 val = (superio_inb(sioaddr, BASE) << 8)
863 | superio_inb(sioaddr, BASE + 1);
864 if (!val) {
865 printk(KERN_INFO "pc87360: Base address not set for "
866 "device 0x%02x\n", logdev[i]);
867 continue;
868 }
869
870 addresses[i] = val;
871
872 if (i==0) { /* Fans */
873 confreg[0] = superio_inb(sioaddr, 0xF0);
874 confreg[1] = superio_inb(sioaddr, 0xF1);
875
876 #ifdef DEBUG
877 printk(KERN_DEBUG "pc87360: Fan 1: mon=%d "
878 "ctrl=%d inv=%d\n", (confreg[0]>>2)&1,
879 (confreg[0]>>3)&1, (confreg[0]>>4)&1);
880 printk(KERN_DEBUG "pc87360: Fan 2: mon=%d "
881 "ctrl=%d inv=%d\n", (confreg[0]>>5)&1,
882 (confreg[0]>>6)&1, (confreg[0]>>7)&1);
883 printk(KERN_DEBUG "pc87360: Fan 3: mon=%d "
884 "ctrl=%d inv=%d\n", confreg[1]&1,
885 (confreg[1]>>1)&1, (confreg[1]>>2)&1);
886 #endif
887 } else if (i==1) { /* Voltages */
888 /* Are we using thermistors? */
889 if (*devid == 0xE9) { /* PC87366 */
890 /* These registers are not logical-device
891 specific, just that we won't need them if
892 we don't use the VLM device */
893 confreg[2] = superio_inb(sioaddr, 0x2B);
894 confreg[3] = superio_inb(sioaddr, 0x25);
895
896 if (confreg[2] & 0x40) {
897 printk(KERN_INFO "pc87360: Using "
898 "thermistors for temperature "
899 "monitoring\n");
900 }
901 if (confreg[3] & 0xE0) {
902 printk(KERN_INFO "pc87360: VID "
903 "inputs routed (mode %u)\n",
904 confreg[3] >> 5);
905 }
906 }
907 }
908 }
909
910 superio_exit(sioaddr);
911 return 0;
912 }
913
914 static int __devinit pc87360_probe(struct platform_device *pdev)
915 {
916 int i;
917 struct pc87360_data *data;
918 int err = 0;
919 const char *name = "pc87360";
920 int use_thermistors = 0;
921 struct device *dev = &pdev->dev;
922
923 if (!(data = kzalloc(sizeof(struct pc87360_data), GFP_KERNEL)))
924 return -ENOMEM;
925
926 data->fannr = 2;
927 data->innr = 0;
928 data->tempnr = 0;
929
930 switch (devid) {
931 case 0xe8:
932 name = "pc87363";
933 break;
934 case 0xe4:
935 name = "pc87364";
936 data->fannr = 3;
937 break;
938 case 0xe5:
939 name = "pc87365";
940 data->fannr = extra_isa[0] ? 3 : 0;
941 data->innr = extra_isa[1] ? 11 : 0;
942 data->tempnr = extra_isa[2] ? 2 : 0;
943 break;
944 case 0xe9:
945 name = "pc87366";
946 data->fannr = extra_isa[0] ? 3 : 0;
947 data->innr = extra_isa[1] ? 14 : 0;
948 data->tempnr = extra_isa[2] ? 3 : 0;
949 break;
950 }
951
952 data->name = name;
953 data->valid = 0;
954 mutex_init(&data->lock);
955 mutex_init(&data->update_lock);
956 platform_set_drvdata(pdev, data);
957
958 for (i = 0; i < 3; i++) {
959 if (((data->address[i] = extra_isa[i]))
960 && !request_region(extra_isa[i], PC87360_EXTENT,
961 pc87360_driver.driver.name)) {
962 dev_err(dev, "Region 0x%x-0x%x already "
963 "in use!\n", extra_isa[i],
964 extra_isa[i]+PC87360_EXTENT-1);
965 for (i--; i >= 0; i--)
966 release_region(extra_isa[i], PC87360_EXTENT);
967 err = -EBUSY;
968 goto ERROR1;
969 }
970 }
971
972 /* Retrieve the fans configuration from Super-I/O space */
973 if (data->fannr)
974 data->fan_conf = confreg[0] | (confreg[1] << 8);
975
976 /* Use the correct reference voltage
977 Unless both the VLM and the TMS logical devices agree to
978 use an external Vref, the internal one is used. */
979 if (data->innr) {
980 i = pc87360_read_value(data, LD_IN, NO_BANK,
981 PC87365_REG_IN_CONFIG);
982 if (data->tempnr) {
983 i &= pc87360_read_value(data, LD_TEMP, NO_BANK,
984 PC87365_REG_TEMP_CONFIG);
985 }
986 data->in_vref = (i&0x02) ? 3025 : 2966;
987 dev_dbg(dev, "Using %s reference voltage\n",
988 (i&0x02) ? "external" : "internal");
989
990 data->vid_conf = confreg[3];
991 data->vrm = vid_which_vrm();
992 }
993
994 /* Fan clock dividers may be needed before any data is read */
995 for (i = 0; i < data->fannr; i++) {
996 if (FAN_CONFIG_MONITOR(data->fan_conf, i))
997 data->fan_status[i] = pc87360_read_value(data,
998 LD_FAN, NO_BANK,
999 PC87360_REG_FAN_STATUS(i));
1000 }
1001
1002 if (init > 0) {
1003 if (devid == 0xe9 && data->address[1]) /* PC87366 */
1004 use_thermistors = confreg[2] & 0x40;
1005
1006 pc87360_init_device(pdev, use_thermistors);
1007 }
1008
1009 /* Register all-or-nothing sysfs groups */
1010
1011 if (data->innr &&
1012 (err = sysfs_create_group(&dev->kobj,
1013 &pc8736x_vin_group)))
1014 goto ERROR3;
1015
1016 if (data->innr == 14 &&
1017 (err = sysfs_create_group(&dev->kobj,
1018 &pc8736x_therm_group)))
1019 goto ERROR3;
1020
1021 /* create device attr-files for varying sysfs groups */
1022
1023 if (data->tempnr) {
1024 for (i = 0; i < data->tempnr; i++) {
1025 if ((err = device_create_file(dev,
1026 &temp_input[i].dev_attr))
1027 || (err = device_create_file(dev,
1028 &temp_min[i].dev_attr))
1029 || (err = device_create_file(dev,
1030 &temp_max[i].dev_attr))
1031 || (err = device_create_file(dev,
1032 &temp_crit[i].dev_attr))
1033 || (err = device_create_file(dev,
1034 &temp_status[i].dev_attr)))
1035 goto ERROR3;
1036 }
1037 if ((err = device_create_file(dev, &dev_attr_alarms_temp)))
1038 goto ERROR3;
1039 }
1040
1041 for (i = 0; i < data->fannr; i++) {
1042 if (FAN_CONFIG_MONITOR(data->fan_conf, i)
1043 && ((err = device_create_file(dev,
1044 &fan_input[i].dev_attr))
1045 || (err = device_create_file(dev,
1046 &fan_min[i].dev_attr))
1047 || (err = device_create_file(dev,
1048 &fan_div[i].dev_attr))
1049 || (err = device_create_file(dev,
1050 &fan_status[i].dev_attr))))
1051 goto ERROR3;
1052
1053 if (FAN_CONFIG_CONTROL(data->fan_conf, i)
1054 && (err = device_create_file(dev, &pwm[i].dev_attr)))
1055 goto ERROR3;
1056 }
1057
1058 if ((err = device_create_file(dev, &dev_attr_name)))
1059 goto ERROR3;
1060
1061 data->hwmon_dev = hwmon_device_register(dev);
1062 if (IS_ERR(data->hwmon_dev)) {
1063 err = PTR_ERR(data->hwmon_dev);
1064 goto ERROR3;
1065 }
1066 return 0;
1067
1068 ERROR3:
1069 device_remove_file(dev, &dev_attr_name);
1070 /* can still remove groups whose members were added individually */
1071 sysfs_remove_group(&dev->kobj, &pc8736x_temp_group);
1072 sysfs_remove_group(&dev->kobj, &pc8736x_fan_group);
1073 sysfs_remove_group(&dev->kobj, &pc8736x_therm_group);
1074 sysfs_remove_group(&dev->kobj, &pc8736x_vin_group);
1075 for (i = 0; i < 3; i++) {
1076 if (data->address[i]) {
1077 release_region(data->address[i], PC87360_EXTENT);
1078 }
1079 }
1080 ERROR1:
1081 kfree(data);
1082 return err;
1083 }
1084
1085 static int __devexit pc87360_remove(struct platform_device *pdev)
1086 {
1087 struct pc87360_data *data = platform_get_drvdata(pdev);
1088 int i;
1089
1090 hwmon_device_unregister(data->hwmon_dev);
1091
1092 device_remove_file(&pdev->dev, &dev_attr_name);
1093 sysfs_remove_group(&pdev->dev.kobj, &pc8736x_temp_group);
1094 sysfs_remove_group(&pdev->dev.kobj, &pc8736x_fan_group);
1095 sysfs_remove_group(&pdev->dev.kobj, &pc8736x_therm_group);
1096 sysfs_remove_group(&pdev->dev.kobj, &pc8736x_vin_group);
1097
1098 for (i = 0; i < 3; i++) {
1099 if (data->address[i]) {
1100 release_region(data->address[i], PC87360_EXTENT);
1101 }
1102 }
1103 kfree(data);
1104
1105 return 0;
1106 }
1107
1108 /* ldi is the logical device index
1109 bank is for voltages and temperatures only */
1110 static int pc87360_read_value(struct pc87360_data *data, u8 ldi, u8 bank,
1111 u8 reg)
1112 {
1113 int res;
1114
1115 mutex_lock(&(data->lock));
1116 if (bank != NO_BANK)
1117 outb_p(bank, data->address[ldi] + PC87365_REG_BANK);
1118 res = inb_p(data->address[ldi] + reg);
1119 mutex_unlock(&(data->lock));
1120
1121 return res;
1122 }
1123
1124 static void pc87360_write_value(struct pc87360_data *data, u8 ldi, u8 bank,
1125 u8 reg, u8 value)
1126 {
1127 mutex_lock(&(data->lock));
1128 if (bank != NO_BANK)
1129 outb_p(bank, data->address[ldi] + PC87365_REG_BANK);
1130 outb_p(value, data->address[ldi] + reg);
1131 mutex_unlock(&(data->lock));
1132 }
1133
1134 static void pc87360_init_device(struct platform_device *pdev,
1135 int use_thermistors)
1136 {
1137 struct pc87360_data *data = platform_get_drvdata(pdev);
1138 int i, nr;
1139 const u8 init_in[14] = { 2, 2, 2, 2, 2, 2, 2, 1, 1, 3, 1, 2, 2, 2 };
1140 const u8 init_temp[3] = { 2, 2, 1 };
1141 u8 reg;
1142
1143 if (init >= 2 && data->innr) {
1144 reg = pc87360_read_value(data, LD_IN, NO_BANK,
1145 PC87365_REG_IN_CONVRATE);
1146 dev_info(&pdev->dev, "VLM conversion set to "
1147 "1s period, 160us delay\n");
1148 pc87360_write_value(data, LD_IN, NO_BANK,
1149 PC87365_REG_IN_CONVRATE,
1150 (reg & 0xC0) | 0x11);
1151 }
1152
1153 nr = data->innr < 11 ? data->innr : 11;
1154 for (i = 0; i < nr; i++) {
1155 if (init >= init_in[i]) {
1156 /* Forcibly enable voltage channel */
1157 reg = pc87360_read_value(data, LD_IN, i,
1158 PC87365_REG_IN_STATUS);
1159 if (!(reg & 0x01)) {
1160 dev_dbg(&pdev->dev, "Forcibly "
1161 "enabling in%d\n", i);
1162 pc87360_write_value(data, LD_IN, i,
1163 PC87365_REG_IN_STATUS,
1164 (reg & 0x68) | 0x87);
1165 }
1166 }
1167 }
1168
1169 /* We can't blindly trust the Super-I/O space configuration bit,
1170 most BIOS won't set it properly */
1171 for (i = 11; i < data->innr; i++) {
1172 reg = pc87360_read_value(data, LD_IN, i,
1173 PC87365_REG_TEMP_STATUS);
1174 use_thermistors = use_thermistors || (reg & 0x01);
1175 }
1176
1177 i = use_thermistors ? 2 : 0;
1178 for (; i < data->tempnr; i++) {
1179 if (init >= init_temp[i]) {
1180 /* Forcibly enable temperature channel */
1181 reg = pc87360_read_value(data, LD_TEMP, i,
1182 PC87365_REG_TEMP_STATUS);
1183 if (!(reg & 0x01)) {
1184 dev_dbg(&pdev->dev, "Forcibly "
1185 "enabling temp%d\n", i+1);
1186 pc87360_write_value(data, LD_TEMP, i,
1187 PC87365_REG_TEMP_STATUS,
1188 0xCF);
1189 }
1190 }
1191 }
1192
1193 if (use_thermistors) {
1194 for (i = 11; i < data->innr; i++) {
1195 if (init >= init_in[i]) {
1196 /* The pin may already be used by thermal
1197 diodes */
1198 reg = pc87360_read_value(data, LD_TEMP,
1199 (i-11)/2, PC87365_REG_TEMP_STATUS);
1200 if (reg & 0x01) {
1201 dev_dbg(&pdev->dev, "Skipping "
1202 "temp%d, pin already in use "
1203 "by temp%d\n", i-7, (i-11)/2);
1204 continue;
1205 }
1206
1207 /* Forcibly enable thermistor channel */
1208 reg = pc87360_read_value(data, LD_IN, i,
1209 PC87365_REG_IN_STATUS);
1210 if (!(reg & 0x01)) {
1211 dev_dbg(&pdev->dev, "Forcibly "
1212 "enabling temp%d\n", i-7);
1213 pc87360_write_value(data, LD_IN, i,
1214 PC87365_REG_TEMP_STATUS,
1215 (reg & 0x60) | 0x8F);
1216 }
1217 }
1218 }
1219 }
1220
1221 if (data->innr) {
1222 reg = pc87360_read_value(data, LD_IN, NO_BANK,
1223 PC87365_REG_IN_CONFIG);
1224 if (reg & 0x01) {
1225 dev_dbg(&pdev->dev, "Forcibly "
1226 "enabling monitoring (VLM)\n");
1227 pc87360_write_value(data, LD_IN, NO_BANK,
1228 PC87365_REG_IN_CONFIG,
1229 reg & 0xFE);
1230 }
1231 }
1232
1233 if (data->tempnr) {
1234 reg = pc87360_read_value(data, LD_TEMP, NO_BANK,
1235 PC87365_REG_TEMP_CONFIG);
1236 if (reg & 0x01) {
1237 dev_dbg(&pdev->dev, "Forcibly enabling "
1238 "monitoring (TMS)\n");
1239 pc87360_write_value(data, LD_TEMP, NO_BANK,
1240 PC87365_REG_TEMP_CONFIG,
1241 reg & 0xFE);
1242 }
1243
1244 if (init >= 2) {
1245 /* Chip config as documented by National Semi. */
1246 pc87360_write_value(data, LD_TEMP, 0xF, 0xA, 0x08);
1247 /* We voluntarily omit the bank here, in case the
1248 sequence itself matters. It shouldn't be a problem,
1249 since nobody else is supposed to access the
1250 device at that point. */
1251 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xB, 0x04);
1252 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xC, 0x35);
1253 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xD, 0x05);
1254 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xE, 0x05);
1255 }
1256 }
1257 }
1258
1259 static void pc87360_autodiv(struct device *dev, int nr)
1260 {
1261 struct pc87360_data *data = dev_get_drvdata(dev);
1262 u8 old_min = data->fan_min[nr];
1263
1264 /* Increase clock divider if needed and possible */
1265 if ((data->fan_status[nr] & 0x04) /* overflow flag */
1266 || (data->fan[nr] >= 224)) { /* next to overflow */
1267 if ((data->fan_status[nr] & 0x60) != 0x60) {
1268 data->fan_status[nr] += 0x20;
1269 data->fan_min[nr] >>= 1;
1270 data->fan[nr] >>= 1;
1271 dev_dbg(dev, "Increasing "
1272 "clock divider to %d for fan %d\n",
1273 FAN_DIV_FROM_REG(data->fan_status[nr]), nr+1);
1274 }
1275 } else {
1276 /* Decrease clock divider if possible */
1277 while (!(data->fan_min[nr] & 0x80) /* min "nails" divider */
1278 && data->fan[nr] < 85 /* bad accuracy */
1279 && (data->fan_status[nr] & 0x60) != 0x00) {
1280 data->fan_status[nr] -= 0x20;
1281 data->fan_min[nr] <<= 1;
1282 data->fan[nr] <<= 1;
1283 dev_dbg(dev, "Decreasing "
1284 "clock divider to %d for fan %d\n",
1285 FAN_DIV_FROM_REG(data->fan_status[nr]),
1286 nr+1);
1287 }
1288 }
1289
1290 /* Write new fan min if it changed */
1291 if (old_min != data->fan_min[nr]) {
1292 pc87360_write_value(data, LD_FAN, NO_BANK,
1293 PC87360_REG_FAN_MIN(nr),
1294 data->fan_min[nr]);
1295 }
1296 }
1297
1298 static struct pc87360_data *pc87360_update_device(struct device *dev)
1299 {
1300 struct pc87360_data *data = dev_get_drvdata(dev);
1301 u8 i;
1302
1303 mutex_lock(&data->update_lock);
1304
1305 if (time_after(jiffies, data->last_updated + HZ * 2) || !data->valid) {
1306 dev_dbg(dev, "Data update\n");
1307
1308 /* Fans */
1309 for (i = 0; i < data->fannr; i++) {
1310 if (FAN_CONFIG_MONITOR(data->fan_conf, i)) {
1311 data->fan_status[i] =
1312 pc87360_read_value(data, LD_FAN,
1313 NO_BANK, PC87360_REG_FAN_STATUS(i));
1314 data->fan[i] = pc87360_read_value(data, LD_FAN,
1315 NO_BANK, PC87360_REG_FAN(i));
1316 data->fan_min[i] = pc87360_read_value(data,
1317 LD_FAN, NO_BANK,
1318 PC87360_REG_FAN_MIN(i));
1319 /* Change clock divider if needed */
1320 pc87360_autodiv(dev, i);
1321 /* Clear bits and write new divider */
1322 pc87360_write_value(data, LD_FAN, NO_BANK,
1323 PC87360_REG_FAN_STATUS(i),
1324 data->fan_status[i]);
1325 }
1326 if (FAN_CONFIG_CONTROL(data->fan_conf, i))
1327 data->pwm[i] = pc87360_read_value(data, LD_FAN,
1328 NO_BANK, PC87360_REG_PWM(i));
1329 }
1330
1331 /* Voltages */
1332 for (i = 0; i < data->innr; i++) {
1333 data->in_status[i] = pc87360_read_value(data, LD_IN, i,
1334 PC87365_REG_IN_STATUS);
1335 /* Clear bits */
1336 pc87360_write_value(data, LD_IN, i,
1337 PC87365_REG_IN_STATUS,
1338 data->in_status[i]);
1339 if ((data->in_status[i] & 0x81) == 0x81) {
1340 data->in[i] = pc87360_read_value(data, LD_IN,
1341 i, PC87365_REG_IN);
1342 }
1343 if (data->in_status[i] & 0x01) {
1344 data->in_min[i] = pc87360_read_value(data,
1345 LD_IN, i,
1346 PC87365_REG_IN_MIN);
1347 data->in_max[i] = pc87360_read_value(data,
1348 LD_IN, i,
1349 PC87365_REG_IN_MAX);
1350 if (i >= 11)
1351 data->in_crit[i-11] =
1352 pc87360_read_value(data, LD_IN,
1353 i, PC87365_REG_TEMP_CRIT);
1354 }
1355 }
1356 if (data->innr) {
1357 data->in_alarms = pc87360_read_value(data, LD_IN,
1358 NO_BANK, PC87365_REG_IN_ALARMS1)
1359 | ((pc87360_read_value(data, LD_IN,
1360 NO_BANK, PC87365_REG_IN_ALARMS2)
1361 & 0x07) << 8);
1362 data->vid = (data->vid_conf & 0xE0) ?
1363 pc87360_read_value(data, LD_IN,
1364 NO_BANK, PC87365_REG_VID) : 0x1F;
1365 }
1366
1367 /* Temperatures */
1368 for (i = 0; i < data->tempnr; i++) {
1369 data->temp_status[i] = pc87360_read_value(data,
1370 LD_TEMP, i,
1371 PC87365_REG_TEMP_STATUS);
1372 /* Clear bits */
1373 pc87360_write_value(data, LD_TEMP, i,
1374 PC87365_REG_TEMP_STATUS,
1375 data->temp_status[i]);
1376 if ((data->temp_status[i] & 0x81) == 0x81) {
1377 data->temp[i] = pc87360_read_value(data,
1378 LD_TEMP, i,
1379 PC87365_REG_TEMP);
1380 }
1381 if (data->temp_status[i] & 0x01) {
1382 data->temp_min[i] = pc87360_read_value(data,
1383 LD_TEMP, i,
1384 PC87365_REG_TEMP_MIN);
1385 data->temp_max[i] = pc87360_read_value(data,
1386 LD_TEMP, i,
1387 PC87365_REG_TEMP_MAX);
1388 data->temp_crit[i] = pc87360_read_value(data,
1389 LD_TEMP, i,
1390 PC87365_REG_TEMP_CRIT);
1391 }
1392 }
1393 if (data->tempnr) {
1394 data->temp_alarms = pc87360_read_value(data, LD_TEMP,
1395 NO_BANK, PC87365_REG_TEMP_ALARMS)
1396 & 0x3F;
1397 }
1398
1399 data->last_updated = jiffies;
1400 data->valid = 1;
1401 }
1402
1403 mutex_unlock(&data->update_lock);
1404
1405 return data;
1406 }
1407
1408 static int __init pc87360_device_add(unsigned short address)
1409 {
1410 struct resource res = {
1411 .name = "pc87360",
1412 .flags = IORESOURCE_IO,
1413 };
1414 int err, i;
1415
1416 pdev = platform_device_alloc("pc87360", address);
1417 if (!pdev) {
1418 err = -ENOMEM;
1419 printk(KERN_ERR "pc87360: Device allocation failed\n");
1420 goto exit;
1421 }
1422
1423 for (i = 0; i < 3; i++) {
1424 if (!extra_isa[i])
1425 continue;
1426 res.start = extra_isa[i];
1427 res.end = extra_isa[i] + PC87360_EXTENT - 1;
1428 err = platform_device_add_resources(pdev, &res, 1);
1429 if (err) {
1430 printk(KERN_ERR "pc87360: Device resource[%d] "
1431 "addition failed (%d)\n", i, err);
1432 goto exit_device_put;
1433 }
1434 }
1435
1436 err = platform_device_add(pdev);
1437 if (err) {
1438 printk(KERN_ERR "pc87360: Device addition failed (%d)\n",
1439 err);
1440 goto exit_device_put;
1441 }
1442
1443 return 0;
1444
1445 exit_device_put:
1446 platform_device_put(pdev);
1447 exit:
1448 return err;
1449 }
1450
1451 static int __init pc87360_init(void)
1452 {
1453 int err, i;
1454 unsigned short address = 0;
1455
1456 if (pc87360_find(0x2e, &devid, extra_isa)
1457 && pc87360_find(0x4e, &devid, extra_isa)) {
1458 printk(KERN_WARNING "pc87360: PC8736x not detected, "
1459 "module not inserted.\n");
1460 return -ENODEV;
1461 }
1462
1463 /* Arbitrarily pick one of the addresses */
1464 for (i = 0; i < 3; i++) {
1465 if (extra_isa[i] != 0x0000) {
1466 address = extra_isa[i];
1467 break;
1468 }
1469 }
1470
1471 if (address == 0x0000) {
1472 printk(KERN_WARNING "pc87360: No active logical device, "
1473 "module not inserted.\n");
1474 return -ENODEV;
1475 }
1476
1477 err = platform_driver_register(&pc87360_driver);
1478 if (err)
1479 goto exit;
1480
1481 /* Sets global pdev as a side effect */
1482 err = pc87360_device_add(address);
1483 if (err)
1484 goto exit_driver;
1485
1486 return 0;
1487
1488 exit_driver:
1489 platform_driver_unregister(&pc87360_driver);
1490 exit:
1491 return err;
1492 }
1493
1494 static void __exit pc87360_exit(void)
1495 {
1496 platform_device_unregister(pdev);
1497 platform_driver_unregister(&pc87360_driver);
1498 }
1499
1500
1501 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
1502 MODULE_DESCRIPTION("PC8736x hardware monitor");
1503 MODULE_LICENSE("GPL");
1504
1505 module_init(pc87360_init);
1506 module_exit(pc87360_exit);
Linux with added FPC-III support