?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / hwmon / pc87360.c
blob94f4b8b4a2ba726c8a8327ecb96c4e34b91173c6
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * pc87360.c - Part of lm_sensors, Linux kernel modules
4 * for hardware monitoring
5 * Copyright (C) 2004, 2007 Jean Delvare <jdelvare@suse.de>
6 *
7 * Copied from smsc47m1.c:
8 * Copyright (C) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
9 *
10 * Supports the following chips:
11 *
12 * Chip #vin #fan #pwm #temp devid
13 * PC87360 - 2 2 - 0xE1
14 * PC87363 - 2 2 - 0xE8
15 * PC87364 - 3 3 - 0xE4
16 * PC87365 11 3 3 2 0xE5
17 * PC87366 11 3 3 3-4 0xE9
18 *
19 * This driver assumes that no more than one chip is present, and one of
20 * the standard Super-I/O addresses is used (0x2E/0x2F or 0x4E/0x4F).
21 */
22
23 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
24
25 #include <linux/module.h>
26 #include <linux/init.h>
27 #include <linux/slab.h>
28 #include <linux/jiffies.h>
29 #include <linux/platform_device.h>
30 #include <linux/hwmon.h>
31 #include <linux/hwmon-sysfs.h>
32 #include <linux/hwmon-vid.h>
33 #include <linux/err.h>
34 #include <linux/mutex.h>
35 #include <linux/acpi.h>
36 #include <linux/io.h>
37
38 static u8 devid;
39 static struct platform_device *pdev;
40 static unsigned short extra_isa[3];
41 static u8 confreg[4];
42
43 static int init = 1;
44 module_param(init, int, 0);
45 MODULE_PARM_DESC(init,
46 "Chip initialization level:\n"
47 " 0: None\n"
48 "*1: Forcibly enable internal voltage and temperature channels, except in9\n"
49 " 2: Forcibly enable all voltage and temperature channels, except in9\n"
50 " 3: Forcibly enable all voltage and temperature channels, including in9");
51
52 static unsigned short force_id;
53 module_param(force_id, ushort, 0);
54 MODULE_PARM_DESC(force_id, "Override the detected device ID");
55
56 /*
57 * Super-I/O registers and operations
58 */
59
60 #define DEV 0x07 /* Register: Logical device select */
61 #define DEVID 0x20 /* Register: Device ID */
62 #define ACT 0x30 /* Register: Device activation */
63 #define BASE 0x60 /* Register: Base address */
64
65 #define FSCM 0x09 /* Logical device: fans */
66 #define VLM 0x0d /* Logical device: voltages */
67 #define TMS 0x0e /* Logical device: temperatures */
68 #define LDNI_MAX 3
69 static const u8 logdev[LDNI_MAX] = { FSCM, VLM, TMS };
70
71 #define LD_FAN 0
72 #define LD_IN 1
73 #define LD_TEMP 2
74
75 static inline void superio_outb(int sioaddr, int reg, int val)
76 {
77 outb(reg, sioaddr);
78 outb(val, sioaddr + 1);
79 }
80
81 static inline int superio_inb(int sioaddr, int reg)
82 {
83 outb(reg, sioaddr);
84 return inb(sioaddr + 1);
85 }
86
87 static inline void superio_exit(int sioaddr)
88 {
89 outb(0x02, sioaddr);
90 outb(0x02, sioaddr + 1);
91 }
92
93 /*
94 * Logical devices
95 */
96
97 #define PC87360_EXTENT 0x10
98 #define PC87365_REG_BANK 0x09
99 #define NO_BANK 0xff
100
101 /*
102 * Fan registers and conversions
103 */
104
105 /* nr has to be 0 or 1 (PC87360/87363) or 2 (PC87364/87365/87366) */
106 #define PC87360_REG_PRESCALE(nr) (0x00 + 2 * (nr))
107 #define PC87360_REG_PWM(nr) (0x01 + 2 * (nr))
108 #define PC87360_REG_FAN_MIN(nr) (0x06 + 3 * (nr))
109 #define PC87360_REG_FAN(nr) (0x07 + 3 * (nr))
110 #define PC87360_REG_FAN_STATUS(nr) (0x08 + 3 * (nr))
111
112 #define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : \
113 480000 / ((val) * (div)))
114 #define FAN_TO_REG(val, div) ((val) <= 100 ? 0 : \
115 480000 / ((val) * (div)))
116 #define FAN_DIV_FROM_REG(val) (1 << (((val) >> 5) & 0x03))
117 #define FAN_STATUS_FROM_REG(val) ((val) & 0x07)
118
119 #define FAN_CONFIG_MONITOR(val, nr) (((val) >> (2 + (nr) * 3)) & 1)
120 #define FAN_CONFIG_CONTROL(val, nr) (((val) >> (3 + (nr) * 3)) & 1)
121 #define FAN_CONFIG_INVERT(val, nr) (((val) >> (4 + (nr) * 3)) & 1)
122
123 #define PWM_FROM_REG(val, inv) ((inv) ? 255 - (val) : (val))
124 static inline u8 PWM_TO_REG(int val, int inv)
125 {
126 if (inv)
127 val = 255 - val;
128 if (val < 0)
129 return 0;
130 if (val > 255)
131 return 255;
132 return val;
133 }
134
135 /*
136 * Voltage registers and conversions
137 */
138
139 #define PC87365_REG_IN_CONVRATE 0x07
140 #define PC87365_REG_IN_CONFIG 0x08
141 #define PC87365_REG_IN 0x0B
142 #define PC87365_REG_IN_MIN 0x0D
143 #define PC87365_REG_IN_MAX 0x0C
144 #define PC87365_REG_IN_STATUS 0x0A
145 #define PC87365_REG_IN_ALARMS1 0x00
146 #define PC87365_REG_IN_ALARMS2 0x01
147 #define PC87365_REG_VID 0x06
148
149 #define IN_FROM_REG(val, ref) (((val) * (ref) + 128) / 256)
150 #define IN_TO_REG(val, ref) ((val) < 0 ? 0 : \
151 (val) * 256 >= (ref) * 255 ? 255 : \
152 ((val) * 256 + (ref) / 2) / (ref))
153
154 /*
155 * Temperature registers and conversions
156 */
157
158 #define PC87365_REG_TEMP_CONFIG 0x08
159 #define PC87365_REG_TEMP 0x0B
160 #define PC87365_REG_TEMP_MIN 0x0D
161 #define PC87365_REG_TEMP_MAX 0x0C
162 #define PC87365_REG_TEMP_CRIT 0x0E
163 #define PC87365_REG_TEMP_STATUS 0x0A
164 #define PC87365_REG_TEMP_ALARMS 0x00
165
166 #define TEMP_FROM_REG(val) ((val) * 1000)
167 #define TEMP_TO_REG(val) ((val) < -55000 ? -55 : \
168 (val) > 127000 ? 127 : \
169 (val) < 0 ? ((val) - 500) / 1000 : \
170 ((val) + 500) / 1000)
171
172 /*
173 * Device data
174 */
175
176 struct pc87360_data {
177 const char *name;
178 struct device *hwmon_dev;
179 struct mutex lock;
180 struct mutex update_lock;
181 char valid; /* !=0 if following fields are valid */
182 unsigned long last_updated; /* In jiffies */
183
184 int address[3];
185
186 u8 fannr, innr, tempnr;
187
188 u8 fan[3]; /* Register value */
189 u8 fan_min[3]; /* Register value */
190 u8 fan_status[3]; /* Register value */
191 u8 pwm[3]; /* Register value */
192 u16 fan_conf; /* Configuration register values, combined */
193
194 u16 in_vref; /* 1 mV/bit */
195 u8 in[14]; /* Register value */
196 u8 in_min[14]; /* Register value */
197 u8 in_max[14]; /* Register value */
198 u8 in_crit[3]; /* Register value */
199 u8 in_status[14]; /* Register value */
200 u16 in_alarms; /* Register values, combined, masked */
201 u8 vid_conf; /* Configuration register value */
202 u8 vrm;
203 u8 vid; /* Register value */
204
205 s8 temp[3]; /* Register value */
206 s8 temp_min[3]; /* Register value */
207 s8 temp_max[3]; /* Register value */
208 s8 temp_crit[3]; /* Register value */
209 u8 temp_status[3]; /* Register value */
210 u8 temp_alarms; /* Register value, masked */
211 };
212
213 /*
214 * Functions declaration
215 */
216
217 static int pc87360_probe(struct platform_device *pdev);
218 static int pc87360_remove(struct platform_device *pdev);
219
220 static int pc87360_read_value(struct pc87360_data *data, u8 ldi, u8 bank,
221 u8 reg);
222 static void pc87360_write_value(struct pc87360_data *data, u8 ldi, u8 bank,
223 u8 reg, u8 value);
224 static void pc87360_init_device(struct platform_device *pdev,
225 int use_thermistors);
226 static struct pc87360_data *pc87360_update_device(struct device *dev);
227
228 /*
229 * Driver data
230 */
231
232 static struct platform_driver pc87360_driver = {
233 .driver = {
234 .name = "pc87360",
235 },
236 .probe = pc87360_probe,
237 .remove = pc87360_remove,
238 };
239
240 /*
241 * Sysfs stuff
242 */
243
244 static ssize_t fan_input_show(struct device *dev,
245 struct device_attribute *devattr, char *buf)
246 {
247 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
248 struct pc87360_data *data = pc87360_update_device(dev);
249 return sprintf(buf, "%u\n", FAN_FROM_REG(data->fan[attr->index],
250 FAN_DIV_FROM_REG(data->fan_status[attr->index])));
251 }
252 static ssize_t fan_min_show(struct device *dev,
253 struct device_attribute *devattr, char *buf)
254 {
255 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
256 struct pc87360_data *data = pc87360_update_device(dev);
257 return sprintf(buf, "%u\n", FAN_FROM_REG(data->fan_min[attr->index],
258 FAN_DIV_FROM_REG(data->fan_status[attr->index])));
259 }
260 static ssize_t fan_div_show(struct device *dev,
261 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",
266 FAN_DIV_FROM_REG(data->fan_status[attr->index]));
267 }
268 static ssize_t fan_status_show(struct device *dev,
269 struct device_attribute *devattr, char *buf)
270 {
271 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
272 struct pc87360_data *data = pc87360_update_device(dev);
273 return sprintf(buf, "%u\n",
274 FAN_STATUS_FROM_REG(data->fan_status[attr->index]));
275 }
276 static ssize_t fan_min_store(struct device *dev,
277 struct device_attribute *devattr,
278 const char *buf, size_t count)
279 {
280 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
281 struct pc87360_data *data = dev_get_drvdata(dev);
282 long fan_min;
283 int err;
284
285 err = kstrtol(buf, 10, &fan_min);
286 if (err)
287 return err;
288
289 mutex_lock(&data->update_lock);
290 fan_min = FAN_TO_REG(fan_min,
291 FAN_DIV_FROM_REG(data->fan_status[attr->index]));
292
293 /* If it wouldn't fit, change clock divisor */
294 while (fan_min > 255
295 && (data->fan_status[attr->index] & 0x60) != 0x60) {
296 fan_min >>= 1;
297 data->fan[attr->index] >>= 1;
298 data->fan_status[attr->index] += 0x20;
299 }
300 data->fan_min[attr->index] = fan_min > 255 ? 255 : fan_min;
301 pc87360_write_value(data, LD_FAN, NO_BANK,
302 PC87360_REG_FAN_MIN(attr->index),
303 data->fan_min[attr->index]);
304
305 /* Write new divider, preserve alarm bits */
306 pc87360_write_value(data, LD_FAN, NO_BANK,
307 PC87360_REG_FAN_STATUS(attr->index),
308 data->fan_status[attr->index] & 0xF9);
309 mutex_unlock(&data->update_lock);
310
311 return count;
312 }
313
314 static struct sensor_device_attribute fan_input[] = {
315 SENSOR_ATTR_RO(fan1_input, fan_input, 0),
316 SENSOR_ATTR_RO(fan2_input, fan_input, 1),
317 SENSOR_ATTR_RO(fan3_input, fan_input, 2),
318 };
319 static struct sensor_device_attribute fan_status[] = {
320 SENSOR_ATTR_RO(fan1_status, fan_status, 0),
321 SENSOR_ATTR_RO(fan2_status, fan_status, 1),
322 SENSOR_ATTR_RO(fan3_status, fan_status, 2),
323 };
324 static struct sensor_device_attribute fan_div[] = {
325 SENSOR_ATTR_RO(fan1_div, fan_div, 0),
326 SENSOR_ATTR_RO(fan2_div, fan_div, 1),
327 SENSOR_ATTR_RO(fan3_div, fan_div, 2),
328 };
329 static struct sensor_device_attribute fan_min[] = {
330 SENSOR_ATTR_RW(fan1_min, fan_min, 0),
331 SENSOR_ATTR_RW(fan2_min, fan_min, 1),
332 SENSOR_ATTR_RW(fan3_min, fan_min, 2),
333 };
334
335 #define FAN_UNIT_ATTRS(X) \
336 { &fan_input[X].dev_attr.attr, \
337 &fan_status[X].dev_attr.attr, \
338 &fan_div[X].dev_attr.attr, \
339 &fan_min[X].dev_attr.attr, \
340 NULL \
341 }
342
343 static ssize_t pwm_show(struct device *dev, struct device_attribute *devattr,
344 char *buf)
345 {
346 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
347 struct pc87360_data *data = pc87360_update_device(dev);
348 return sprintf(buf, "%u\n",
349 PWM_FROM_REG(data->pwm[attr->index],
350 FAN_CONFIG_INVERT(data->fan_conf,
351 attr->index)));
352 }
353 static ssize_t pwm_store(struct device *dev, struct device_attribute *devattr,
354 const char *buf, size_t count)
355 {
356 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
357 struct pc87360_data *data = dev_get_drvdata(dev);
358 long val;
359 int err;
360
361 err = kstrtol(buf, 10, &val);
362 if (err)
363 return err;
364
365 mutex_lock(&data->update_lock);
366 data->pwm[attr->index] = PWM_TO_REG(val,
367 FAN_CONFIG_INVERT(data->fan_conf, attr->index));
368 pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_PWM(attr->index),
369 data->pwm[attr->index]);
370 mutex_unlock(&data->update_lock);
371 return count;
372 }
373
374 static struct sensor_device_attribute pwm[] = {
375 SENSOR_ATTR_RW(pwm1, pwm, 0),
376 SENSOR_ATTR_RW(pwm2, pwm, 1),
377 SENSOR_ATTR_RW(pwm3, pwm, 2),
378 };
379
380 static struct attribute *pc8736x_fan_attr[][5] = {
381 FAN_UNIT_ATTRS(0),
382 FAN_UNIT_ATTRS(1),
383 FAN_UNIT_ATTRS(2)
384 };
385
386 static const struct attribute_group pc8736x_fan_attr_group[] = {
387 { .attrs = pc8736x_fan_attr[0], },
388 { .attrs = pc8736x_fan_attr[1], },
389 { .attrs = pc8736x_fan_attr[2], },
390 };
391
392 static ssize_t in_input_show(struct device *dev,
393 struct device_attribute *devattr, char *buf)
394 {
395 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
396 struct pc87360_data *data = pc87360_update_device(dev);
397 return sprintf(buf, "%u\n", IN_FROM_REG(data->in[attr->index],
398 data->in_vref));
399 }
400 static ssize_t in_min_show(struct device *dev,
401 struct device_attribute *devattr, char *buf)
402 {
403 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
404 struct pc87360_data *data = pc87360_update_device(dev);
405 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_min[attr->index],
406 data->in_vref));
407 }
408 static ssize_t in_max_show(struct device *dev,
409 struct device_attribute *devattr, char *buf)
410 {
411 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
412 struct pc87360_data *data = pc87360_update_device(dev);
413 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_max[attr->index],
414 data->in_vref));
415 }
416 static ssize_t in_status_show(struct device *dev,
417 struct device_attribute *devattr, char *buf)
418 {
419 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
420 struct pc87360_data *data = pc87360_update_device(dev);
421 return sprintf(buf, "%u\n", data->in_status[attr->index]);
422 }
423 static ssize_t in_min_store(struct device *dev,
424 struct device_attribute *devattr, const char *buf,
425 size_t count)
426 {
427 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
428 struct pc87360_data *data = dev_get_drvdata(dev);
429 long val;
430 int err;
431
432 err = kstrtol(buf, 10, &val);
433 if (err)
434 return err;
435
436 mutex_lock(&data->update_lock);
437 data->in_min[attr->index] = IN_TO_REG(val, data->in_vref);
438 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_IN_MIN,
439 data->in_min[attr->index]);
440 mutex_unlock(&data->update_lock);
441 return count;
442 }
443 static ssize_t in_max_store(struct device *dev,
444 struct device_attribute *devattr, const char *buf,
445 size_t count)
446 {
447 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
448 struct pc87360_data *data = dev_get_drvdata(dev);
449 long val;
450 int err;
451
452 err = kstrtol(buf, 10, &val);
453 if (err)
454 return err;
455
456 mutex_lock(&data->update_lock);
457 data->in_max[attr->index] = IN_TO_REG(val,
458 data->in_vref);
459 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_IN_MAX,
460 data->in_max[attr->index]);
461 mutex_unlock(&data->update_lock);
462 return count;
463 }
464
465 static struct sensor_device_attribute in_input[] = {
466 SENSOR_ATTR_RO(in0_input, in_input, 0),
467 SENSOR_ATTR_RO(in1_input, in_input, 1),
468 SENSOR_ATTR_RO(in2_input, in_input, 2),
469 SENSOR_ATTR_RO(in3_input, in_input, 3),
470 SENSOR_ATTR_RO(in4_input, in_input, 4),
471 SENSOR_ATTR_RO(in5_input, in_input, 5),
472 SENSOR_ATTR_RO(in6_input, in_input, 6),
473 SENSOR_ATTR_RO(in7_input, in_input, 7),
474 SENSOR_ATTR_RO(in8_input, in_input, 8),
475 SENSOR_ATTR_RO(in9_input, in_input, 9),
476 SENSOR_ATTR_RO(in10_input, in_input, 10),
477 };
478 static struct sensor_device_attribute in_status[] = {
479 SENSOR_ATTR_RO(in0_status, in_status, 0),
480 SENSOR_ATTR_RO(in1_status, in_status, 1),
481 SENSOR_ATTR_RO(in2_status, in_status, 2),
482 SENSOR_ATTR_RO(in3_status, in_status, 3),
483 SENSOR_ATTR_RO(in4_status, in_status, 4),
484 SENSOR_ATTR_RO(in5_status, in_status, 5),
485 SENSOR_ATTR_RO(in6_status, in_status, 6),
486 SENSOR_ATTR_RO(in7_status, in_status, 7),
487 SENSOR_ATTR_RO(in8_status, in_status, 8),
488 SENSOR_ATTR_RO(in9_status, in_status, 9),
489 SENSOR_ATTR_RO(in10_status, in_status, 10),
490 };
491 static struct sensor_device_attribute in_min[] = {
492 SENSOR_ATTR_RW(in0_min, in_min, 0),
493 SENSOR_ATTR_RW(in1_min, in_min, 1),
494 SENSOR_ATTR_RW(in2_min, in_min, 2),
495 SENSOR_ATTR_RW(in3_min, in_min, 3),
496 SENSOR_ATTR_RW(in4_min, in_min, 4),
497 SENSOR_ATTR_RW(in5_min, in_min, 5),
498 SENSOR_ATTR_RW(in6_min, in_min, 6),
499 SENSOR_ATTR_RW(in7_min, in_min, 7),
500 SENSOR_ATTR_RW(in8_min, in_min, 8),
501 SENSOR_ATTR_RW(in9_min, in_min, 9),
502 SENSOR_ATTR_RW(in10_min, in_min, 10),
503 };
504 static struct sensor_device_attribute in_max[] = {
505 SENSOR_ATTR_RW(in0_max, in_max, 0),
506 SENSOR_ATTR_RW(in1_max, in_max, 1),
507 SENSOR_ATTR_RW(in2_max, in_max, 2),
508 SENSOR_ATTR_RW(in3_max, in_max, 3),
509 SENSOR_ATTR_RW(in4_max, in_max, 4),
510 SENSOR_ATTR_RW(in5_max, in_max, 5),
511 SENSOR_ATTR_RW(in6_max, in_max, 6),
512 SENSOR_ATTR_RW(in7_max, in_max, 7),
513 SENSOR_ATTR_RW(in8_max, in_max, 8),
514 SENSOR_ATTR_RW(in9_max, in_max, 9),
515 SENSOR_ATTR_RW(in10_max, in_max, 10),
516 };
517
518 /* (temp & vin) channel status register alarm bits (pdf sec.11.5.12) */
519 #define CHAN_ALM_MIN 0x02 /* min limit crossed */
520 #define CHAN_ALM_MAX 0x04 /* max limit exceeded */
521 #define TEMP_ALM_CRIT 0x08 /* temp crit exceeded (temp only) */
522
523 /*
524 * show_in_min/max_alarm() reads data from the per-channel status
525 * register (sec 11.5.12), not the vin event status registers (sec
526 * 11.5.2) that (legacy) show_in_alarm() resds (via data->in_alarms)
527 */
528
529 static ssize_t in_min_alarm_show(struct device *dev,
530 struct device_attribute *devattr, char *buf)
531 {
532 struct pc87360_data *data = pc87360_update_device(dev);
533 unsigned nr = to_sensor_dev_attr(devattr)->index;
534
535 return sprintf(buf, "%u\n", !!(data->in_status[nr] & CHAN_ALM_MIN));
536 }
537 static ssize_t in_max_alarm_show(struct device *dev,
538 struct device_attribute *devattr, char *buf)
539 {
540 struct pc87360_data *data = pc87360_update_device(dev);
541 unsigned nr = to_sensor_dev_attr(devattr)->index;
542
543 return sprintf(buf, "%u\n", !!(data->in_status[nr] & CHAN_ALM_MAX));
544 }
545
546 static struct sensor_device_attribute in_min_alarm[] = {
547 SENSOR_ATTR_RO(in0_min_alarm, in_min_alarm, 0),
548 SENSOR_ATTR_RO(in1_min_alarm, in_min_alarm, 1),
549 SENSOR_ATTR_RO(in2_min_alarm, in_min_alarm, 2),
550 SENSOR_ATTR_RO(in3_min_alarm, in_min_alarm, 3),
551 SENSOR_ATTR_RO(in4_min_alarm, in_min_alarm, 4),
552 SENSOR_ATTR_RO(in5_min_alarm, in_min_alarm, 5),
553 SENSOR_ATTR_RO(in6_min_alarm, in_min_alarm, 6),
554 SENSOR_ATTR_RO(in7_min_alarm, in_min_alarm, 7),
555 SENSOR_ATTR_RO(in8_min_alarm, in_min_alarm, 8),
556 SENSOR_ATTR_RO(in9_min_alarm, in_min_alarm, 9),
557 SENSOR_ATTR_RO(in10_min_alarm, in_min_alarm, 10),
558 };
559 static struct sensor_device_attribute in_max_alarm[] = {
560 SENSOR_ATTR_RO(in0_max_alarm, in_max_alarm, 0),
561 SENSOR_ATTR_RO(in1_max_alarm, in_max_alarm, 1),
562 SENSOR_ATTR_RO(in2_max_alarm, in_max_alarm, 2),
563 SENSOR_ATTR_RO(in3_max_alarm, in_max_alarm, 3),
564 SENSOR_ATTR_RO(in4_max_alarm, in_max_alarm, 4),
565 SENSOR_ATTR_RO(in5_max_alarm, in_max_alarm, 5),
566 SENSOR_ATTR_RO(in6_max_alarm, in_max_alarm, 6),
567 SENSOR_ATTR_RO(in7_max_alarm, in_max_alarm, 7),
568 SENSOR_ATTR_RO(in8_max_alarm, in_max_alarm, 8),
569 SENSOR_ATTR_RO(in9_max_alarm, in_max_alarm, 9),
570 SENSOR_ATTR_RO(in10_max_alarm, in_max_alarm, 10),
571 };
572
573 #define VIN_UNIT_ATTRS(X) \
574 &in_input[X].dev_attr.attr, \
575 &in_status[X].dev_attr.attr, \
576 &in_min[X].dev_attr.attr, \
577 &in_max[X].dev_attr.attr, \
578 &in_min_alarm[X].dev_attr.attr, \
579 &in_max_alarm[X].dev_attr.attr
580
581 static ssize_t cpu0_vid_show(struct device *dev,
582 struct device_attribute *attr, char *buf)
583 {
584 struct pc87360_data *data = pc87360_update_device(dev);
585 return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm));
586 }
587 static DEVICE_ATTR_RO(cpu0_vid);
588
589 static ssize_t vrm_show(struct device *dev, struct device_attribute *attr,
590 char *buf)
591 {
592 struct pc87360_data *data = dev_get_drvdata(dev);
593 return sprintf(buf, "%u\n", data->vrm);
594 }
595 static ssize_t vrm_store(struct device *dev, struct device_attribute *attr,
596 const char *buf, size_t count)
597 {
598 struct pc87360_data *data = dev_get_drvdata(dev);
599 unsigned long val;
600 int err;
601
602 err = kstrtoul(buf, 10, &val);
603 if (err)
604 return err;
605
606 if (val > 255)
607 return -EINVAL;
608
609 data->vrm = val;
610 return count;
611 }
612 static DEVICE_ATTR_RW(vrm);
613
614 static ssize_t alarms_in_show(struct device *dev,
615 struct device_attribute *attr, char *buf)
616 {
617 struct pc87360_data *data = pc87360_update_device(dev);
618 return sprintf(buf, "%u\n", data->in_alarms);
619 }
620 static DEVICE_ATTR_RO(alarms_in);
621
622 static struct attribute *pc8736x_vin_attr_array[] = {
623 VIN_UNIT_ATTRS(0),
624 VIN_UNIT_ATTRS(1),
625 VIN_UNIT_ATTRS(2),
626 VIN_UNIT_ATTRS(3),
627 VIN_UNIT_ATTRS(4),
628 VIN_UNIT_ATTRS(5),
629 VIN_UNIT_ATTRS(6),
630 VIN_UNIT_ATTRS(7),
631 VIN_UNIT_ATTRS(8),
632 VIN_UNIT_ATTRS(9),
633 VIN_UNIT_ATTRS(10),
634 &dev_attr_cpu0_vid.attr,
635 &dev_attr_vrm.attr,
636 &dev_attr_alarms_in.attr,
637 NULL
638 };
639 static const struct attribute_group pc8736x_vin_group = {
640 .attrs = pc8736x_vin_attr_array,
641 };
642
643 static ssize_t therm_input_show(struct device *dev,
644 struct device_attribute *devattr, char *buf)
645 {
646 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
647 struct pc87360_data *data = pc87360_update_device(dev);
648 return sprintf(buf, "%u\n", IN_FROM_REG(data->in[attr->index],
649 data->in_vref));
650 }
651 static ssize_t therm_min_show(struct device *dev,
652 struct device_attribute *devattr, char *buf)
653 {
654 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
655 struct pc87360_data *data = pc87360_update_device(dev);
656 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_min[attr->index],
657 data->in_vref));
658 }
659 static ssize_t therm_max_show(struct device *dev,
660 struct device_attribute *devattr, char *buf)
661 {
662 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
663 struct pc87360_data *data = pc87360_update_device(dev);
664 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_max[attr->index],
665 data->in_vref));
666 }
667 static ssize_t therm_crit_show(struct device *dev,
668 struct device_attribute *devattr, char *buf)
669 {
670 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
671 struct pc87360_data *data = pc87360_update_device(dev);
672 return sprintf(buf, "%u\n", IN_FROM_REG(data->in_crit[attr->index-11],
673 data->in_vref));
674 }
675 static ssize_t therm_status_show(struct device *dev,
676 struct device_attribute *devattr, char *buf)
677 {
678 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
679 struct pc87360_data *data = pc87360_update_device(dev);
680 return sprintf(buf, "%u\n", data->in_status[attr->index]);
681 }
682
683 static ssize_t therm_min_store(struct device *dev,
684 struct device_attribute *devattr,
685 const char *buf, size_t count)
686 {
687 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
688 struct pc87360_data *data = dev_get_drvdata(dev);
689 long val;
690 int err;
691
692 err = kstrtol(buf, 10, &val);
693 if (err)
694 return err;
695
696 mutex_lock(&data->update_lock);
697 data->in_min[attr->index] = IN_TO_REG(val, data->in_vref);
698 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_TEMP_MIN,
699 data->in_min[attr->index]);
700 mutex_unlock(&data->update_lock);
701 return count;
702 }
703
704 static ssize_t therm_max_store(struct device *dev,
705 struct device_attribute *devattr,
706 const char *buf, size_t count)
707 {
708 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
709 struct pc87360_data *data = dev_get_drvdata(dev);
710 long val;
711 int err;
712
713 err = kstrtol(buf, 10, &val);
714 if (err)
715 return err;
716
717 mutex_lock(&data->update_lock);
718 data->in_max[attr->index] = IN_TO_REG(val, data->in_vref);
719 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_TEMP_MAX,
720 data->in_max[attr->index]);
721 mutex_unlock(&data->update_lock);
722 return count;
723 }
724 static ssize_t therm_crit_store(struct device *dev,
725 struct device_attribute *devattr,
726 const char *buf, size_t count)
727 {
728 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
729 struct pc87360_data *data = dev_get_drvdata(dev);
730 long val;
731 int err;
732
733 err = kstrtol(buf, 10, &val);
734 if (err)
735 return err;
736
737 mutex_lock(&data->update_lock);
738 data->in_crit[attr->index-11] = IN_TO_REG(val, data->in_vref);
739 pc87360_write_value(data, LD_IN, attr->index, PC87365_REG_TEMP_CRIT,
740 data->in_crit[attr->index-11]);
741 mutex_unlock(&data->update_lock);
742 return count;
743 }
744
745 /*
746 * the +11 term below reflects the fact that VLM units 11,12,13 are
747 * used in the chip to measure voltage across the thermistors
748 */
749 static struct sensor_device_attribute therm_input[] = {
750 SENSOR_ATTR_RO(temp4_input, therm_input, 0 + 11),
751 SENSOR_ATTR_RO(temp5_input, therm_input, 1 + 11),
752 SENSOR_ATTR_RO(temp6_input, therm_input, 2 + 11),
753 };
754 static struct sensor_device_attribute therm_status[] = {
755 SENSOR_ATTR_RO(temp4_status, therm_status, 0 + 11),
756 SENSOR_ATTR_RO(temp5_status, therm_status, 1 + 11),
757 SENSOR_ATTR_RO(temp6_status, therm_status, 2 + 11),
758 };
759 static struct sensor_device_attribute therm_min[] = {
760 SENSOR_ATTR_RW(temp4_min, therm_min, 0 + 11),
761 SENSOR_ATTR_RW(temp5_min, therm_min, 1 + 11),
762 SENSOR_ATTR_RW(temp6_min, therm_min, 2 + 11),
763 };
764 static struct sensor_device_attribute therm_max[] = {
765 SENSOR_ATTR_RW(temp4_max, therm_max, 0 + 11),
766 SENSOR_ATTR_RW(temp5_max, therm_max, 1 + 11),
767 SENSOR_ATTR_RW(temp6_max, therm_max, 2 + 11),
768 };
769 static struct sensor_device_attribute therm_crit[] = {
770 SENSOR_ATTR_RW(temp4_crit, therm_crit, 0 + 11),
771 SENSOR_ATTR_RW(temp5_crit, therm_crit, 1 + 11),
772 SENSOR_ATTR_RW(temp6_crit, therm_crit, 2 + 11),
773 };
774
775 /*
776 * show_therm_min/max_alarm() reads data from the per-channel voltage
777 * status register (sec 11.5.12)
778 */
779
780 static ssize_t therm_min_alarm_show(struct device *dev,
781 struct device_attribute *devattr,
782 char *buf)
783 {
784 struct pc87360_data *data = pc87360_update_device(dev);
785 unsigned nr = to_sensor_dev_attr(devattr)->index;
786
787 return sprintf(buf, "%u\n", !!(data->in_status[nr] & CHAN_ALM_MIN));
788 }
789 static ssize_t therm_max_alarm_show(struct device *dev,
790 struct device_attribute *devattr,
791 char *buf)
792 {
793 struct pc87360_data *data = pc87360_update_device(dev);
794 unsigned nr = to_sensor_dev_attr(devattr)->index;
795
796 return sprintf(buf, "%u\n", !!(data->in_status[nr] & CHAN_ALM_MAX));
797 }
798 static ssize_t therm_crit_alarm_show(struct device *dev,
799 struct device_attribute *devattr,
800 char *buf)
801 {
802 struct pc87360_data *data = pc87360_update_device(dev);
803 unsigned nr = to_sensor_dev_attr(devattr)->index;
804
805 return sprintf(buf, "%u\n", !!(data->in_status[nr] & TEMP_ALM_CRIT));
806 }
807
808 static struct sensor_device_attribute therm_min_alarm[] = {
809 SENSOR_ATTR_RO(temp4_min_alarm, therm_min_alarm, 0 + 11),
810 SENSOR_ATTR_RO(temp5_min_alarm, therm_min_alarm, 1 + 11),
811 SENSOR_ATTR_RO(temp6_min_alarm, therm_min_alarm, 2 + 11),
812 };
813 static struct sensor_device_attribute therm_max_alarm[] = {
814 SENSOR_ATTR_RO(temp4_max_alarm, therm_max_alarm, 0 + 11),
815 SENSOR_ATTR_RO(temp5_max_alarm, therm_max_alarm, 1 + 11),
816 SENSOR_ATTR_RO(temp6_max_alarm, therm_max_alarm, 2 + 11),
817 };
818 static struct sensor_device_attribute therm_crit_alarm[] = {
819 SENSOR_ATTR_RO(temp4_crit_alarm, therm_crit_alarm, 0 + 11),
820 SENSOR_ATTR_RO(temp5_crit_alarm, therm_crit_alarm, 1 + 11),
821 SENSOR_ATTR_RO(temp6_crit_alarm, therm_crit_alarm, 2 + 11),
822 };
823
824 #define THERM_UNIT_ATTRS(X) \
825 &therm_input[X].dev_attr.attr, \
826 &therm_status[X].dev_attr.attr, \
827 &therm_min[X].dev_attr.attr, \
828 &therm_max[X].dev_attr.attr, \
829 &therm_crit[X].dev_attr.attr, \
830 &therm_min_alarm[X].dev_attr.attr, \
831 &therm_max_alarm[X].dev_attr.attr, \
832 &therm_crit_alarm[X].dev_attr.attr
833
834 static struct attribute *pc8736x_therm_attr_array[] = {
835 THERM_UNIT_ATTRS(0),
836 THERM_UNIT_ATTRS(1),
837 THERM_UNIT_ATTRS(2),
838 NULL
839 };
840 static const struct attribute_group pc8736x_therm_group = {
841 .attrs = pc8736x_therm_attr_array,
842 };
843
844 static ssize_t temp_input_show(struct device *dev,
845 struct device_attribute *devattr, char *buf)
846 {
847 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
848 struct pc87360_data *data = pc87360_update_device(dev);
849 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[attr->index]));
850 }
851
852 static ssize_t temp_min_show(struct device *dev,
853 struct device_attribute *devattr, char *buf)
854 {
855 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
856 struct pc87360_data *data = pc87360_update_device(dev);
857 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[attr->index]));
858 }
859
860 static ssize_t temp_max_show(struct device *dev,
861 struct device_attribute *devattr, char *buf)
862 {
863 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
864 struct pc87360_data *data = pc87360_update_device(dev);
865 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[attr->index]));
866 }
867
868 static ssize_t temp_crit_show(struct device *dev,
869 struct device_attribute *devattr, char *buf)
870 {
871 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
872 struct pc87360_data *data = pc87360_update_device(dev);
873 return sprintf(buf, "%d\n",
874 TEMP_FROM_REG(data->temp_crit[attr->index]));
875 }
876
877 static ssize_t temp_status_show(struct device *dev,
878 struct device_attribute *devattr, char *buf)
879 {
880 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
881 struct pc87360_data *data = pc87360_update_device(dev);
882 return sprintf(buf, "%d\n", data->temp_status[attr->index]);
883 }
884
885 static ssize_t temp_min_store(struct device *dev,
886 struct device_attribute *devattr,
887 const char *buf, size_t count)
888 {
889 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
890 struct pc87360_data *data = dev_get_drvdata(dev);
891 long val;
892 int err;
893
894 err = kstrtol(buf, 10, &val);
895 if (err)
896 return err;
897
898 mutex_lock(&data->update_lock);
899 data->temp_min[attr->index] = TEMP_TO_REG(val);
900 pc87360_write_value(data, LD_TEMP, attr->index, PC87365_REG_TEMP_MIN,
901 data->temp_min[attr->index]);
902 mutex_unlock(&data->update_lock);
903 return count;
904 }
905
906 static ssize_t temp_max_store(struct device *dev,
907 struct device_attribute *devattr,
908 const char *buf, size_t count)
909 {
910 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
911 struct pc87360_data *data = dev_get_drvdata(dev);
912 long val;
913 int err;
914
915 err = kstrtol(buf, 10, &val);
916 if (err)
917 return err;
918
919 mutex_lock(&data->update_lock);
920 data->temp_max[attr->index] = TEMP_TO_REG(val);
921 pc87360_write_value(data, LD_TEMP, attr->index, PC87365_REG_TEMP_MAX,
922 data->temp_max[attr->index]);
923 mutex_unlock(&data->update_lock);
924 return count;
925 }
926
927 static ssize_t temp_crit_store(struct device *dev,
928 struct device_attribute *devattr,
929 const char *buf, size_t count)
930 {
931 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
932 struct pc87360_data *data = dev_get_drvdata(dev);
933 long val;
934 int err;
935
936 err = kstrtol(buf, 10, &val);
937 if (err)
938 return err;
939
940 mutex_lock(&data->update_lock);
941 data->temp_crit[attr->index] = TEMP_TO_REG(val);
942 pc87360_write_value(data, LD_TEMP, attr->index, PC87365_REG_TEMP_CRIT,
943 data->temp_crit[attr->index]);
944 mutex_unlock(&data->update_lock);
945 return count;
946 }
947
948 static struct sensor_device_attribute temp_input[] = {
949 SENSOR_ATTR_RO(temp1_input, temp_input, 0),
950 SENSOR_ATTR_RO(temp2_input, temp_input, 1),
951 SENSOR_ATTR_RO(temp3_input, temp_input, 2),
952 };
953 static struct sensor_device_attribute temp_status[] = {
954 SENSOR_ATTR_RO(temp1_status, temp_status, 0),
955 SENSOR_ATTR_RO(temp2_status, temp_status, 1),
956 SENSOR_ATTR_RO(temp3_status, temp_status, 2),
957 };
958 static struct sensor_device_attribute temp_min[] = {
959 SENSOR_ATTR_RW(temp1_min, temp_min, 0),
960 SENSOR_ATTR_RW(temp2_min, temp_min, 1),
961 SENSOR_ATTR_RW(temp3_min, temp_min, 2),
962 };
963 static struct sensor_device_attribute temp_max[] = {
964 SENSOR_ATTR_RW(temp1_max, temp_max, 0),
965 SENSOR_ATTR_RW(temp2_max, temp_max, 1),
966 SENSOR_ATTR_RW(temp3_max, temp_max, 2),
967 };
968 static struct sensor_device_attribute temp_crit[] = {
969 SENSOR_ATTR_RW(temp1_crit, temp_crit, 0),
970 SENSOR_ATTR_RW(temp2_crit, temp_crit, 1),
971 SENSOR_ATTR_RW(temp3_crit, temp_crit, 2),
972 };
973
974 static ssize_t alarms_temp_show(struct device *dev,
975 struct device_attribute *attr, char *buf)
976 {
977 struct pc87360_data *data = pc87360_update_device(dev);
978 return sprintf(buf, "%u\n", data->temp_alarms);
979 }
980
981 static DEVICE_ATTR_RO(alarms_temp);
982
983 /*
984 * show_temp_min/max_alarm() reads data from the per-channel status
985 * register (sec 12.3.7), not the temp event status registers (sec
986 * 12.3.2) that show_temp_alarm() reads (via data->temp_alarms)
987 */
988
989 static ssize_t temp_min_alarm_show(struct device *dev,
990 struct device_attribute *devattr,
991 char *buf)
992 {
993 struct pc87360_data *data = pc87360_update_device(dev);
994 unsigned nr = to_sensor_dev_attr(devattr)->index;
995
996 return sprintf(buf, "%u\n", !!(data->temp_status[nr] & CHAN_ALM_MIN));
997 }
998
999 static ssize_t temp_max_alarm_show(struct device *dev,
1000 struct device_attribute *devattr,
1001 char *buf)
1002 {
1003 struct pc87360_data *data = pc87360_update_device(dev);
1004 unsigned nr = to_sensor_dev_attr(devattr)->index;
1005
1006 return sprintf(buf, "%u\n", !!(data->temp_status[nr] & CHAN_ALM_MAX));
1007 }
1008
1009 static ssize_t temp_crit_alarm_show(struct device *dev,
1010 struct device_attribute *devattr,
1011 char *buf)
1012 {
1013 struct pc87360_data *data = pc87360_update_device(dev);
1014 unsigned nr = to_sensor_dev_attr(devattr)->index;
1015
1016 return sprintf(buf, "%u\n", !!(data->temp_status[nr] & TEMP_ALM_CRIT));
1017 }
1018
1019 static struct sensor_device_attribute temp_min_alarm[] = {
1020 SENSOR_ATTR_RO(temp1_min_alarm, temp_min_alarm, 0),
1021 SENSOR_ATTR_RO(temp2_min_alarm, temp_min_alarm, 1),
1022 SENSOR_ATTR_RO(temp3_min_alarm, temp_min_alarm, 2),
1023 };
1024
1025 static struct sensor_device_attribute temp_max_alarm[] = {
1026 SENSOR_ATTR_RO(temp1_max_alarm, temp_max_alarm, 0),
1027 SENSOR_ATTR_RO(temp2_max_alarm, temp_max_alarm, 1),
1028 SENSOR_ATTR_RO(temp3_max_alarm, temp_max_alarm, 2),
1029 };
1030
1031 static struct sensor_device_attribute temp_crit_alarm[] = {
1032 SENSOR_ATTR_RO(temp1_crit_alarm, temp_crit_alarm, 0),
1033 SENSOR_ATTR_RO(temp2_crit_alarm, temp_crit_alarm, 1),
1034 SENSOR_ATTR_RO(temp3_crit_alarm, temp_crit_alarm, 2),
1035 };
1036
1037 #define TEMP_FAULT 0x40 /* open diode */
1038 static ssize_t temp_fault_show(struct device *dev,
1039 struct device_attribute *devattr, char *buf)
1040 {
1041 struct pc87360_data *data = pc87360_update_device(dev);
1042 unsigned nr = to_sensor_dev_attr(devattr)->index;
1043
1044 return sprintf(buf, "%u\n", !!(data->temp_status[nr] & TEMP_FAULT));
1045 }
1046 static struct sensor_device_attribute temp_fault[] = {
1047 SENSOR_ATTR_RO(temp1_fault, temp_fault, 0),
1048 SENSOR_ATTR_RO(temp2_fault, temp_fault, 1),
1049 SENSOR_ATTR_RO(temp3_fault, temp_fault, 2),
1050 };
1051
1052 #define TEMP_UNIT_ATTRS(X) \
1053 { &temp_input[X].dev_attr.attr, \
1054 &temp_status[X].dev_attr.attr, \
1055 &temp_min[X].dev_attr.attr, \
1056 &temp_max[X].dev_attr.attr, \
1057 &temp_crit[X].dev_attr.attr, \
1058 &temp_min_alarm[X].dev_attr.attr, \
1059 &temp_max_alarm[X].dev_attr.attr, \
1060 &temp_crit_alarm[X].dev_attr.attr, \
1061 &temp_fault[X].dev_attr.attr, \
1062 NULL \
1063 }
1064
1065 static struct attribute *pc8736x_temp_attr[][10] = {
1066 TEMP_UNIT_ATTRS(0),
1067 TEMP_UNIT_ATTRS(1),
1068 TEMP_UNIT_ATTRS(2)
1069 };
1070
1071 static const struct attribute_group pc8736x_temp_attr_group[] = {
1072 { .attrs = pc8736x_temp_attr[0] },
1073 { .attrs = pc8736x_temp_attr[1] },
1074 { .attrs = pc8736x_temp_attr[2] }
1075 };
1076
1077 static ssize_t name_show(struct device *dev,
1078 struct device_attribute *devattr, char *buf)
1079 {
1080 struct pc87360_data *data = dev_get_drvdata(dev);
1081 return sprintf(buf, "%s\n", data->name);
1082 }
1083
1084 static DEVICE_ATTR_RO(name);
1085
1086 /*
1087 * Device detection, registration and update
1088 */
1089
1090 static int __init pc87360_find(int sioaddr, u8 *devid,
1091 unsigned short *addresses)
1092 {
1093 u16 val;
1094 int i;
1095 int nrdev; /* logical device count */
1096
1097 /* No superio_enter */
1098
1099 /* Identify device */
1100 val = force_id ? force_id : superio_inb(sioaddr, DEVID);
1101 switch (val) {
1102 case 0xE1: /* PC87360 */
1103 case 0xE8: /* PC87363 */
1104 case 0xE4: /* PC87364 */
1105 nrdev = 1;
1106 break;
1107 case 0xE5: /* PC87365 */
1108 case 0xE9: /* PC87366 */
1109 nrdev = 3;
1110 break;
1111 default:
1112 superio_exit(sioaddr);
1113 return -ENODEV;
1114 }
1115 /* Remember the device id */
1116 *devid = val;
1117
1118 for (i = 0; i < nrdev; i++) {
1119 /* select logical device */
1120 superio_outb(sioaddr, DEV, logdev[i]);
1121
1122 val = superio_inb(sioaddr, ACT);
1123 if (!(val & 0x01)) {
1124 pr_info("Device 0x%02x not activated\n", logdev[i]);
1125 continue;
1126 }
1127
1128 val = (superio_inb(sioaddr, BASE) << 8)
1129 | superio_inb(sioaddr, BASE + 1);
1130 if (!val) {
1131 pr_info("Base address not set for device 0x%02x\n",
1132 logdev[i]);
1133 continue;
1134 }
1135
1136 addresses[i] = val;
1137
1138 if (i == 0) { /* Fans */
1139 confreg[0] = superio_inb(sioaddr, 0xF0);
1140 confreg[1] = superio_inb(sioaddr, 0xF1);
1141
1142 pr_debug("Fan %d: mon=%d ctrl=%d inv=%d\n", 1,
1143 (confreg[0] >> 2) & 1, (confreg[0] >> 3) & 1,
1144 (confreg[0] >> 4) & 1);
1145 pr_debug("Fan %d: mon=%d ctrl=%d inv=%d\n", 2,
1146 (confreg[0] >> 5) & 1, (confreg[0] >> 6) & 1,
1147 (confreg[0] >> 7) & 1);
1148 pr_debug("Fan %d: mon=%d ctrl=%d inv=%d\n", 3,
1149 confreg[1] & 1, (confreg[1] >> 1) & 1,
1150 (confreg[1] >> 2) & 1);
1151 } else if (i == 1) { /* Voltages */
1152 /* Are we using thermistors? */
1153 if (*devid == 0xE9) { /* PC87366 */
1154 /*
1155 * These registers are not logical-device
1156 * specific, just that we won't need them if
1157 * we don't use the VLM device
1158 */
1159 confreg[2] = superio_inb(sioaddr, 0x2B);
1160 confreg[3] = superio_inb(sioaddr, 0x25);
1161
1162 if (confreg[2] & 0x40) {
1163 pr_info("Using thermistors for temperature monitoring\n");
1164 }
1165 if (confreg[3] & 0xE0) {
1166 pr_info("VID inputs routed (mode %u)\n",
1167 confreg[3] >> 5);
1168 }
1169 }
1170 }
1171 }
1172
1173 superio_exit(sioaddr);
1174 return 0;
1175 }
1176
1177 static void pc87360_remove_files(struct device *dev)
1178 {
1179 int i;
1180
1181 device_remove_file(dev, &dev_attr_name);
1182 device_remove_file(dev, &dev_attr_alarms_temp);
1183 for (i = 0; i < ARRAY_SIZE(pc8736x_temp_attr_group); i++)
1184 sysfs_remove_group(&dev->kobj, &pc8736x_temp_attr_group[i]);
1185 for (i = 0; i < ARRAY_SIZE(pc8736x_fan_attr_group); i++) {
1186 sysfs_remove_group(&pdev->dev.kobj, &pc8736x_fan_attr_group[i]);
1187 device_remove_file(dev, &pwm[i].dev_attr);
1188 }
1189 sysfs_remove_group(&dev->kobj, &pc8736x_therm_group);
1190 sysfs_remove_group(&dev->kobj, &pc8736x_vin_group);
1191 }
1192
1193 static int pc87360_probe(struct platform_device *pdev)
1194 {
1195 int i;
1196 struct pc87360_data *data;
1197 int err = 0;
1198 const char *name;
1199 int use_thermistors = 0;
1200 struct device *dev = &pdev->dev;
1201
1202 data = devm_kzalloc(dev, sizeof(struct pc87360_data), GFP_KERNEL);
1203 if (!data)
1204 return -ENOMEM;
1205
1206 switch (devid) {
1207 default:
1208 name = "pc87360";
1209 data->fannr = 2;
1210 break;
1211 case 0xe8:
1212 name = "pc87363";
1213 data->fannr = 2;
1214 break;
1215 case 0xe4:
1216 name = "pc87364";
1217 data->fannr = 3;
1218 break;
1219 case 0xe5:
1220 name = "pc87365";
1221 data->fannr = extra_isa[0] ? 3 : 0;
1222 data->innr = extra_isa[1] ? 11 : 0;
1223 data->tempnr = extra_isa[2] ? 2 : 0;
1224 break;
1225 case 0xe9:
1226 name = "pc87366";
1227 data->fannr = extra_isa[0] ? 3 : 0;
1228 data->innr = extra_isa[1] ? 14 : 0;
1229 data->tempnr = extra_isa[2] ? 3 : 0;
1230 break;
1231 }
1232
1233 data->name = name;
1234 mutex_init(&data->lock);
1235 mutex_init(&data->update_lock);
1236 platform_set_drvdata(pdev, data);
1237
1238 for (i = 0; i < LDNI_MAX; i++) {
1239 data->address[i] = extra_isa[i];
1240 if (data->address[i]
1241 && !devm_request_region(dev, extra_isa[i], PC87360_EXTENT,
1242 pc87360_driver.driver.name)) {
1243 dev_err(dev,
1244 "Region 0x%x-0x%x already in use!\n",
1245 extra_isa[i], extra_isa[i]+PC87360_EXTENT-1);
1246 return -EBUSY;
1247 }
1248 }
1249
1250 /* Retrieve the fans configuration from Super-I/O space */
1251 if (data->fannr)
1252 data->fan_conf = confreg[0] | (confreg[1] << 8);
1253
1254 /*
1255 * Use the correct reference voltage
1256 * Unless both the VLM and the TMS logical devices agree to
1257 * use an external Vref, the internal one is used.
1258 */
1259 if (data->innr) {
1260 i = pc87360_read_value(data, LD_IN, NO_BANK,
1261 PC87365_REG_IN_CONFIG);
1262 if (data->tempnr) {
1263 i &= pc87360_read_value(data, LD_TEMP, NO_BANK,
1264 PC87365_REG_TEMP_CONFIG);
1265 }
1266 data->in_vref = (i&0x02) ? 3025 : 2966;
1267 dev_dbg(dev, "Using %s reference voltage\n",
1268 (i&0x02) ? "external" : "internal");
1269
1270 data->vid_conf = confreg[3];
1271 data->vrm = vid_which_vrm();
1272 }
1273
1274 /* Fan clock dividers may be needed before any data is read */
1275 for (i = 0; i < data->fannr; i++) {
1276 if (FAN_CONFIG_MONITOR(data->fan_conf, i))
1277 data->fan_status[i] = pc87360_read_value(data,
1278 LD_FAN, NO_BANK,
1279 PC87360_REG_FAN_STATUS(i));
1280 }
1281
1282 if (init > 0) {
1283 if (devid == 0xe9 && data->address[1]) /* PC87366 */
1284 use_thermistors = confreg[2] & 0x40;
1285
1286 pc87360_init_device(pdev, use_thermistors);
1287 }
1288
1289 /* Register all-or-nothing sysfs groups */
1290
1291 if (data->innr) {
1292 err = sysfs_create_group(&dev->kobj, &pc8736x_vin_group);
1293 if (err)
1294 goto error;
1295 }
1296
1297 if (data->innr == 14) {
1298 err = sysfs_create_group(&dev->kobj, &pc8736x_therm_group);
1299 if (err)
1300 goto error;
1301 }
1302
1303 /* create device attr-files for varying sysfs groups */
1304
1305 if (data->tempnr) {
1306 for (i = 0; i < data->tempnr; i++) {
1307 err = sysfs_create_group(&dev->kobj,
1308 &pc8736x_temp_attr_group[i]);
1309 if (err)
1310 goto error;
1311 }
1312 err = device_create_file(dev, &dev_attr_alarms_temp);
1313 if (err)
1314 goto error;
1315 }
1316
1317 for (i = 0; i < data->fannr; i++) {
1318 if (FAN_CONFIG_MONITOR(data->fan_conf, i)) {
1319 err = sysfs_create_group(&dev->kobj,
1320 &pc8736x_fan_attr_group[i]);
1321 if (err)
1322 goto error;
1323 }
1324 if (FAN_CONFIG_CONTROL(data->fan_conf, i)) {
1325 err = device_create_file(dev, &pwm[i].dev_attr);
1326 if (err)
1327 goto error;
1328 }
1329 }
1330
1331 err = device_create_file(dev, &dev_attr_name);
1332 if (err)
1333 goto error;
1334
1335 data->hwmon_dev = hwmon_device_register(dev);
1336 if (IS_ERR(data->hwmon_dev)) {
1337 err = PTR_ERR(data->hwmon_dev);
1338 goto error;
1339 }
1340 return 0;
1341
1342 error:
1343 pc87360_remove_files(dev);
1344 return err;
1345 }
1346
1347 static int pc87360_remove(struct platform_device *pdev)
1348 {
1349 struct pc87360_data *data = platform_get_drvdata(pdev);
1350
1351 hwmon_device_unregister(data->hwmon_dev);
1352 pc87360_remove_files(&pdev->dev);
1353
1354 return 0;
1355 }
1356
1357 /*
1358 * ldi is the logical device index
1359 * bank is for voltages and temperatures only
1360 */
1361 static int pc87360_read_value(struct pc87360_data *data, u8 ldi, u8 bank,
1362 u8 reg)
1363 {
1364 int res;
1365
1366 mutex_lock(&(data->lock));
1367 if (bank != NO_BANK)
1368 outb_p(bank, data->address[ldi] + PC87365_REG_BANK);
1369 res = inb_p(data->address[ldi] + reg);
1370 mutex_unlock(&(data->lock));
1371
1372 return res;
1373 }
1374
1375 static void pc87360_write_value(struct pc87360_data *data, u8 ldi, u8 bank,
1376 u8 reg, u8 value)
1377 {
1378 mutex_lock(&(data->lock));
1379 if (bank != NO_BANK)
1380 outb_p(bank, data->address[ldi] + PC87365_REG_BANK);
1381 outb_p(value, data->address[ldi] + reg);
1382 mutex_unlock(&(data->lock));
1383 }
1384
1385 /* (temp & vin) channel conversion status register flags (pdf sec.11.5.12) */
1386 #define CHAN_CNVRTD 0x80 /* new data ready */
1387 #define CHAN_ENA 0x01 /* enabled channel (temp or vin) */
1388 #define CHAN_ALM_ENA 0x10 /* propagate to alarms-reg ?? (chk val!) */
1389 #define CHAN_READY (CHAN_ENA|CHAN_CNVRTD) /* sample ready mask */
1390
1391 #define TEMP_OTS_OE 0x20 /* OTS Output Enable */
1392 #define VIN_RW1C_MASK (CHAN_READY|CHAN_ALM_MAX|CHAN_ALM_MIN) /* 0x87 */
1393 #define TEMP_RW1C_MASK (VIN_RW1C_MASK|TEMP_ALM_CRIT|TEMP_FAULT) /* 0xCF */
1394
1395 static void pc87360_init_device(struct platform_device *pdev,
1396 int use_thermistors)
1397 {
1398 struct pc87360_data *data = platform_get_drvdata(pdev);
1399 int i, nr;
1400 const u8 init_in[14] = { 2, 2, 2, 2, 2, 2, 2, 1, 1, 3, 1, 2, 2, 2 };
1401 const u8 init_temp[3] = { 2, 2, 1 };
1402 u8 reg;
1403
1404 if (init >= 2 && data->innr) {
1405 reg = pc87360_read_value(data, LD_IN, NO_BANK,
1406 PC87365_REG_IN_CONVRATE);
1407 dev_info(&pdev->dev,
1408 "VLM conversion set to 1s period, 160us delay\n");
1409 pc87360_write_value(data, LD_IN, NO_BANK,
1410 PC87365_REG_IN_CONVRATE,
1411 (reg & 0xC0) | 0x11);
1412 }
1413
1414 nr = data->innr < 11 ? data->innr : 11;
1415 for (i = 0; i < nr; i++) {
1416 reg = pc87360_read_value(data, LD_IN, i,
1417 PC87365_REG_IN_STATUS);
1418 dev_dbg(&pdev->dev, "bios in%d status:0x%02x\n", i, reg);
1419 if (init >= init_in[i]) {
1420 /* Forcibly enable voltage channel */
1421 if (!(reg & CHAN_ENA)) {
1422 dev_dbg(&pdev->dev, "Forcibly enabling in%d\n",
1423 i);
1424 pc87360_write_value(data, LD_IN, i,
1425 PC87365_REG_IN_STATUS,
1426 (reg & 0x68) | 0x87);
1427 }
1428 }
1429 }
1430
1431 /*
1432 * We can't blindly trust the Super-I/O space configuration bit,
1433 * most BIOS won't set it properly
1434 */
1435 dev_dbg(&pdev->dev, "bios thermistors:%d\n", use_thermistors);
1436 for (i = 11; i < data->innr; i++) {
1437 reg = pc87360_read_value(data, LD_IN, i,
1438 PC87365_REG_TEMP_STATUS);
1439 use_thermistors = use_thermistors || (reg & CHAN_ENA);
1440 /* thermistors are temp[4-6], measured on vin[11-14] */
1441 dev_dbg(&pdev->dev, "bios temp%d_status:0x%02x\n", i-7, reg);
1442 }
1443 dev_dbg(&pdev->dev, "using thermistors:%d\n", use_thermistors);
1444
1445 i = use_thermistors ? 2 : 0;
1446 for (; i < data->tempnr; i++) {
1447 reg = pc87360_read_value(data, LD_TEMP, i,
1448 PC87365_REG_TEMP_STATUS);
1449 dev_dbg(&pdev->dev, "bios temp%d_status:0x%02x\n", i + 1, reg);
1450 if (init >= init_temp[i]) {
1451 /* Forcibly enable temperature channel */
1452 if (!(reg & CHAN_ENA)) {
1453 dev_dbg(&pdev->dev,
1454 "Forcibly enabling temp%d\n", i + 1);
1455 pc87360_write_value(data, LD_TEMP, i,
1456 PC87365_REG_TEMP_STATUS,
1457 0xCF);
1458 }
1459 }
1460 }
1461
1462 if (use_thermistors) {
1463 for (i = 11; i < data->innr; i++) {
1464 if (init >= init_in[i]) {
1465 /*
1466 * The pin may already be used by thermal
1467 * diodes
1468 */
1469 reg = pc87360_read_value(data, LD_TEMP,
1470 (i - 11) / 2, PC87365_REG_TEMP_STATUS);
1471 if (reg & CHAN_ENA) {
1472 dev_dbg(&pdev->dev,
1473 "Skipping temp%d, pin already in use by temp%d\n",
1474 i - 7, (i - 11) / 2);
1475 continue;
1476 }
1477
1478 /* Forcibly enable thermistor channel */
1479 reg = pc87360_read_value(data, LD_IN, i,
1480 PC87365_REG_IN_STATUS);
1481 if (!(reg & CHAN_ENA)) {
1482 dev_dbg(&pdev->dev,
1483 "Forcibly enabling temp%d\n",
1484 i - 7);
1485 pc87360_write_value(data, LD_IN, i,
1486 PC87365_REG_TEMP_STATUS,
1487 (reg & 0x60) | 0x8F);
1488 }
1489 }
1490 }
1491 }
1492
1493 if (data->innr) {
1494 reg = pc87360_read_value(data, LD_IN, NO_BANK,
1495 PC87365_REG_IN_CONFIG);
1496 dev_dbg(&pdev->dev, "bios vin-cfg:0x%02x\n", reg);
1497 if (reg & CHAN_ENA) {
1498 dev_dbg(&pdev->dev,
1499 "Forcibly enabling monitoring (VLM)\n");
1500 pc87360_write_value(data, LD_IN, NO_BANK,
1501 PC87365_REG_IN_CONFIG,
1502 reg & 0xFE);
1503 }
1504 }
1505
1506 if (data->tempnr) {
1507 reg = pc87360_read_value(data, LD_TEMP, NO_BANK,
1508 PC87365_REG_TEMP_CONFIG);
1509 dev_dbg(&pdev->dev, "bios temp-cfg:0x%02x\n", reg);
1510 if (reg & CHAN_ENA) {
1511 dev_dbg(&pdev->dev,
1512 "Forcibly enabling monitoring (TMS)\n");
1513 pc87360_write_value(data, LD_TEMP, NO_BANK,
1514 PC87365_REG_TEMP_CONFIG,
1515 reg & 0xFE);
1516 }
1517
1518 if (init >= 2) {
1519 /* Chip config as documented by National Semi. */
1520 pc87360_write_value(data, LD_TEMP, 0xF, 0xA, 0x08);
1521 /*
1522 * We voluntarily omit the bank here, in case the
1523 * sequence itself matters. It shouldn't be a problem,
1524 * since nobody else is supposed to access the
1525 * device at that point.
1526 */
1527 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xB, 0x04);
1528 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xC, 0x35);
1529 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xD, 0x05);
1530 pc87360_write_value(data, LD_TEMP, NO_BANK, 0xE, 0x05);
1531 }
1532 }
1533 }
1534
1535 static void pc87360_autodiv(struct device *dev, int nr)
1536 {
1537 struct pc87360_data *data = dev_get_drvdata(dev);
1538 u8 old_min = data->fan_min[nr];
1539
1540 /* Increase clock divider if needed and possible */
1541 if ((data->fan_status[nr] & 0x04) /* overflow flag */
1542 || (data->fan[nr] >= 224)) { /* next to overflow */
1543 if ((data->fan_status[nr] & 0x60) != 0x60) {
1544 data->fan_status[nr] += 0x20;
1545 data->fan_min[nr] >>= 1;
1546 data->fan[nr] >>= 1;
1547 dev_dbg(dev,
1548 "Increasing clock divider to %d for fan %d\n",
1549 FAN_DIV_FROM_REG(data->fan_status[nr]), nr + 1);
1550 }
1551 } else {
1552 /* Decrease clock divider if possible */
1553 while (!(data->fan_min[nr] & 0x80) /* min "nails" divider */
1554 && data->fan[nr] < 85 /* bad accuracy */
1555 && (data->fan_status[nr] & 0x60) != 0x00) {
1556 data->fan_status[nr] -= 0x20;
1557 data->fan_min[nr] <<= 1;
1558 data->fan[nr] <<= 1;
1559 dev_dbg(dev,
1560 "Decreasing clock divider to %d for fan %d\n",
1561 FAN_DIV_FROM_REG(data->fan_status[nr]),
1562 nr + 1);
1563 }
1564 }
1565
1566 /* Write new fan min if it changed */
1567 if (old_min != data->fan_min[nr]) {
1568 pc87360_write_value(data, LD_FAN, NO_BANK,
1569 PC87360_REG_FAN_MIN(nr),
1570 data->fan_min[nr]);
1571 }
1572 }
1573
1574 static struct pc87360_data *pc87360_update_device(struct device *dev)
1575 {
1576 struct pc87360_data *data = dev_get_drvdata(dev);
1577 u8 i;
1578
1579 mutex_lock(&data->update_lock);
1580
1581 if (time_after(jiffies, data->last_updated + HZ * 2) || !data->valid) {
1582 dev_dbg(dev, "Data update\n");
1583
1584 /* Fans */
1585 for (i = 0; i < data->fannr; i++) {
1586 if (FAN_CONFIG_MONITOR(data->fan_conf, i)) {
1587 data->fan_status[i] =
1588 pc87360_read_value(data, LD_FAN,
1589 NO_BANK, PC87360_REG_FAN_STATUS(i));
1590 data->fan[i] = pc87360_read_value(data, LD_FAN,
1591 NO_BANK, PC87360_REG_FAN(i));
1592 data->fan_min[i] = pc87360_read_value(data,
1593 LD_FAN, NO_BANK,
1594 PC87360_REG_FAN_MIN(i));
1595 /* Change clock divider if needed */
1596 pc87360_autodiv(dev, i);
1597 /* Clear bits and write new divider */
1598 pc87360_write_value(data, LD_FAN, NO_BANK,
1599 PC87360_REG_FAN_STATUS(i),
1600 data->fan_status[i]);
1601 }
1602 if (FAN_CONFIG_CONTROL(data->fan_conf, i))
1603 data->pwm[i] = pc87360_read_value(data, LD_FAN,
1604 NO_BANK, PC87360_REG_PWM(i));
1605 }
1606
1607 /* Voltages */
1608 for (i = 0; i < data->innr; i++) {
1609 data->in_status[i] = pc87360_read_value(data, LD_IN, i,
1610 PC87365_REG_IN_STATUS);
1611 /* Clear bits */
1612 pc87360_write_value(data, LD_IN, i,
1613 PC87365_REG_IN_STATUS,
1614 data->in_status[i]);
1615 if ((data->in_status[i] & CHAN_READY) == CHAN_READY) {
1616 data->in[i] = pc87360_read_value(data, LD_IN,
1617 i, PC87365_REG_IN);
1618 }
1619 if (data->in_status[i] & CHAN_ENA) {
1620 data->in_min[i] = pc87360_read_value(data,
1621 LD_IN, i,
1622 PC87365_REG_IN_MIN);
1623 data->in_max[i] = pc87360_read_value(data,
1624 LD_IN, i,
1625 PC87365_REG_IN_MAX);
1626 if (i >= 11)
1627 data->in_crit[i-11] =
1628 pc87360_read_value(data, LD_IN,
1629 i, PC87365_REG_TEMP_CRIT);
1630 }
1631 }
1632 if (data->innr) {
1633 data->in_alarms = pc87360_read_value(data, LD_IN,
1634 NO_BANK, PC87365_REG_IN_ALARMS1)
1635 | ((pc87360_read_value(data, LD_IN,
1636 NO_BANK, PC87365_REG_IN_ALARMS2)
1637 & 0x07) << 8);
1638 data->vid = (data->vid_conf & 0xE0) ?
1639 pc87360_read_value(data, LD_IN,
1640 NO_BANK, PC87365_REG_VID) : 0x1F;
1641 }
1642
1643 /* Temperatures */
1644 for (i = 0; i < data->tempnr; i++) {
1645 data->temp_status[i] = pc87360_read_value(data,
1646 LD_TEMP, i,
1647 PC87365_REG_TEMP_STATUS);
1648 /* Clear bits */
1649 pc87360_write_value(data, LD_TEMP, i,
1650 PC87365_REG_TEMP_STATUS,
1651 data->temp_status[i]);
1652 if ((data->temp_status[i] & CHAN_READY) == CHAN_READY) {
1653 data->temp[i] = pc87360_read_value(data,
1654 LD_TEMP, i,
1655 PC87365_REG_TEMP);
1656 }
1657 if (data->temp_status[i] & CHAN_ENA) {
1658 data->temp_min[i] = pc87360_read_value(data,
1659 LD_TEMP, i,
1660 PC87365_REG_TEMP_MIN);
1661 data->temp_max[i] = pc87360_read_value(data,
1662 LD_TEMP, i,
1663 PC87365_REG_TEMP_MAX);
1664 data->temp_crit[i] = pc87360_read_value(data,
1665 LD_TEMP, i,
1666 PC87365_REG_TEMP_CRIT);
1667 }
1668 }
1669 if (data->tempnr) {
1670 data->temp_alarms = pc87360_read_value(data, LD_TEMP,
1671 NO_BANK, PC87365_REG_TEMP_ALARMS)
1672 & 0x3F;
1673 }
1674
1675 data->last_updated = jiffies;
1676 data->valid = 1;
1677 }
1678
1679 mutex_unlock(&data->update_lock);
1680
1681 return data;
1682 }
1683
1684 static int __init pc87360_device_add(unsigned short address)
1685 {
1686 struct resource res[3];
1687 int err, i, res_count;
1688
1689 pdev = platform_device_alloc("pc87360", address);
1690 if (!pdev) {
1691 err = -ENOMEM;
1692 pr_err("Device allocation failed\n");
1693 goto exit;
1694 }
1695
1696 memset(res, 0, 3 * sizeof(struct resource));
1697 res_count = 0;
1698 for (i = 0; i < 3; i++) {
1699 if (!extra_isa[i])
1700 continue;
1701 res[res_count].start = extra_isa[i];
1702 res[res_count].end = extra_isa[i] + PC87360_EXTENT - 1;
1703 res[res_count].name = "pc87360",
1704 res[res_count].flags = IORESOURCE_IO,
1705
1706 err = acpi_check_resource_conflict(&res[res_count]);
1707 if (err)
1708 goto exit_device_put;
1709
1710 res_count++;
1711 }
1712
1713 err = platform_device_add_resources(pdev, res, res_count);
1714 if (err) {
1715 pr_err("Device resources addition failed (%d)\n", err);
1716 goto exit_device_put;
1717 }
1718
1719 err = platform_device_add(pdev);
1720 if (err) {
1721 pr_err("Device addition failed (%d)\n", err);
1722 goto exit_device_put;
1723 }
1724
1725 return 0;
1726
1727 exit_device_put:
1728 platform_device_put(pdev);
1729 exit:
1730 return err;
1731 }
1732
1733 static int __init pc87360_init(void)
1734 {
1735 int err, i;
1736 unsigned short address = 0;
1737
1738 if (pc87360_find(0x2e, &devid, extra_isa)
1739 && pc87360_find(0x4e, &devid, extra_isa)) {
1740 pr_warn("PC8736x not detected, module not inserted\n");
1741 return -ENODEV;
1742 }
1743
1744 /* Arbitrarily pick one of the addresses */
1745 for (i = 0; i < 3; i++) {
1746 if (extra_isa[i] != 0x0000) {
1747 address = extra_isa[i];
1748 break;
1749 }
1750 }
1751
1752 if (address == 0x0000) {
1753 pr_warn("No active logical device, module not inserted\n");
1754 return -ENODEV;
1755 }
1756
1757 err = platform_driver_register(&pc87360_driver);
1758 if (err)
1759 goto exit;
1760
1761 /* Sets global pdev as a side effect */
1762 err = pc87360_device_add(address);
1763 if (err)
1764 goto exit_driver;
1765
1766 return 0;
1767
1768 exit_driver:
1769 platform_driver_unregister(&pc87360_driver);
1770 exit:
1771 return err;
1772 }
1773
1774 static void __exit pc87360_exit(void)
1775 {
1776 platform_device_unregister(pdev);
1777 platform_driver_unregister(&pc87360_driver);
1778 }
1779
1780
1781 MODULE_AUTHOR("Jean Delvare <jdelvare@suse.de>");
1782 MODULE_DESCRIPTION("PC8736x hardware monitor");
1783 MODULE_LICENSE("GPL");
1784
1785 module_init(pc87360_init);
1786 module_exit(pc87360_exit);
Linux with added FPC-III support