1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * pc87427.c - hardware monitoring driver for the |
4 | * National Semiconductor PC87427 Super-I/O chip |
5 | * Copyright (C) 2006, 2008, 2010 Jean Delvare <jdelvare@suse.de> |
6 | * |
7 | * Supports the following chips: |
8 | * |
9 | * Chip #vin #fan #pwm #temp devid |
10 | * PC87427 - 8 4 6 0xF2 |
11 | * |
12 | * This driver assumes that no more than one chip is present. |
13 | * Only fans are fully supported so far. Temperatures are in read-only |
14 | * mode, and voltages aren't supported at all. |
15 | */ |
16 | |
17 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
18 | |
19 | #include <linux/module.h> |
20 | #include <linux/init.h> |
21 | #include <linux/slab.h> |
22 | #include <linux/jiffies.h> |
23 | #include <linux/platform_device.h> |
24 | #include <linux/hwmon.h> |
25 | #include <linux/hwmon-sysfs.h> |
26 | #include <linux/err.h> |
27 | #include <linux/mutex.h> |
28 | #include <linux/sysfs.h> |
29 | #include <linux/ioport.h> |
30 | #include <linux/acpi.h> |
31 | #include <linux/io.h> |
32 | |
33 | static unsigned short force_id; |
34 | module_param(force_id, ushort, 0); |
35 | MODULE_PARM_DESC(force_id, "Override the detected device ID" ); |
36 | |
37 | static struct platform_device *pdev; |
38 | |
39 | #define DRVNAME "pc87427" |
40 | |
41 | /* |
42 | * The lock mutex protects both the I/O accesses (needed because the |
43 | * device is using banked registers) and the register cache (needed to keep |
44 | * the data in the registers and the cache in sync at any time). |
45 | */ |
46 | struct pc87427_data { |
47 | struct device *hwmon_dev; |
48 | struct mutex lock; |
49 | int address[2]; |
50 | const char *name; |
51 | |
52 | unsigned long last_updated; /* in jiffies */ |
53 | u8 fan_enabled; /* bit vector */ |
54 | u16 fan[8]; /* register values */ |
55 | u16 fan_min[8]; /* register values */ |
56 | u8 fan_status[8]; /* register values */ |
57 | |
58 | u8 pwm_enabled; /* bit vector */ |
59 | u8 pwm_auto_ok; /* bit vector */ |
60 | u8 pwm_enable[4]; /* register values */ |
61 | u8 pwm[4]; /* register values */ |
62 | |
63 | u8 temp_enabled; /* bit vector */ |
64 | s16 temp[6]; /* register values */ |
65 | s8 temp_min[6]; /* register values */ |
66 | s8 temp_max[6]; /* register values */ |
67 | s8 temp_crit[6]; /* register values */ |
68 | u8 temp_status[6]; /* register values */ |
69 | u8 temp_type[6]; /* register values */ |
70 | }; |
71 | |
72 | struct pc87427_sio_data { |
73 | unsigned short address[2]; |
74 | u8 has_fanin; |
75 | u8 has_fanout; |
76 | }; |
77 | |
78 | /* |
79 | * Super-I/O registers and operations |
80 | */ |
81 | |
82 | #define SIOREG_LDSEL 0x07 /* Logical device select */ |
83 | #define SIOREG_DEVID 0x20 /* Device ID */ |
84 | #define SIOREG_CF2 0x22 /* Configuration 2 */ |
85 | #define SIOREG_CF3 0x23 /* Configuration 3 */ |
86 | #define SIOREG_CF4 0x24 /* Configuration 4 */ |
87 | #define SIOREG_CF5 0x25 /* Configuration 5 */ |
88 | #define SIOREG_CFB 0x2B /* Configuration B */ |
89 | #define SIOREG_CFC 0x2C /* Configuration C */ |
90 | #define SIOREG_CFD 0x2D /* Configuration D */ |
91 | #define SIOREG_ACT 0x30 /* Device activation */ |
92 | #define SIOREG_MAP 0x50 /* I/O or memory mapping */ |
93 | #define SIOREG_IOBASE 0x60 /* I/O base address */ |
94 | |
95 | static const u8 logdev[2] = { 0x09, 0x14 }; |
96 | static const char *logdev_str[2] = { DRVNAME " FMC" , DRVNAME " HMC" }; |
97 | #define LD_FAN 0 |
98 | #define LD_IN 1 |
99 | #define LD_TEMP 1 |
100 | |
101 | static inline int superio_enter(int sioaddr) |
102 | { |
103 | if (!request_muxed_region(sioaddr, 2, DRVNAME)) |
104 | return -EBUSY; |
105 | return 0; |
106 | } |
107 | |
108 | static inline void superio_outb(int sioaddr, int reg, int val) |
109 | { |
110 | outb(value: reg, port: sioaddr); |
111 | outb(value: val, port: sioaddr + 1); |
112 | } |
113 | |
114 | static inline int superio_inb(int sioaddr, int reg) |
115 | { |
116 | outb(value: reg, port: sioaddr); |
117 | return inb(port: sioaddr + 1); |
118 | } |
119 | |
120 | static inline void superio_exit(int sioaddr) |
121 | { |
122 | outb(value: 0x02, port: sioaddr); |
123 | outb(value: 0x02, port: sioaddr + 1); |
124 | release_region(sioaddr, 2); |
125 | } |
126 | |
127 | /* |
128 | * Logical devices |
129 | */ |
130 | |
131 | #define REGION_LENGTH 32 |
132 | #define PC87427_REG_BANK 0x0f |
133 | #define BANK_FM(nr) (nr) |
134 | #define BANK_FT(nr) (0x08 + (nr)) |
135 | #define BANK_FC(nr) (0x10 + (nr) * 2) |
136 | #define BANK_TM(nr) (nr) |
137 | #define BANK_VM(nr) (0x08 + (nr)) |
138 | |
139 | /* |
140 | * I/O access functions |
141 | */ |
142 | |
143 | /* ldi is the logical device index */ |
144 | static inline int pc87427_read8(struct pc87427_data *data, u8 ldi, u8 reg) |
145 | { |
146 | return inb(port: data->address[ldi] + reg); |
147 | } |
148 | |
149 | /* Must be called with data->lock held, except during init */ |
150 | static inline int pc87427_read8_bank(struct pc87427_data *data, u8 ldi, |
151 | u8 bank, u8 reg) |
152 | { |
153 | outb(value: bank, port: data->address[ldi] + PC87427_REG_BANK); |
154 | return inb(port: data->address[ldi] + reg); |
155 | } |
156 | |
157 | /* Must be called with data->lock held, except during init */ |
158 | static inline void pc87427_write8_bank(struct pc87427_data *data, u8 ldi, |
159 | u8 bank, u8 reg, u8 value) |
160 | { |
161 | outb(value: bank, port: data->address[ldi] + PC87427_REG_BANK); |
162 | outb(value, port: data->address[ldi] + reg); |
163 | } |
164 | |
165 | /* |
166 | * Fan registers and conversions |
167 | */ |
168 | |
169 | /* fan data registers are 16-bit wide */ |
170 | #define PC87427_REG_FAN 0x12 |
171 | #define PC87427_REG_FAN_MIN 0x14 |
172 | #define PC87427_REG_FAN_STATUS 0x10 |
173 | |
174 | #define FAN_STATUS_STALL (1 << 3) |
175 | #define FAN_STATUS_LOSPD (1 << 1) |
176 | #define FAN_STATUS_MONEN (1 << 0) |
177 | |
178 | /* |
179 | * Dedicated function to read all registers related to a given fan input. |
180 | * This saves us quite a few locks and bank selections. |
181 | * Must be called with data->lock held. |
182 | * nr is from 0 to 7 |
183 | */ |
184 | static void pc87427_readall_fan(struct pc87427_data *data, u8 nr) |
185 | { |
186 | int iobase = data->address[LD_FAN]; |
187 | |
188 | outb(BANK_FM(nr), port: iobase + PC87427_REG_BANK); |
189 | data->fan[nr] = inw(port: iobase + PC87427_REG_FAN); |
190 | data->fan_min[nr] = inw(port: iobase + PC87427_REG_FAN_MIN); |
191 | data->fan_status[nr] = inb(port: iobase + PC87427_REG_FAN_STATUS); |
192 | /* Clear fan alarm bits */ |
193 | outb(value: data->fan_status[nr], port: iobase + PC87427_REG_FAN_STATUS); |
194 | } |
195 | |
196 | /* |
197 | * The 2 LSB of fan speed registers are used for something different. |
198 | * The actual 2 LSB of the measurements are not available. |
199 | */ |
200 | static inline unsigned long fan_from_reg(u16 reg) |
201 | { |
202 | reg &= 0xfffc; |
203 | if (reg == 0x0000 || reg == 0xfffc) |
204 | return 0; |
205 | return 5400000UL / reg; |
206 | } |
207 | |
208 | /* The 2 LSB of the fan speed limit registers are not significant. */ |
209 | static inline u16 fan_to_reg(unsigned long val) |
210 | { |
211 | if (val < 83UL) |
212 | return 0xffff; |
213 | if (val >= 1350000UL) |
214 | return 0x0004; |
215 | return ((1350000UL + val / 2) / val) << 2; |
216 | } |
217 | |
218 | /* |
219 | * PWM registers and conversions |
220 | */ |
221 | |
222 | #define PC87427_REG_PWM_ENABLE 0x10 |
223 | #define PC87427_REG_PWM_DUTY 0x12 |
224 | |
225 | #define PWM_ENABLE_MODE_MASK (7 << 4) |
226 | #define PWM_ENABLE_CTLEN (1 << 0) |
227 | |
228 | #define PWM_MODE_MANUAL (0 << 4) |
229 | #define PWM_MODE_AUTO (1 << 4) |
230 | #define PWM_MODE_OFF (2 << 4) |
231 | #define PWM_MODE_ON (7 << 4) |
232 | |
233 | /* |
234 | * Dedicated function to read all registers related to a given PWM output. |
235 | * This saves us quite a few locks and bank selections. |
236 | * Must be called with data->lock held. |
237 | * nr is from 0 to 3 |
238 | */ |
239 | static void pc87427_readall_pwm(struct pc87427_data *data, u8 nr) |
240 | { |
241 | int iobase = data->address[LD_FAN]; |
242 | |
243 | outb(BANK_FC(nr), port: iobase + PC87427_REG_BANK); |
244 | data->pwm_enable[nr] = inb(port: iobase + PC87427_REG_PWM_ENABLE); |
245 | data->pwm[nr] = inb(port: iobase + PC87427_REG_PWM_DUTY); |
246 | } |
247 | |
248 | static inline int pwm_enable_from_reg(u8 reg) |
249 | { |
250 | switch (reg & PWM_ENABLE_MODE_MASK) { |
251 | case PWM_MODE_ON: |
252 | return 0; |
253 | case PWM_MODE_MANUAL: |
254 | case PWM_MODE_OFF: |
255 | return 1; |
256 | case PWM_MODE_AUTO: |
257 | return 2; |
258 | default: |
259 | return -EPROTO; |
260 | } |
261 | } |
262 | |
263 | static inline u8 pwm_enable_to_reg(unsigned long val, u8 pwmval) |
264 | { |
265 | switch (val) { |
266 | default: |
267 | return PWM_MODE_ON; |
268 | case 1: |
269 | return pwmval ? PWM_MODE_MANUAL : PWM_MODE_OFF; |
270 | case 2: |
271 | return PWM_MODE_AUTO; |
272 | } |
273 | } |
274 | |
275 | /* |
276 | * Temperature registers and conversions |
277 | */ |
278 | |
279 | #define PC87427_REG_TEMP_STATUS 0x10 |
280 | #define PC87427_REG_TEMP 0x14 |
281 | #define PC87427_REG_TEMP_MAX 0x18 |
282 | #define PC87427_REG_TEMP_MIN 0x19 |
283 | #define PC87427_REG_TEMP_CRIT 0x1a |
284 | #define PC87427_REG_TEMP_TYPE 0x1d |
285 | |
286 | #define TEMP_STATUS_CHANEN (1 << 0) |
287 | #define TEMP_STATUS_LOWFLG (1 << 1) |
288 | #define TEMP_STATUS_HIGHFLG (1 << 2) |
289 | #define TEMP_STATUS_CRITFLG (1 << 3) |
290 | #define TEMP_STATUS_SENSERR (1 << 5) |
291 | #define TEMP_TYPE_MASK (3 << 5) |
292 | |
293 | #define TEMP_TYPE_THERMISTOR (1 << 5) |
294 | #define TEMP_TYPE_REMOTE_DIODE (2 << 5) |
295 | #define TEMP_TYPE_LOCAL_DIODE (3 << 5) |
296 | |
297 | /* |
298 | * Dedicated function to read all registers related to a given temperature |
299 | * input. This saves us quite a few locks and bank selections. |
300 | * Must be called with data->lock held. |
301 | * nr is from 0 to 5 |
302 | */ |
303 | static void pc87427_readall_temp(struct pc87427_data *data, u8 nr) |
304 | { |
305 | int iobase = data->address[LD_TEMP]; |
306 | |
307 | outb(BANK_TM(nr), port: iobase + PC87427_REG_BANK); |
308 | data->temp[nr] = le16_to_cpu(inw(iobase + PC87427_REG_TEMP)); |
309 | data->temp_max[nr] = inb(port: iobase + PC87427_REG_TEMP_MAX); |
310 | data->temp_min[nr] = inb(port: iobase + PC87427_REG_TEMP_MIN); |
311 | data->temp_crit[nr] = inb(port: iobase + PC87427_REG_TEMP_CRIT); |
312 | data->temp_type[nr] = inb(port: iobase + PC87427_REG_TEMP_TYPE); |
313 | data->temp_status[nr] = inb(port: iobase + PC87427_REG_TEMP_STATUS); |
314 | /* Clear fan alarm bits */ |
315 | outb(value: data->temp_status[nr], port: iobase + PC87427_REG_TEMP_STATUS); |
316 | } |
317 | |
318 | static inline unsigned int temp_type_from_reg(u8 reg) |
319 | { |
320 | switch (reg & TEMP_TYPE_MASK) { |
321 | case TEMP_TYPE_THERMISTOR: |
322 | return 4; |
323 | case TEMP_TYPE_REMOTE_DIODE: |
324 | case TEMP_TYPE_LOCAL_DIODE: |
325 | return 3; |
326 | default: |
327 | return 0; |
328 | } |
329 | } |
330 | |
331 | /* |
332 | * We assume 8-bit thermal sensors; 9-bit thermal sensors are possible |
333 | * too, but I have no idea how to figure out when they are used. |
334 | */ |
335 | static inline long temp_from_reg(s16 reg) |
336 | { |
337 | return reg * 1000 / 256; |
338 | } |
339 | |
340 | static inline long temp_from_reg8(s8 reg) |
341 | { |
342 | return reg * 1000; |
343 | } |
344 | |
345 | /* |
346 | * Data interface |
347 | */ |
348 | |
349 | static struct pc87427_data *pc87427_update_device(struct device *dev) |
350 | { |
351 | struct pc87427_data *data = dev_get_drvdata(dev); |
352 | int i; |
353 | |
354 | mutex_lock(&data->lock); |
355 | if (!time_after(jiffies, data->last_updated + HZ) |
356 | && data->last_updated) |
357 | goto done; |
358 | |
359 | /* Fans */ |
360 | for (i = 0; i < 8; i++) { |
361 | if (!(data->fan_enabled & (1 << i))) |
362 | continue; |
363 | pc87427_readall_fan(data, nr: i); |
364 | } |
365 | |
366 | /* PWM outputs */ |
367 | for (i = 0; i < 4; i++) { |
368 | if (!(data->pwm_enabled & (1 << i))) |
369 | continue; |
370 | pc87427_readall_pwm(data, nr: i); |
371 | } |
372 | |
373 | /* Temperature channels */ |
374 | for (i = 0; i < 6; i++) { |
375 | if (!(data->temp_enabled & (1 << i))) |
376 | continue; |
377 | pc87427_readall_temp(data, nr: i); |
378 | } |
379 | |
380 | data->last_updated = jiffies; |
381 | |
382 | done: |
383 | mutex_unlock(lock: &data->lock); |
384 | return data; |
385 | } |
386 | |
387 | static ssize_t fan_input_show(struct device *dev, |
388 | struct device_attribute *devattr, char *buf) |
389 | { |
390 | struct pc87427_data *data = pc87427_update_device(dev); |
391 | int nr = to_sensor_dev_attr(devattr)->index; |
392 | |
393 | return sprintf(buf, fmt: "%lu\n" , fan_from_reg(reg: data->fan[nr])); |
394 | } |
395 | |
396 | static ssize_t fan_min_show(struct device *dev, |
397 | struct device_attribute *devattr, char *buf) |
398 | { |
399 | struct pc87427_data *data = pc87427_update_device(dev); |
400 | int nr = to_sensor_dev_attr(devattr)->index; |
401 | |
402 | return sprintf(buf, fmt: "%lu\n" , fan_from_reg(reg: data->fan_min[nr])); |
403 | } |
404 | |
405 | static ssize_t fan_alarm_show(struct device *dev, |
406 | struct device_attribute *devattr, char *buf) |
407 | { |
408 | struct pc87427_data *data = pc87427_update_device(dev); |
409 | int nr = to_sensor_dev_attr(devattr)->index; |
410 | |
411 | return sprintf(buf, fmt: "%d\n" , !!(data->fan_status[nr] |
412 | & FAN_STATUS_LOSPD)); |
413 | } |
414 | |
415 | static ssize_t fan_fault_show(struct device *dev, |
416 | struct device_attribute *devattr, char *buf) |
417 | { |
418 | struct pc87427_data *data = pc87427_update_device(dev); |
419 | int nr = to_sensor_dev_attr(devattr)->index; |
420 | |
421 | return sprintf(buf, fmt: "%d\n" , !!(data->fan_status[nr] |
422 | & FAN_STATUS_STALL)); |
423 | } |
424 | |
425 | static ssize_t fan_min_store(struct device *dev, |
426 | struct device_attribute *devattr, |
427 | const char *buf, size_t count) |
428 | { |
429 | struct pc87427_data *data = dev_get_drvdata(dev); |
430 | int nr = to_sensor_dev_attr(devattr)->index; |
431 | unsigned long val; |
432 | int iobase = data->address[LD_FAN]; |
433 | |
434 | if (kstrtoul(s: buf, base: 10, res: &val) < 0) |
435 | return -EINVAL; |
436 | |
437 | mutex_lock(&data->lock); |
438 | outb(BANK_FM(nr), port: iobase + PC87427_REG_BANK); |
439 | /* |
440 | * The low speed limit registers are read-only while monitoring |
441 | * is enabled, so we have to disable monitoring, then change the |
442 | * limit, and finally enable monitoring again. |
443 | */ |
444 | outb(value: 0, port: iobase + PC87427_REG_FAN_STATUS); |
445 | data->fan_min[nr] = fan_to_reg(val); |
446 | outw(value: data->fan_min[nr], port: iobase + PC87427_REG_FAN_MIN); |
447 | outb(FAN_STATUS_MONEN, port: iobase + PC87427_REG_FAN_STATUS); |
448 | mutex_unlock(lock: &data->lock); |
449 | |
450 | return count; |
451 | } |
452 | |
453 | static SENSOR_DEVICE_ATTR_RO(fan1_input, fan_input, 0); |
454 | static SENSOR_DEVICE_ATTR_RO(fan2_input, fan_input, 1); |
455 | static SENSOR_DEVICE_ATTR_RO(fan3_input, fan_input, 2); |
456 | static SENSOR_DEVICE_ATTR_RO(fan4_input, fan_input, 3); |
457 | static SENSOR_DEVICE_ATTR_RO(fan5_input, fan_input, 4); |
458 | static SENSOR_DEVICE_ATTR_RO(fan6_input, fan_input, 5); |
459 | static SENSOR_DEVICE_ATTR_RO(fan7_input, fan_input, 6); |
460 | static SENSOR_DEVICE_ATTR_RO(fan8_input, fan_input, 7); |
461 | |
462 | static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0); |
463 | static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1); |
464 | static SENSOR_DEVICE_ATTR_RW(fan3_min, fan_min, 2); |
465 | static SENSOR_DEVICE_ATTR_RW(fan4_min, fan_min, 3); |
466 | static SENSOR_DEVICE_ATTR_RW(fan5_min, fan_min, 4); |
467 | static SENSOR_DEVICE_ATTR_RW(fan6_min, fan_min, 5); |
468 | static SENSOR_DEVICE_ATTR_RW(fan7_min, fan_min, 6); |
469 | static SENSOR_DEVICE_ATTR_RW(fan8_min, fan_min, 7); |
470 | |
471 | static SENSOR_DEVICE_ATTR_RO(fan1_alarm, fan_alarm, 0); |
472 | static SENSOR_DEVICE_ATTR_RO(fan2_alarm, fan_alarm, 1); |
473 | static SENSOR_DEVICE_ATTR_RO(fan3_alarm, fan_alarm, 2); |
474 | static SENSOR_DEVICE_ATTR_RO(fan4_alarm, fan_alarm, 3); |
475 | static SENSOR_DEVICE_ATTR_RO(fan5_alarm, fan_alarm, 4); |
476 | static SENSOR_DEVICE_ATTR_RO(fan6_alarm, fan_alarm, 5); |
477 | static SENSOR_DEVICE_ATTR_RO(fan7_alarm, fan_alarm, 6); |
478 | static SENSOR_DEVICE_ATTR_RO(fan8_alarm, fan_alarm, 7); |
479 | |
480 | static SENSOR_DEVICE_ATTR_RO(fan1_fault, fan_fault, 0); |
481 | static SENSOR_DEVICE_ATTR_RO(fan2_fault, fan_fault, 1); |
482 | static SENSOR_DEVICE_ATTR_RO(fan3_fault, fan_fault, 2); |
483 | static SENSOR_DEVICE_ATTR_RO(fan4_fault, fan_fault, 3); |
484 | static SENSOR_DEVICE_ATTR_RO(fan5_fault, fan_fault, 4); |
485 | static SENSOR_DEVICE_ATTR_RO(fan6_fault, fan_fault, 5); |
486 | static SENSOR_DEVICE_ATTR_RO(fan7_fault, fan_fault, 6); |
487 | static SENSOR_DEVICE_ATTR_RO(fan8_fault, fan_fault, 7); |
488 | |
489 | static struct attribute *pc87427_attributes_fan[8][5] = { |
490 | { |
491 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
492 | &sensor_dev_attr_fan1_min.dev_attr.attr, |
493 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, |
494 | &sensor_dev_attr_fan1_fault.dev_attr.attr, |
495 | NULL |
496 | }, { |
497 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
498 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
499 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, |
500 | &sensor_dev_attr_fan2_fault.dev_attr.attr, |
501 | NULL |
502 | }, { |
503 | &sensor_dev_attr_fan3_input.dev_attr.attr, |
504 | &sensor_dev_attr_fan3_min.dev_attr.attr, |
505 | &sensor_dev_attr_fan3_alarm.dev_attr.attr, |
506 | &sensor_dev_attr_fan3_fault.dev_attr.attr, |
507 | NULL |
508 | }, { |
509 | &sensor_dev_attr_fan4_input.dev_attr.attr, |
510 | &sensor_dev_attr_fan4_min.dev_attr.attr, |
511 | &sensor_dev_attr_fan4_alarm.dev_attr.attr, |
512 | &sensor_dev_attr_fan4_fault.dev_attr.attr, |
513 | NULL |
514 | }, { |
515 | &sensor_dev_attr_fan5_input.dev_attr.attr, |
516 | &sensor_dev_attr_fan5_min.dev_attr.attr, |
517 | &sensor_dev_attr_fan5_alarm.dev_attr.attr, |
518 | &sensor_dev_attr_fan5_fault.dev_attr.attr, |
519 | NULL |
520 | }, { |
521 | &sensor_dev_attr_fan6_input.dev_attr.attr, |
522 | &sensor_dev_attr_fan6_min.dev_attr.attr, |
523 | &sensor_dev_attr_fan6_alarm.dev_attr.attr, |
524 | &sensor_dev_attr_fan6_fault.dev_attr.attr, |
525 | NULL |
526 | }, { |
527 | &sensor_dev_attr_fan7_input.dev_attr.attr, |
528 | &sensor_dev_attr_fan7_min.dev_attr.attr, |
529 | &sensor_dev_attr_fan7_alarm.dev_attr.attr, |
530 | &sensor_dev_attr_fan7_fault.dev_attr.attr, |
531 | NULL |
532 | }, { |
533 | &sensor_dev_attr_fan8_input.dev_attr.attr, |
534 | &sensor_dev_attr_fan8_min.dev_attr.attr, |
535 | &sensor_dev_attr_fan8_alarm.dev_attr.attr, |
536 | &sensor_dev_attr_fan8_fault.dev_attr.attr, |
537 | NULL |
538 | } |
539 | }; |
540 | |
541 | static const struct attribute_group pc87427_group_fan[8] = { |
542 | { .attrs = pc87427_attributes_fan[0] }, |
543 | { .attrs = pc87427_attributes_fan[1] }, |
544 | { .attrs = pc87427_attributes_fan[2] }, |
545 | { .attrs = pc87427_attributes_fan[3] }, |
546 | { .attrs = pc87427_attributes_fan[4] }, |
547 | { .attrs = pc87427_attributes_fan[5] }, |
548 | { .attrs = pc87427_attributes_fan[6] }, |
549 | { .attrs = pc87427_attributes_fan[7] }, |
550 | }; |
551 | |
552 | /* |
553 | * Must be called with data->lock held and pc87427_readall_pwm() freshly |
554 | * called |
555 | */ |
556 | static void update_pwm_enable(struct pc87427_data *data, int nr, u8 mode) |
557 | { |
558 | int iobase = data->address[LD_FAN]; |
559 | data->pwm_enable[nr] &= ~PWM_ENABLE_MODE_MASK; |
560 | data->pwm_enable[nr] |= mode; |
561 | outb(value: data->pwm_enable[nr], port: iobase + PC87427_REG_PWM_ENABLE); |
562 | } |
563 | |
564 | static ssize_t pwm_enable_show(struct device *dev, |
565 | struct device_attribute *devattr, char *buf) |
566 | { |
567 | struct pc87427_data *data = pc87427_update_device(dev); |
568 | int nr = to_sensor_dev_attr(devattr)->index; |
569 | int pwm_enable; |
570 | |
571 | pwm_enable = pwm_enable_from_reg(reg: data->pwm_enable[nr]); |
572 | if (pwm_enable < 0) |
573 | return pwm_enable; |
574 | return sprintf(buf, fmt: "%d\n" , pwm_enable); |
575 | } |
576 | |
577 | static ssize_t pwm_enable_store(struct device *dev, |
578 | struct device_attribute *devattr, |
579 | const char *buf, size_t count) |
580 | { |
581 | struct pc87427_data *data = dev_get_drvdata(dev); |
582 | int nr = to_sensor_dev_attr(devattr)->index; |
583 | unsigned long val; |
584 | |
585 | if (kstrtoul(s: buf, base: 10, res: &val) < 0 || val > 2) |
586 | return -EINVAL; |
587 | /* Can't go to automatic mode if it isn't configured */ |
588 | if (val == 2 && !(data->pwm_auto_ok & (1 << nr))) |
589 | return -EINVAL; |
590 | |
591 | mutex_lock(&data->lock); |
592 | pc87427_readall_pwm(data, nr); |
593 | update_pwm_enable(data, nr, mode: pwm_enable_to_reg(val, pwmval: data->pwm[nr])); |
594 | mutex_unlock(lock: &data->lock); |
595 | |
596 | return count; |
597 | } |
598 | |
599 | static ssize_t pwm_show(struct device *dev, struct device_attribute *devattr, |
600 | char *buf) |
601 | { |
602 | struct pc87427_data *data = pc87427_update_device(dev); |
603 | int nr = to_sensor_dev_attr(devattr)->index; |
604 | |
605 | return sprintf(buf, fmt: "%d\n" , (int)data->pwm[nr]); |
606 | } |
607 | |
608 | static ssize_t pwm_store(struct device *dev, struct device_attribute *devattr, |
609 | const char *buf, size_t count) |
610 | { |
611 | struct pc87427_data *data = dev_get_drvdata(dev); |
612 | int nr = to_sensor_dev_attr(devattr)->index; |
613 | unsigned long val; |
614 | int iobase = data->address[LD_FAN]; |
615 | u8 mode; |
616 | |
617 | if (kstrtoul(s: buf, base: 10, res: &val) < 0 || val > 0xff) |
618 | return -EINVAL; |
619 | |
620 | mutex_lock(&data->lock); |
621 | pc87427_readall_pwm(data, nr); |
622 | mode = data->pwm_enable[nr] & PWM_ENABLE_MODE_MASK; |
623 | if (mode != PWM_MODE_MANUAL && mode != PWM_MODE_OFF) { |
624 | dev_notice(dev, |
625 | "Can't set PWM%d duty cycle while not in manual mode\n" , |
626 | nr + 1); |
627 | mutex_unlock(lock: &data->lock); |
628 | return -EPERM; |
629 | } |
630 | |
631 | /* We may have to change the mode */ |
632 | if (mode == PWM_MODE_MANUAL && val == 0) { |
633 | /* Transition from Manual to Off */ |
634 | update_pwm_enable(data, nr, PWM_MODE_OFF); |
635 | mode = PWM_MODE_OFF; |
636 | dev_dbg(dev, "Switching PWM%d from %s to %s\n" , nr + 1, |
637 | "manual" , "off" ); |
638 | } else if (mode == PWM_MODE_OFF && val != 0) { |
639 | /* Transition from Off to Manual */ |
640 | update_pwm_enable(data, nr, PWM_MODE_MANUAL); |
641 | mode = PWM_MODE_MANUAL; |
642 | dev_dbg(dev, "Switching PWM%d from %s to %s\n" , nr + 1, |
643 | "off" , "manual" ); |
644 | } |
645 | |
646 | data->pwm[nr] = val; |
647 | if (mode == PWM_MODE_MANUAL) |
648 | outb(value: val, port: iobase + PC87427_REG_PWM_DUTY); |
649 | mutex_unlock(lock: &data->lock); |
650 | |
651 | return count; |
652 | } |
653 | |
654 | static SENSOR_DEVICE_ATTR_RW(pwm1_enable, pwm_enable, 0); |
655 | static SENSOR_DEVICE_ATTR_RW(pwm2_enable, pwm_enable, 1); |
656 | static SENSOR_DEVICE_ATTR_RW(pwm3_enable, pwm_enable, 2); |
657 | static SENSOR_DEVICE_ATTR_RW(pwm4_enable, pwm_enable, 3); |
658 | |
659 | static SENSOR_DEVICE_ATTR_RW(pwm1, pwm, 0); |
660 | static SENSOR_DEVICE_ATTR_RW(pwm2, pwm, 1); |
661 | static SENSOR_DEVICE_ATTR_RW(pwm3, pwm, 2); |
662 | static SENSOR_DEVICE_ATTR_RW(pwm4, pwm, 3); |
663 | |
664 | static struct attribute *pc87427_attributes_pwm[4][3] = { |
665 | { |
666 | &sensor_dev_attr_pwm1_enable.dev_attr.attr, |
667 | &sensor_dev_attr_pwm1.dev_attr.attr, |
668 | NULL |
669 | }, { |
670 | &sensor_dev_attr_pwm2_enable.dev_attr.attr, |
671 | &sensor_dev_attr_pwm2.dev_attr.attr, |
672 | NULL |
673 | }, { |
674 | &sensor_dev_attr_pwm3_enable.dev_attr.attr, |
675 | &sensor_dev_attr_pwm3.dev_attr.attr, |
676 | NULL |
677 | }, { |
678 | &sensor_dev_attr_pwm4_enable.dev_attr.attr, |
679 | &sensor_dev_attr_pwm4.dev_attr.attr, |
680 | NULL |
681 | } |
682 | }; |
683 | |
684 | static const struct attribute_group pc87427_group_pwm[4] = { |
685 | { .attrs = pc87427_attributes_pwm[0] }, |
686 | { .attrs = pc87427_attributes_pwm[1] }, |
687 | { .attrs = pc87427_attributes_pwm[2] }, |
688 | { .attrs = pc87427_attributes_pwm[3] }, |
689 | }; |
690 | |
691 | static ssize_t temp_input_show(struct device *dev, |
692 | struct device_attribute *devattr, char *buf) |
693 | { |
694 | struct pc87427_data *data = pc87427_update_device(dev); |
695 | int nr = to_sensor_dev_attr(devattr)->index; |
696 | |
697 | return sprintf(buf, fmt: "%ld\n" , temp_from_reg(reg: data->temp[nr])); |
698 | } |
699 | |
700 | static ssize_t temp_min_show(struct device *dev, |
701 | struct device_attribute *devattr, char *buf) |
702 | { |
703 | struct pc87427_data *data = pc87427_update_device(dev); |
704 | int nr = to_sensor_dev_attr(devattr)->index; |
705 | |
706 | return sprintf(buf, fmt: "%ld\n" , temp_from_reg8(reg: data->temp_min[nr])); |
707 | } |
708 | |
709 | static ssize_t temp_max_show(struct device *dev, |
710 | struct device_attribute *devattr, char *buf) |
711 | { |
712 | struct pc87427_data *data = pc87427_update_device(dev); |
713 | int nr = to_sensor_dev_attr(devattr)->index; |
714 | |
715 | return sprintf(buf, fmt: "%ld\n" , temp_from_reg8(reg: data->temp_max[nr])); |
716 | } |
717 | |
718 | static ssize_t temp_crit_show(struct device *dev, |
719 | struct device_attribute *devattr, char *buf) |
720 | { |
721 | struct pc87427_data *data = pc87427_update_device(dev); |
722 | int nr = to_sensor_dev_attr(devattr)->index; |
723 | |
724 | return sprintf(buf, fmt: "%ld\n" , temp_from_reg8(reg: data->temp_crit[nr])); |
725 | } |
726 | |
727 | static ssize_t temp_type_show(struct device *dev, |
728 | struct device_attribute *devattr, char *buf) |
729 | { |
730 | struct pc87427_data *data = pc87427_update_device(dev); |
731 | int nr = to_sensor_dev_attr(devattr)->index; |
732 | |
733 | return sprintf(buf, fmt: "%u\n" , temp_type_from_reg(reg: data->temp_type[nr])); |
734 | } |
735 | |
736 | static ssize_t temp_min_alarm_show(struct device *dev, |
737 | struct device_attribute *devattr, |
738 | char *buf) |
739 | { |
740 | struct pc87427_data *data = pc87427_update_device(dev); |
741 | int nr = to_sensor_dev_attr(devattr)->index; |
742 | |
743 | return sprintf(buf, fmt: "%d\n" , !!(data->temp_status[nr] |
744 | & TEMP_STATUS_LOWFLG)); |
745 | } |
746 | |
747 | static ssize_t temp_max_alarm_show(struct device *dev, |
748 | struct device_attribute *devattr, |
749 | char *buf) |
750 | { |
751 | struct pc87427_data *data = pc87427_update_device(dev); |
752 | int nr = to_sensor_dev_attr(devattr)->index; |
753 | |
754 | return sprintf(buf, fmt: "%d\n" , !!(data->temp_status[nr] |
755 | & TEMP_STATUS_HIGHFLG)); |
756 | } |
757 | |
758 | static ssize_t temp_crit_alarm_show(struct device *dev, |
759 | struct device_attribute *devattr, |
760 | char *buf) |
761 | { |
762 | struct pc87427_data *data = pc87427_update_device(dev); |
763 | int nr = to_sensor_dev_attr(devattr)->index; |
764 | |
765 | return sprintf(buf, fmt: "%d\n" , !!(data->temp_status[nr] |
766 | & TEMP_STATUS_CRITFLG)); |
767 | } |
768 | |
769 | static ssize_t temp_fault_show(struct device *dev, |
770 | struct device_attribute *devattr, char *buf) |
771 | { |
772 | struct pc87427_data *data = pc87427_update_device(dev); |
773 | int nr = to_sensor_dev_attr(devattr)->index; |
774 | |
775 | return sprintf(buf, fmt: "%d\n" , !!(data->temp_status[nr] |
776 | & TEMP_STATUS_SENSERR)); |
777 | } |
778 | |
779 | static SENSOR_DEVICE_ATTR_RO(temp1_input, temp_input, 0); |
780 | static SENSOR_DEVICE_ATTR_RO(temp2_input, temp_input, 1); |
781 | static SENSOR_DEVICE_ATTR_RO(temp3_input, temp_input, 2); |
782 | static SENSOR_DEVICE_ATTR_RO(temp4_input, temp_input, 3); |
783 | static SENSOR_DEVICE_ATTR_RO(temp5_input, temp_input, 4); |
784 | static SENSOR_DEVICE_ATTR_RO(temp6_input, temp_input, 5); |
785 | |
786 | static SENSOR_DEVICE_ATTR_RO(temp1_min, temp_min, 0); |
787 | static SENSOR_DEVICE_ATTR_RO(temp2_min, temp_min, 1); |
788 | static SENSOR_DEVICE_ATTR_RO(temp3_min, temp_min, 2); |
789 | static SENSOR_DEVICE_ATTR_RO(temp4_min, temp_min, 3); |
790 | static SENSOR_DEVICE_ATTR_RO(temp5_min, temp_min, 4); |
791 | static SENSOR_DEVICE_ATTR_RO(temp6_min, temp_min, 5); |
792 | |
793 | static SENSOR_DEVICE_ATTR_RO(temp1_max, temp_max, 0); |
794 | static SENSOR_DEVICE_ATTR_RO(temp2_max, temp_max, 1); |
795 | static SENSOR_DEVICE_ATTR_RO(temp3_max, temp_max, 2); |
796 | static SENSOR_DEVICE_ATTR_RO(temp4_max, temp_max, 3); |
797 | static SENSOR_DEVICE_ATTR_RO(temp5_max, temp_max, 4); |
798 | static SENSOR_DEVICE_ATTR_RO(temp6_max, temp_max, 5); |
799 | |
800 | static SENSOR_DEVICE_ATTR_RO(temp1_crit, temp_crit, 0); |
801 | static SENSOR_DEVICE_ATTR_RO(temp2_crit, temp_crit, 1); |
802 | static SENSOR_DEVICE_ATTR_RO(temp3_crit, temp_crit, 2); |
803 | static SENSOR_DEVICE_ATTR_RO(temp4_crit, temp_crit, 3); |
804 | static SENSOR_DEVICE_ATTR_RO(temp5_crit, temp_crit, 4); |
805 | static SENSOR_DEVICE_ATTR_RO(temp6_crit, temp_crit, 5); |
806 | |
807 | static SENSOR_DEVICE_ATTR_RO(temp1_type, temp_type, 0); |
808 | static SENSOR_DEVICE_ATTR_RO(temp2_type, temp_type, 1); |
809 | static SENSOR_DEVICE_ATTR_RO(temp3_type, temp_type, 2); |
810 | static SENSOR_DEVICE_ATTR_RO(temp4_type, temp_type, 3); |
811 | static SENSOR_DEVICE_ATTR_RO(temp5_type, temp_type, 4); |
812 | static SENSOR_DEVICE_ATTR_RO(temp6_type, temp_type, 5); |
813 | |
814 | static SENSOR_DEVICE_ATTR_RO(temp1_min_alarm, temp_min_alarm, 0); |
815 | static SENSOR_DEVICE_ATTR_RO(temp2_min_alarm, temp_min_alarm, 1); |
816 | static SENSOR_DEVICE_ATTR_RO(temp3_min_alarm, temp_min_alarm, 2); |
817 | static SENSOR_DEVICE_ATTR_RO(temp4_min_alarm, temp_min_alarm, 3); |
818 | static SENSOR_DEVICE_ATTR_RO(temp5_min_alarm, temp_min_alarm, 4); |
819 | static SENSOR_DEVICE_ATTR_RO(temp6_min_alarm, temp_min_alarm, 5); |
820 | |
821 | static SENSOR_DEVICE_ATTR_RO(temp1_max_alarm, temp_max_alarm, 0); |
822 | static SENSOR_DEVICE_ATTR_RO(temp2_max_alarm, temp_max_alarm, 1); |
823 | static SENSOR_DEVICE_ATTR_RO(temp3_max_alarm, temp_max_alarm, 2); |
824 | static SENSOR_DEVICE_ATTR_RO(temp4_max_alarm, temp_max_alarm, 3); |
825 | static SENSOR_DEVICE_ATTR_RO(temp5_max_alarm, temp_max_alarm, 4); |
826 | static SENSOR_DEVICE_ATTR_RO(temp6_max_alarm, temp_max_alarm, 5); |
827 | |
828 | static SENSOR_DEVICE_ATTR_RO(temp1_crit_alarm, temp_crit_alarm, 0); |
829 | static SENSOR_DEVICE_ATTR_RO(temp2_crit_alarm, temp_crit_alarm, 1); |
830 | static SENSOR_DEVICE_ATTR_RO(temp3_crit_alarm, temp_crit_alarm, 2); |
831 | static SENSOR_DEVICE_ATTR_RO(temp4_crit_alarm, temp_crit_alarm, 3); |
832 | static SENSOR_DEVICE_ATTR_RO(temp5_crit_alarm, temp_crit_alarm, 4); |
833 | static SENSOR_DEVICE_ATTR_RO(temp6_crit_alarm, temp_crit_alarm, 5); |
834 | |
835 | static SENSOR_DEVICE_ATTR_RO(temp1_fault, temp_fault, 0); |
836 | static SENSOR_DEVICE_ATTR_RO(temp2_fault, temp_fault, 1); |
837 | static SENSOR_DEVICE_ATTR_RO(temp3_fault, temp_fault, 2); |
838 | static SENSOR_DEVICE_ATTR_RO(temp4_fault, temp_fault, 3); |
839 | static SENSOR_DEVICE_ATTR_RO(temp5_fault, temp_fault, 4); |
840 | static SENSOR_DEVICE_ATTR_RO(temp6_fault, temp_fault, 5); |
841 | |
842 | static struct attribute *pc87427_attributes_temp[6][10] = { |
843 | { |
844 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
845 | &sensor_dev_attr_temp1_min.dev_attr.attr, |
846 | &sensor_dev_attr_temp1_max.dev_attr.attr, |
847 | &sensor_dev_attr_temp1_crit.dev_attr.attr, |
848 | &sensor_dev_attr_temp1_type.dev_attr.attr, |
849 | &sensor_dev_attr_temp1_min_alarm.dev_attr.attr, |
850 | &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, |
851 | &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr, |
852 | &sensor_dev_attr_temp1_fault.dev_attr.attr, |
853 | NULL |
854 | }, { |
855 | &sensor_dev_attr_temp2_input.dev_attr.attr, |
856 | &sensor_dev_attr_temp2_min.dev_attr.attr, |
857 | &sensor_dev_attr_temp2_max.dev_attr.attr, |
858 | &sensor_dev_attr_temp2_crit.dev_attr.attr, |
859 | &sensor_dev_attr_temp2_type.dev_attr.attr, |
860 | &sensor_dev_attr_temp2_min_alarm.dev_attr.attr, |
861 | &sensor_dev_attr_temp2_max_alarm.dev_attr.attr, |
862 | &sensor_dev_attr_temp2_crit_alarm.dev_attr.attr, |
863 | &sensor_dev_attr_temp2_fault.dev_attr.attr, |
864 | NULL |
865 | }, { |
866 | &sensor_dev_attr_temp3_input.dev_attr.attr, |
867 | &sensor_dev_attr_temp3_min.dev_attr.attr, |
868 | &sensor_dev_attr_temp3_max.dev_attr.attr, |
869 | &sensor_dev_attr_temp3_crit.dev_attr.attr, |
870 | &sensor_dev_attr_temp3_type.dev_attr.attr, |
871 | &sensor_dev_attr_temp3_min_alarm.dev_attr.attr, |
872 | &sensor_dev_attr_temp3_max_alarm.dev_attr.attr, |
873 | &sensor_dev_attr_temp3_crit_alarm.dev_attr.attr, |
874 | &sensor_dev_attr_temp3_fault.dev_attr.attr, |
875 | NULL |
876 | }, { |
877 | &sensor_dev_attr_temp4_input.dev_attr.attr, |
878 | &sensor_dev_attr_temp4_min.dev_attr.attr, |
879 | &sensor_dev_attr_temp4_max.dev_attr.attr, |
880 | &sensor_dev_attr_temp4_crit.dev_attr.attr, |
881 | &sensor_dev_attr_temp4_type.dev_attr.attr, |
882 | &sensor_dev_attr_temp4_min_alarm.dev_attr.attr, |
883 | &sensor_dev_attr_temp4_max_alarm.dev_attr.attr, |
884 | &sensor_dev_attr_temp4_crit_alarm.dev_attr.attr, |
885 | &sensor_dev_attr_temp4_fault.dev_attr.attr, |
886 | NULL |
887 | }, { |
888 | &sensor_dev_attr_temp5_input.dev_attr.attr, |
889 | &sensor_dev_attr_temp5_min.dev_attr.attr, |
890 | &sensor_dev_attr_temp5_max.dev_attr.attr, |
891 | &sensor_dev_attr_temp5_crit.dev_attr.attr, |
892 | &sensor_dev_attr_temp5_type.dev_attr.attr, |
893 | &sensor_dev_attr_temp5_min_alarm.dev_attr.attr, |
894 | &sensor_dev_attr_temp5_max_alarm.dev_attr.attr, |
895 | &sensor_dev_attr_temp5_crit_alarm.dev_attr.attr, |
896 | &sensor_dev_attr_temp5_fault.dev_attr.attr, |
897 | NULL |
898 | }, { |
899 | &sensor_dev_attr_temp6_input.dev_attr.attr, |
900 | &sensor_dev_attr_temp6_min.dev_attr.attr, |
901 | &sensor_dev_attr_temp6_max.dev_attr.attr, |
902 | &sensor_dev_attr_temp6_crit.dev_attr.attr, |
903 | &sensor_dev_attr_temp6_type.dev_attr.attr, |
904 | &sensor_dev_attr_temp6_min_alarm.dev_attr.attr, |
905 | &sensor_dev_attr_temp6_max_alarm.dev_attr.attr, |
906 | &sensor_dev_attr_temp6_crit_alarm.dev_attr.attr, |
907 | &sensor_dev_attr_temp6_fault.dev_attr.attr, |
908 | NULL |
909 | } |
910 | }; |
911 | |
912 | static const struct attribute_group pc87427_group_temp[6] = { |
913 | { .attrs = pc87427_attributes_temp[0] }, |
914 | { .attrs = pc87427_attributes_temp[1] }, |
915 | { .attrs = pc87427_attributes_temp[2] }, |
916 | { .attrs = pc87427_attributes_temp[3] }, |
917 | { .attrs = pc87427_attributes_temp[4] }, |
918 | { .attrs = pc87427_attributes_temp[5] }, |
919 | }; |
920 | |
921 | static ssize_t name_show(struct device *dev, struct device_attribute |
922 | *devattr, char *buf) |
923 | { |
924 | struct pc87427_data *data = dev_get_drvdata(dev); |
925 | |
926 | return sprintf(buf, fmt: "%s\n" , data->name); |
927 | } |
928 | static DEVICE_ATTR_RO(name); |
929 | |
930 | |
931 | /* |
932 | * Device detection, attach and detach |
933 | */ |
934 | |
935 | static int pc87427_request_regions(struct platform_device *pdev, |
936 | int count) |
937 | { |
938 | struct resource *res; |
939 | int i; |
940 | |
941 | for (i = 0; i < count; i++) { |
942 | res = platform_get_resource(pdev, IORESOURCE_IO, i); |
943 | if (!res) { |
944 | dev_err(&pdev->dev, "Missing resource #%d\n" , i); |
945 | return -ENOENT; |
946 | } |
947 | if (!devm_request_region(&pdev->dev, res->start, |
948 | resource_size(res), DRVNAME)) { |
949 | dev_err(&pdev->dev, |
950 | "Failed to request region 0x%lx-0x%lx\n" , |
951 | (unsigned long)res->start, |
952 | (unsigned long)res->end); |
953 | return -EBUSY; |
954 | } |
955 | } |
956 | return 0; |
957 | } |
958 | |
959 | static void pc87427_init_device(struct device *dev) |
960 | { |
961 | struct pc87427_sio_data *sio_data = dev_get_platdata(dev); |
962 | struct pc87427_data *data = dev_get_drvdata(dev); |
963 | int i; |
964 | u8 reg; |
965 | |
966 | /* The FMC module should be ready */ |
967 | reg = pc87427_read8(data, LD_FAN, PC87427_REG_BANK); |
968 | if (!(reg & 0x80)) |
969 | dev_warn(dev, "%s module not ready!\n" , "FMC" ); |
970 | |
971 | /* Check which fans are enabled */ |
972 | for (i = 0; i < 8; i++) { |
973 | if (!(sio_data->has_fanin & (1 << i))) /* Not wired */ |
974 | continue; |
975 | reg = pc87427_read8_bank(data, LD_FAN, BANK_FM(i), |
976 | PC87427_REG_FAN_STATUS); |
977 | if (reg & FAN_STATUS_MONEN) |
978 | data->fan_enabled |= (1 << i); |
979 | } |
980 | |
981 | if (!data->fan_enabled) { |
982 | dev_dbg(dev, "Enabling monitoring of all fans\n" ); |
983 | for (i = 0; i < 8; i++) { |
984 | if (!(sio_data->has_fanin & (1 << i))) /* Not wired */ |
985 | continue; |
986 | pc87427_write8_bank(data, LD_FAN, BANK_FM(i), |
987 | PC87427_REG_FAN_STATUS, |
988 | FAN_STATUS_MONEN); |
989 | } |
990 | data->fan_enabled = sio_data->has_fanin; |
991 | } |
992 | |
993 | /* Check which PWM outputs are enabled */ |
994 | for (i = 0; i < 4; i++) { |
995 | if (!(sio_data->has_fanout & (1 << i))) /* Not wired */ |
996 | continue; |
997 | reg = pc87427_read8_bank(data, LD_FAN, BANK_FC(i), |
998 | PC87427_REG_PWM_ENABLE); |
999 | if (reg & PWM_ENABLE_CTLEN) |
1000 | data->pwm_enabled |= (1 << i); |
1001 | |
1002 | /* |
1003 | * We don't expose an interface to reconfigure the automatic |
1004 | * fan control mode, so only allow to return to this mode if |
1005 | * it was originally set. |
1006 | */ |
1007 | if ((reg & PWM_ENABLE_MODE_MASK) == PWM_MODE_AUTO) { |
1008 | dev_dbg(dev, "PWM%d is in automatic control mode\n" , |
1009 | i + 1); |
1010 | data->pwm_auto_ok |= (1 << i); |
1011 | } |
1012 | } |
1013 | |
1014 | /* The HMC module should be ready */ |
1015 | reg = pc87427_read8(data, LD_TEMP, PC87427_REG_BANK); |
1016 | if (!(reg & 0x80)) |
1017 | dev_warn(dev, "%s module not ready!\n" , "HMC" ); |
1018 | |
1019 | /* Check which temperature channels are enabled */ |
1020 | for (i = 0; i < 6; i++) { |
1021 | reg = pc87427_read8_bank(data, LD_TEMP, BANK_TM(i), |
1022 | PC87427_REG_TEMP_STATUS); |
1023 | if (reg & TEMP_STATUS_CHANEN) |
1024 | data->temp_enabled |= (1 << i); |
1025 | } |
1026 | } |
1027 | |
1028 | static void pc87427_remove_files(struct device *dev) |
1029 | { |
1030 | struct pc87427_data *data = dev_get_drvdata(dev); |
1031 | int i; |
1032 | |
1033 | device_remove_file(dev, attr: &dev_attr_name); |
1034 | for (i = 0; i < 8; i++) { |
1035 | if (!(data->fan_enabled & (1 << i))) |
1036 | continue; |
1037 | sysfs_remove_group(kobj: &dev->kobj, grp: &pc87427_group_fan[i]); |
1038 | } |
1039 | for (i = 0; i < 4; i++) { |
1040 | if (!(data->pwm_enabled & (1 << i))) |
1041 | continue; |
1042 | sysfs_remove_group(kobj: &dev->kobj, grp: &pc87427_group_pwm[i]); |
1043 | } |
1044 | for (i = 0; i < 6; i++) { |
1045 | if (!(data->temp_enabled & (1 << i))) |
1046 | continue; |
1047 | sysfs_remove_group(kobj: &dev->kobj, grp: &pc87427_group_temp[i]); |
1048 | } |
1049 | } |
1050 | |
1051 | static int pc87427_probe(struct platform_device *pdev) |
1052 | { |
1053 | struct pc87427_sio_data *sio_data = dev_get_platdata(dev: &pdev->dev); |
1054 | struct pc87427_data *data; |
1055 | int i, err, res_count; |
1056 | |
1057 | data = devm_kzalloc(dev: &pdev->dev, size: sizeof(struct pc87427_data), |
1058 | GFP_KERNEL); |
1059 | if (!data) |
1060 | return -ENOMEM; |
1061 | |
1062 | data->address[0] = sio_data->address[0]; |
1063 | data->address[1] = sio_data->address[1]; |
1064 | res_count = (data->address[0] != 0) + (data->address[1] != 0); |
1065 | |
1066 | err = pc87427_request_regions(pdev, count: res_count); |
1067 | if (err) |
1068 | return err; |
1069 | |
1070 | mutex_init(&data->lock); |
1071 | data->name = "pc87427" ; |
1072 | platform_set_drvdata(pdev, data); |
1073 | pc87427_init_device(dev: &pdev->dev); |
1074 | |
1075 | /* Register sysfs hooks */ |
1076 | err = device_create_file(device: &pdev->dev, entry: &dev_attr_name); |
1077 | if (err) |
1078 | return err; |
1079 | for (i = 0; i < 8; i++) { |
1080 | if (!(data->fan_enabled & (1 << i))) |
1081 | continue; |
1082 | err = sysfs_create_group(kobj: &pdev->dev.kobj, |
1083 | grp: &pc87427_group_fan[i]); |
1084 | if (err) |
1085 | goto exit_remove_files; |
1086 | } |
1087 | for (i = 0; i < 4; i++) { |
1088 | if (!(data->pwm_enabled & (1 << i))) |
1089 | continue; |
1090 | err = sysfs_create_group(kobj: &pdev->dev.kobj, |
1091 | grp: &pc87427_group_pwm[i]); |
1092 | if (err) |
1093 | goto exit_remove_files; |
1094 | } |
1095 | for (i = 0; i < 6; i++) { |
1096 | if (!(data->temp_enabled & (1 << i))) |
1097 | continue; |
1098 | err = sysfs_create_group(kobj: &pdev->dev.kobj, |
1099 | grp: &pc87427_group_temp[i]); |
1100 | if (err) |
1101 | goto exit_remove_files; |
1102 | } |
1103 | |
1104 | data->hwmon_dev = hwmon_device_register(dev: &pdev->dev); |
1105 | if (IS_ERR(ptr: data->hwmon_dev)) { |
1106 | err = PTR_ERR(ptr: data->hwmon_dev); |
1107 | dev_err(&pdev->dev, "Class registration failed (%d)\n" , err); |
1108 | goto exit_remove_files; |
1109 | } |
1110 | |
1111 | return 0; |
1112 | |
1113 | exit_remove_files: |
1114 | pc87427_remove_files(dev: &pdev->dev); |
1115 | return err; |
1116 | } |
1117 | |
1118 | static void pc87427_remove(struct platform_device *pdev) |
1119 | { |
1120 | struct pc87427_data *data = platform_get_drvdata(pdev); |
1121 | |
1122 | hwmon_device_unregister(dev: data->hwmon_dev); |
1123 | pc87427_remove_files(dev: &pdev->dev); |
1124 | } |
1125 | |
1126 | |
1127 | static struct platform_driver pc87427_driver = { |
1128 | .driver = { |
1129 | .name = DRVNAME, |
1130 | }, |
1131 | .probe = pc87427_probe, |
1132 | .remove_new = pc87427_remove, |
1133 | }; |
1134 | |
1135 | static int __init pc87427_device_add(const struct pc87427_sio_data *sio_data) |
1136 | { |
1137 | struct resource res[2] = { |
1138 | { .flags = IORESOURCE_IO }, |
1139 | { .flags = IORESOURCE_IO }, |
1140 | }; |
1141 | int err, i, res_count; |
1142 | |
1143 | res_count = 0; |
1144 | for (i = 0; i < 2; i++) { |
1145 | if (!sio_data->address[i]) |
1146 | continue; |
1147 | res[res_count].start = sio_data->address[i]; |
1148 | res[res_count].end = sio_data->address[i] + REGION_LENGTH - 1; |
1149 | res[res_count].name = logdev_str[i]; |
1150 | |
1151 | err = acpi_check_resource_conflict(res: &res[res_count]); |
1152 | if (err) |
1153 | goto exit; |
1154 | |
1155 | res_count++; |
1156 | } |
1157 | |
1158 | pdev = platform_device_alloc(DRVNAME, id: res[0].start); |
1159 | if (!pdev) { |
1160 | err = -ENOMEM; |
1161 | pr_err("Device allocation failed\n" ); |
1162 | goto exit; |
1163 | } |
1164 | |
1165 | err = platform_device_add_resources(pdev, res, num: res_count); |
1166 | if (err) { |
1167 | pr_err("Device resource addition failed (%d)\n" , err); |
1168 | goto exit_device_put; |
1169 | } |
1170 | |
1171 | err = platform_device_add_data(pdev, data: sio_data, |
1172 | size: sizeof(struct pc87427_sio_data)); |
1173 | if (err) { |
1174 | pr_err("Platform data allocation failed\n" ); |
1175 | goto exit_device_put; |
1176 | } |
1177 | |
1178 | err = platform_device_add(pdev); |
1179 | if (err) { |
1180 | pr_err("Device addition failed (%d)\n" , err); |
1181 | goto exit_device_put; |
1182 | } |
1183 | |
1184 | return 0; |
1185 | |
1186 | exit_device_put: |
1187 | platform_device_put(pdev); |
1188 | exit: |
1189 | return err; |
1190 | } |
1191 | |
1192 | static int __init pc87427_find(int sioaddr, struct pc87427_sio_data *sio_data) |
1193 | { |
1194 | u16 val; |
1195 | u8 cfg, cfg_b; |
1196 | int i, err; |
1197 | |
1198 | err = superio_enter(sioaddr); |
1199 | if (err) |
1200 | return err; |
1201 | |
1202 | /* Identify device */ |
1203 | val = force_id ? force_id : superio_inb(sioaddr, SIOREG_DEVID); |
1204 | if (val != 0xf2) { /* PC87427 */ |
1205 | err = -ENODEV; |
1206 | goto exit; |
1207 | } |
1208 | |
1209 | for (i = 0; i < 2; i++) { |
1210 | sio_data->address[i] = 0; |
1211 | /* Select logical device */ |
1212 | superio_outb(sioaddr, SIOREG_LDSEL, val: logdev[i]); |
1213 | |
1214 | val = superio_inb(sioaddr, SIOREG_ACT); |
1215 | if (!(val & 0x01)) { |
1216 | pr_info("Logical device 0x%02x not activated\n" , |
1217 | logdev[i]); |
1218 | continue; |
1219 | } |
1220 | |
1221 | val = superio_inb(sioaddr, SIOREG_MAP); |
1222 | if (val & 0x01) { |
1223 | pr_warn("Logical device 0x%02x is memory-mapped, can't use\n" , |
1224 | logdev[i]); |
1225 | continue; |
1226 | } |
1227 | |
1228 | val = (superio_inb(sioaddr, SIOREG_IOBASE) << 8) |
1229 | | superio_inb(sioaddr, SIOREG_IOBASE + 1); |
1230 | if (!val) { |
1231 | pr_info("I/O base address not set for logical device 0x%02x\n" , |
1232 | logdev[i]); |
1233 | continue; |
1234 | } |
1235 | sio_data->address[i] = val; |
1236 | } |
1237 | |
1238 | /* No point in loading the driver if everything is disabled */ |
1239 | if (!sio_data->address[0] && !sio_data->address[1]) { |
1240 | err = -ENODEV; |
1241 | goto exit; |
1242 | } |
1243 | |
1244 | /* Check which fan inputs are wired */ |
1245 | sio_data->has_fanin = (1 << 2) | (1 << 3); /* FANIN2, FANIN3 */ |
1246 | |
1247 | cfg = superio_inb(sioaddr, SIOREG_CF2); |
1248 | if (!(cfg & (1 << 3))) |
1249 | sio_data->has_fanin |= (1 << 0); /* FANIN0 */ |
1250 | if (!(cfg & (1 << 2))) |
1251 | sio_data->has_fanin |= (1 << 4); /* FANIN4 */ |
1252 | |
1253 | cfg = superio_inb(sioaddr, SIOREG_CFD); |
1254 | if (!(cfg & (1 << 0))) |
1255 | sio_data->has_fanin |= (1 << 1); /* FANIN1 */ |
1256 | |
1257 | cfg = superio_inb(sioaddr, SIOREG_CF4); |
1258 | if (!(cfg & (1 << 0))) |
1259 | sio_data->has_fanin |= (1 << 7); /* FANIN7 */ |
1260 | cfg_b = superio_inb(sioaddr, SIOREG_CFB); |
1261 | if (!(cfg & (1 << 1)) && (cfg_b & (1 << 3))) |
1262 | sio_data->has_fanin |= (1 << 5); /* FANIN5 */ |
1263 | cfg = superio_inb(sioaddr, SIOREG_CF3); |
1264 | if ((cfg & (1 << 3)) && !(cfg_b & (1 << 5))) |
1265 | sio_data->has_fanin |= (1 << 6); /* FANIN6 */ |
1266 | |
1267 | /* Check which fan outputs are wired */ |
1268 | sio_data->has_fanout = (1 << 0); /* FANOUT0 */ |
1269 | if (cfg_b & (1 << 0)) |
1270 | sio_data->has_fanout |= (1 << 3); /* FANOUT3 */ |
1271 | |
1272 | cfg = superio_inb(sioaddr, SIOREG_CFC); |
1273 | if (!(cfg & (1 << 4))) { |
1274 | if (cfg_b & (1 << 1)) |
1275 | sio_data->has_fanout |= (1 << 1); /* FANOUT1 */ |
1276 | if (cfg_b & (1 << 2)) |
1277 | sio_data->has_fanout |= (1 << 2); /* FANOUT2 */ |
1278 | } |
1279 | |
1280 | /* FANOUT1 and FANOUT2 can each be routed to 2 different pins */ |
1281 | cfg = superio_inb(sioaddr, SIOREG_CF5); |
1282 | if (cfg & (1 << 6)) |
1283 | sio_data->has_fanout |= (1 << 1); /* FANOUT1 */ |
1284 | if (cfg & (1 << 5)) |
1285 | sio_data->has_fanout |= (1 << 2); /* FANOUT2 */ |
1286 | |
1287 | exit: |
1288 | superio_exit(sioaddr); |
1289 | return err; |
1290 | } |
1291 | |
1292 | static int __init pc87427_init(void) |
1293 | { |
1294 | int err; |
1295 | struct pc87427_sio_data sio_data; |
1296 | |
1297 | if (pc87427_find(sioaddr: 0x2e, sio_data: &sio_data) |
1298 | && pc87427_find(sioaddr: 0x4e, sio_data: &sio_data)) |
1299 | return -ENODEV; |
1300 | |
1301 | err = platform_driver_register(&pc87427_driver); |
1302 | if (err) |
1303 | goto exit; |
1304 | |
1305 | /* Sets global pdev as a side effect */ |
1306 | err = pc87427_device_add(sio_data: &sio_data); |
1307 | if (err) |
1308 | goto exit_driver; |
1309 | |
1310 | return 0; |
1311 | |
1312 | exit_driver: |
1313 | platform_driver_unregister(&pc87427_driver); |
1314 | exit: |
1315 | return err; |
1316 | } |
1317 | |
1318 | static void __exit pc87427_exit(void) |
1319 | { |
1320 | platform_device_unregister(pdev); |
1321 | platform_driver_unregister(&pc87427_driver); |
1322 | } |
1323 | |
1324 | MODULE_AUTHOR("Jean Delvare <jdelvare@suse.de>" ); |
1325 | MODULE_DESCRIPTION("PC87427 hardware monitoring driver" ); |
1326 | MODULE_LICENSE("GPL" ); |
1327 | |
1328 | module_init(pc87427_init); |
1329 | module_exit(pc87427_exit); |
1330 | |