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