Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | smsc47m1.c - Part of lm_sensors, Linux kernel modules | |
3 | for hardware monitoring | |
4 | ||
6091780e | 5 | Supports the SMSC LPC47B27x, LPC47M10x, LPC47M112, LPC47M13x, |
8eccbb6f JD |
6 | LPC47M14x, LPC47M15x, LPC47M192, LPC47M292 and LPC47M997 |
7 | Super-I/O chips. | |
1da177e4 LT |
8 | |
9 | Copyright (C) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com> | |
8eccbb6f | 10 | Copyright (C) 2004-2007 Jean Delvare <khali@linux-fr.org> |
1da177e4 LT |
11 | Ported to Linux 2.6 by Gabriele Gorla <gorlik@yahoo.com> |
12 | and Jean Delvare | |
13 | ||
14 | This program is free software; you can redistribute it and/or modify | |
15 | it under the terms of the GNU General Public License as published by | |
16 | the Free Software Foundation; either version 2 of the License, or | |
17 | (at your option) any later version. | |
18 | ||
19 | This program is distributed in the hope that it will be useful, | |
20 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
21 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
22 | GNU General Public License for more details. | |
23 | ||
24 | You should have received a copy of the GNU General Public License | |
25 | along with this program; if not, write to the Free Software | |
26 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
27 | */ | |
28 | ||
29 | #include <linux/module.h> | |
30 | #include <linux/slab.h> | |
31 | #include <linux/ioport.h> | |
32 | #include <linux/jiffies.h> | |
33 | #include <linux/i2c.h> | |
fde09509 | 34 | #include <linux/i2c-isa.h> |
943b0830 MH |
35 | #include <linux/hwmon.h> |
36 | #include <linux/err.h> | |
1da177e4 | 37 | #include <linux/init.h> |
9a61bf63 | 38 | #include <linux/mutex.h> |
ce8c6ce1 | 39 | #include <linux/sysfs.h> |
1da177e4 LT |
40 | #include <asm/io.h> |
41 | ||
1da177e4 | 42 | /* Address is autodetected, there is no default value */ |
2d8672c5 | 43 | static unsigned short address; |
8eccbb6f JD |
44 | static u8 devid; |
45 | enum chips { smsc47m1, smsc47m2 }; | |
1da177e4 LT |
46 | |
47 | /* Super-I/0 registers and commands */ | |
48 | ||
49 | #define REG 0x2e /* The register to read/write */ | |
50 | #define VAL 0x2f /* The value to read/write */ | |
51 | ||
52 | static inline void | |
53 | superio_outb(int reg, int val) | |
54 | { | |
55 | outb(reg, REG); | |
56 | outb(val, VAL); | |
57 | } | |
58 | ||
59 | static inline int | |
60 | superio_inb(int reg) | |
61 | { | |
62 | outb(reg, REG); | |
63 | return inb(VAL); | |
64 | } | |
65 | ||
66 | /* logical device for fans is 0x0A */ | |
67 | #define superio_select() superio_outb(0x07, 0x0A) | |
68 | ||
69 | static inline void | |
70 | superio_enter(void) | |
71 | { | |
72 | outb(0x55, REG); | |
73 | } | |
74 | ||
75 | static inline void | |
76 | superio_exit(void) | |
77 | { | |
78 | outb(0xAA, REG); | |
79 | } | |
80 | ||
81 | #define SUPERIO_REG_ACT 0x30 | |
82 | #define SUPERIO_REG_BASE 0x60 | |
83 | #define SUPERIO_REG_DEVID 0x20 | |
84 | ||
85 | /* Logical device registers */ | |
86 | ||
87 | #define SMSC_EXTENT 0x80 | |
88 | ||
89 | /* nr is 0 or 1 in the macros below */ | |
90 | #define SMSC47M1_REG_ALARM 0x04 | |
91 | #define SMSC47M1_REG_TPIN(nr) (0x34 - (nr)) | |
92 | #define SMSC47M1_REG_PPIN(nr) (0x36 - (nr)) | |
1da177e4 | 93 | #define SMSC47M1_REG_FANDIV 0x58 |
8eccbb6f JD |
94 | |
95 | static const u8 SMSC47M1_REG_FAN[3] = { 0x59, 0x5a, 0x6b }; | |
96 | static const u8 SMSC47M1_REG_FAN_PRELOAD[3] = { 0x5b, 0x5c, 0x6c }; | |
97 | static const u8 SMSC47M1_REG_PWM[3] = { 0x56, 0x57, 0x69 }; | |
98 | ||
99 | #define SMSC47M2_REG_ALARM6 0x09 | |
100 | #define SMSC47M2_REG_TPIN1 0x38 | |
101 | #define SMSC47M2_REG_TPIN2 0x37 | |
102 | #define SMSC47M2_REG_TPIN3 0x2d | |
103 | #define SMSC47M2_REG_PPIN3 0x2c | |
104 | #define SMSC47M2_REG_FANDIV3 0x6a | |
1da177e4 LT |
105 | |
106 | #define MIN_FROM_REG(reg,div) ((reg)>=192 ? 0 : \ | |
107 | 983040/((192-(reg))*(div))) | |
108 | #define FAN_FROM_REG(reg,div,preload) ((reg)<=(preload) || (reg)==255 ? 0 : \ | |
109 | 983040/(((reg)-(preload))*(div))) | |
110 | #define DIV_FROM_REG(reg) (1 << (reg)) | |
111 | #define PWM_FROM_REG(reg) (((reg) & 0x7E) << 1) | |
112 | #define PWM_EN_FROM_REG(reg) ((~(reg)) & 0x01) | |
113 | #define PWM_TO_REG(reg) (((reg) >> 1) & 0x7E) | |
114 | ||
115 | struct smsc47m1_data { | |
116 | struct i2c_client client; | |
8eccbb6f | 117 | enum chips type; |
943b0830 | 118 | struct class_device *class_dev; |
9a61bf63 | 119 | struct mutex lock; |
1da177e4 | 120 | |
9a61bf63 | 121 | struct mutex update_lock; |
1da177e4 LT |
122 | unsigned long last_updated; /* In jiffies */ |
123 | ||
8eccbb6f JD |
124 | u8 fan[3]; /* Register value */ |
125 | u8 fan_preload[3]; /* Register value */ | |
126 | u8 fan_div[3]; /* Register encoding, shifted right */ | |
1da177e4 | 127 | u8 alarms; /* Register encoding */ |
8eccbb6f | 128 | u8 pwm[3]; /* Register value (bit 0 is disable) */ |
1da177e4 LT |
129 | }; |
130 | ||
131 | ||
2d8672c5 | 132 | static int smsc47m1_detect(struct i2c_adapter *adapter); |
1da177e4 LT |
133 | static int smsc47m1_detach_client(struct i2c_client *client); |
134 | ||
135 | static int smsc47m1_read_value(struct i2c_client *client, u8 reg); | |
136 | static void smsc47m1_write_value(struct i2c_client *client, u8 reg, u8 value); | |
137 | ||
138 | static struct smsc47m1_data *smsc47m1_update_device(struct device *dev, | |
139 | int init); | |
140 | ||
141 | ||
142 | static struct i2c_driver smsc47m1_driver = { | |
cdaf7934 | 143 | .driver = { |
87218842 | 144 | .owner = THIS_MODULE, |
cdaf7934 LR |
145 | .name = "smsc47m1", |
146 | }, | |
2d8672c5 | 147 | .attach_adapter = smsc47m1_detect, |
1da177e4 LT |
148 | .detach_client = smsc47m1_detach_client, |
149 | }; | |
150 | ||
151 | /* nr is 0 or 1 in the callback functions below */ | |
152 | ||
153 | static ssize_t get_fan(struct device *dev, char *buf, int nr) | |
154 | { | |
155 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
156 | /* This chip (stupidly) stops monitoring fan speed if PWM is | |
157 | enabled and duty cycle is 0%. This is fine if the monitoring | |
158 | and control concern the same fan, but troublesome if they are | |
159 | not (which could as well happen). */ | |
160 | int rpm = (data->pwm[nr] & 0x7F) == 0x00 ? 0 : | |
161 | FAN_FROM_REG(data->fan[nr], | |
162 | DIV_FROM_REG(data->fan_div[nr]), | |
163 | data->fan_preload[nr]); | |
164 | return sprintf(buf, "%d\n", rpm); | |
165 | } | |
166 | ||
167 | static ssize_t get_fan_min(struct device *dev, char *buf, int nr) | |
168 | { | |
169 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
170 | int rpm = MIN_FROM_REG(data->fan_preload[nr], | |
171 | DIV_FROM_REG(data->fan_div[nr])); | |
172 | return sprintf(buf, "%d\n", rpm); | |
173 | } | |
174 | ||
175 | static ssize_t get_fan_div(struct device *dev, char *buf, int nr) | |
176 | { | |
177 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
178 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr])); | |
179 | } | |
180 | ||
181 | static ssize_t get_pwm(struct device *dev, char *buf, int nr) | |
182 | { | |
183 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
184 | return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr])); | |
185 | } | |
186 | ||
187 | static ssize_t get_pwm_en(struct device *dev, char *buf, int nr) | |
188 | { | |
189 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
190 | return sprintf(buf, "%d\n", PWM_EN_FROM_REG(data->pwm[nr])); | |
191 | } | |
192 | ||
a5099cfc | 193 | static ssize_t get_alarms(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4 LT |
194 | { |
195 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
196 | return sprintf(buf, "%d\n", data->alarms); | |
197 | } | |
198 | ||
199 | static ssize_t set_fan_min(struct device *dev, const char *buf, | |
200 | size_t count, int nr) | |
201 | { | |
202 | struct i2c_client *client = to_i2c_client(dev); | |
203 | struct smsc47m1_data *data = i2c_get_clientdata(client); | |
204 | long rpmdiv, val = simple_strtol(buf, NULL, 10); | |
205 | ||
9a61bf63 | 206 | mutex_lock(&data->update_lock); |
1da177e4 LT |
207 | rpmdiv = val * DIV_FROM_REG(data->fan_div[nr]); |
208 | ||
209 | if (983040 > 192 * rpmdiv || 2 * rpmdiv > 983040) { | |
9a61bf63 | 210 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
211 | return -EINVAL; |
212 | } | |
213 | ||
214 | data->fan_preload[nr] = 192 - ((983040 + rpmdiv / 2) / rpmdiv); | |
8eccbb6f | 215 | smsc47m1_write_value(client, SMSC47M1_REG_FAN_PRELOAD[nr], |
1da177e4 | 216 | data->fan_preload[nr]); |
9a61bf63 | 217 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
218 | |
219 | return count; | |
220 | } | |
221 | ||
222 | /* Note: we save and restore the fan minimum here, because its value is | |
223 | determined in part by the fan clock divider. This follows the principle | |
d6e05edc | 224 | of least surprise; the user doesn't expect the fan minimum to change just |
1da177e4 LT |
225 | because the divider changed. */ |
226 | static ssize_t set_fan_div(struct device *dev, const char *buf, | |
227 | size_t count, int nr) | |
228 | { | |
229 | struct i2c_client *client = to_i2c_client(dev); | |
230 | struct smsc47m1_data *data = i2c_get_clientdata(client); | |
231 | ||
232 | long new_div = simple_strtol(buf, NULL, 10), tmp; | |
233 | u8 old_div = DIV_FROM_REG(data->fan_div[nr]); | |
234 | ||
235 | if (new_div == old_div) /* No change */ | |
236 | return count; | |
237 | ||
9a61bf63 | 238 | mutex_lock(&data->update_lock); |
1da177e4 LT |
239 | switch (new_div) { |
240 | case 1: data->fan_div[nr] = 0; break; | |
241 | case 2: data->fan_div[nr] = 1; break; | |
242 | case 4: data->fan_div[nr] = 2; break; | |
243 | case 8: data->fan_div[nr] = 3; break; | |
244 | default: | |
9a61bf63 | 245 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
246 | return -EINVAL; |
247 | } | |
248 | ||
8eccbb6f JD |
249 | switch (nr) { |
250 | case 0: | |
251 | case 1: | |
252 | tmp = smsc47m1_read_value(client, SMSC47M1_REG_FANDIV) | |
253 | & ~(0x03 << (4 + 2 * nr)); | |
254 | tmp |= data->fan_div[nr] << (4 + 2 * nr); | |
255 | smsc47m1_write_value(client, SMSC47M1_REG_FANDIV, tmp); | |
256 | break; | |
257 | case 2: | |
258 | tmp = smsc47m1_read_value(client, SMSC47M2_REG_FANDIV3) & 0xCF; | |
259 | tmp |= data->fan_div[2] << 4; | |
260 | smsc47m1_write_value(client, SMSC47M2_REG_FANDIV3, tmp); | |
261 | break; | |
262 | } | |
1da177e4 LT |
263 | |
264 | /* Preserve fan min */ | |
265 | tmp = 192 - (old_div * (192 - data->fan_preload[nr]) | |
266 | + new_div / 2) / new_div; | |
267 | data->fan_preload[nr] = SENSORS_LIMIT(tmp, 0, 191); | |
8eccbb6f | 268 | smsc47m1_write_value(client, SMSC47M1_REG_FAN_PRELOAD[nr], |
1da177e4 | 269 | data->fan_preload[nr]); |
9a61bf63 | 270 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
271 | |
272 | return count; | |
273 | } | |
274 | ||
275 | static ssize_t set_pwm(struct device *dev, const char *buf, | |
276 | size_t count, int nr) | |
277 | { | |
278 | struct i2c_client *client = to_i2c_client(dev); | |
279 | struct smsc47m1_data *data = i2c_get_clientdata(client); | |
280 | ||
281 | long val = simple_strtol(buf, NULL, 10); | |
282 | ||
283 | if (val < 0 || val > 255) | |
284 | return -EINVAL; | |
285 | ||
9a61bf63 | 286 | mutex_lock(&data->update_lock); |
1da177e4 LT |
287 | data->pwm[nr] &= 0x81; /* Preserve additional bits */ |
288 | data->pwm[nr] |= PWM_TO_REG(val); | |
8eccbb6f | 289 | smsc47m1_write_value(client, SMSC47M1_REG_PWM[nr], |
1da177e4 | 290 | data->pwm[nr]); |
9a61bf63 | 291 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
292 | |
293 | return count; | |
294 | } | |
295 | ||
296 | static ssize_t set_pwm_en(struct device *dev, const char *buf, | |
297 | size_t count, int nr) | |
298 | { | |
299 | struct i2c_client *client = to_i2c_client(dev); | |
300 | struct smsc47m1_data *data = i2c_get_clientdata(client); | |
301 | ||
302 | long val = simple_strtol(buf, NULL, 10); | |
303 | ||
304 | if (val != 0 && val != 1) | |
305 | return -EINVAL; | |
306 | ||
9a61bf63 | 307 | mutex_lock(&data->update_lock); |
1da177e4 LT |
308 | data->pwm[nr] &= 0xFE; /* preserve the other bits */ |
309 | data->pwm[nr] |= !val; | |
8eccbb6f | 310 | smsc47m1_write_value(client, SMSC47M1_REG_PWM[nr], |
1da177e4 | 311 | data->pwm[nr]); |
9a61bf63 | 312 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
313 | |
314 | return count; | |
315 | } | |
316 | ||
317 | #define fan_present(offset) \ | |
a5099cfc | 318 | static ssize_t get_fan##offset (struct device *dev, struct device_attribute *attr, char *buf) \ |
1da177e4 LT |
319 | { \ |
320 | return get_fan(dev, buf, offset - 1); \ | |
321 | } \ | |
a5099cfc | 322 | static ssize_t get_fan##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ |
1da177e4 LT |
323 | { \ |
324 | return get_fan_min(dev, buf, offset - 1); \ | |
325 | } \ | |
a5099cfc | 326 | static ssize_t set_fan##offset##_min (struct device *dev, struct device_attribute *attr, \ |
1da177e4 LT |
327 | const char *buf, size_t count) \ |
328 | { \ | |
329 | return set_fan_min(dev, buf, count, offset - 1); \ | |
330 | } \ | |
a5099cfc | 331 | static ssize_t get_fan##offset##_div (struct device *dev, struct device_attribute *attr, char *buf) \ |
1da177e4 LT |
332 | { \ |
333 | return get_fan_div(dev, buf, offset - 1); \ | |
334 | } \ | |
a5099cfc | 335 | static ssize_t set_fan##offset##_div (struct device *dev, struct device_attribute *attr, \ |
1da177e4 LT |
336 | const char *buf, size_t count) \ |
337 | { \ | |
338 | return set_fan_div(dev, buf, count, offset - 1); \ | |
339 | } \ | |
a5099cfc | 340 | static ssize_t get_pwm##offset (struct device *dev, struct device_attribute *attr, char *buf) \ |
1da177e4 LT |
341 | { \ |
342 | return get_pwm(dev, buf, offset - 1); \ | |
343 | } \ | |
a5099cfc | 344 | static ssize_t set_pwm##offset (struct device *dev, struct device_attribute *attr, \ |
1da177e4 LT |
345 | const char *buf, size_t count) \ |
346 | { \ | |
347 | return set_pwm(dev, buf, count, offset - 1); \ | |
348 | } \ | |
a5099cfc | 349 | static ssize_t get_pwm##offset##_en (struct device *dev, struct device_attribute *attr, char *buf) \ |
1da177e4 LT |
350 | { \ |
351 | return get_pwm_en(dev, buf, offset - 1); \ | |
352 | } \ | |
a5099cfc | 353 | static ssize_t set_pwm##offset##_en (struct device *dev, struct device_attribute *attr, \ |
1da177e4 LT |
354 | const char *buf, size_t count) \ |
355 | { \ | |
356 | return set_pwm_en(dev, buf, count, offset - 1); \ | |
357 | } \ | |
358 | static DEVICE_ATTR(fan##offset##_input, S_IRUGO, get_fan##offset, \ | |
359 | NULL); \ | |
360 | static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ | |
361 | get_fan##offset##_min, set_fan##offset##_min); \ | |
362 | static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ | |
363 | get_fan##offset##_div, set_fan##offset##_div); \ | |
364 | static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \ | |
365 | get_pwm##offset, set_pwm##offset); \ | |
366 | static DEVICE_ATTR(pwm##offset##_enable, S_IRUGO | S_IWUSR, \ | |
367 | get_pwm##offset##_en, set_pwm##offset##_en); | |
368 | ||
369 | fan_present(1); | |
370 | fan_present(2); | |
8eccbb6f | 371 | fan_present(3); |
1da177e4 LT |
372 | |
373 | static DEVICE_ATTR(alarms, S_IRUGO, get_alarms, NULL); | |
374 | ||
ce8c6ce1 JD |
375 | /* Almost all sysfs files may or may not be created depending on the chip |
376 | setup so we create them individually. It is still convenient to define a | |
377 | group to remove them all at once. */ | |
378 | static struct attribute *smsc47m1_attributes[] = { | |
379 | &dev_attr_fan1_input.attr, | |
380 | &dev_attr_fan1_min.attr, | |
381 | &dev_attr_fan1_div.attr, | |
382 | &dev_attr_fan2_input.attr, | |
383 | &dev_attr_fan2_min.attr, | |
384 | &dev_attr_fan2_div.attr, | |
8eccbb6f JD |
385 | &dev_attr_fan3_input.attr, |
386 | &dev_attr_fan3_min.attr, | |
387 | &dev_attr_fan3_div.attr, | |
ce8c6ce1 JD |
388 | |
389 | &dev_attr_pwm1.attr, | |
390 | &dev_attr_pwm1_enable.attr, | |
391 | &dev_attr_pwm2.attr, | |
392 | &dev_attr_pwm2_enable.attr, | |
8eccbb6f JD |
393 | &dev_attr_pwm3.attr, |
394 | &dev_attr_pwm3_enable.attr, | |
ce8c6ce1 JD |
395 | |
396 | &dev_attr_alarms.attr, | |
397 | NULL | |
398 | }; | |
399 | ||
400 | static const struct attribute_group smsc47m1_group = { | |
401 | .attrs = smsc47m1_attributes, | |
402 | }; | |
403 | ||
e6cfb3ad | 404 | static int __init smsc47m1_find(unsigned short *addr) |
1da177e4 LT |
405 | { |
406 | u8 val; | |
407 | ||
408 | superio_enter(); | |
8eccbb6f | 409 | devid = superio_inb(SUPERIO_REG_DEVID); |
1da177e4 LT |
410 | |
411 | /* | |
6091780e JD |
412 | * SMSC LPC47M10x/LPC47M112/LPC47M13x (device id 0x59), LPC47M14x |
413 | * (device id 0x5F) and LPC47B27x (device id 0x51) have fan control. | |
1da177e4 | 414 | * The LPC47M15x and LPC47M192 chips "with hardware monitoring block" |
ec5ce552 | 415 | * can do much more besides (device id 0x60). |
b890a07f JD |
416 | * The LPC47M997 is undocumented, but seems to be compatible with |
417 | * the LPC47M192, and has the same device id. | |
8eccbb6f JD |
418 | * The LPC47M292 (device id 0x6B) is somewhat compatible, but it |
419 | * supports a 3rd fan, and the pin configuration registers are | |
420 | * unfortunately different. | |
1da177e4 | 421 | */ |
8eccbb6f JD |
422 | switch (devid) { |
423 | case 0x51: | |
ec5ce552 | 424 | printk(KERN_INFO "smsc47m1: Found SMSC LPC47B27x\n"); |
8eccbb6f JD |
425 | break; |
426 | case 0x59: | |
6091780e JD |
427 | printk(KERN_INFO "smsc47m1: Found SMSC " |
428 | "LPC47M10x/LPC47M112/LPC47M13x\n"); | |
8eccbb6f JD |
429 | break; |
430 | case 0x5F: | |
ec5ce552 | 431 | printk(KERN_INFO "smsc47m1: Found SMSC LPC47M14x\n"); |
8eccbb6f JD |
432 | break; |
433 | case 0x60: | |
b890a07f JD |
434 | printk(KERN_INFO "smsc47m1: Found SMSC " |
435 | "LPC47M15x/LPC47M192/LPC47M997\n"); | |
8eccbb6f JD |
436 | break; |
437 | case 0x6B: | |
438 | printk(KERN_INFO "smsc47m1: Found SMSC LPC47M292\n"); | |
439 | break; | |
440 | default: | |
1da177e4 LT |
441 | superio_exit(); |
442 | return -ENODEV; | |
443 | } | |
444 | ||
445 | superio_select(); | |
2d8672c5 JD |
446 | *addr = (superio_inb(SUPERIO_REG_BASE) << 8) |
447 | | superio_inb(SUPERIO_REG_BASE + 1); | |
1da177e4 | 448 | val = superio_inb(SUPERIO_REG_ACT); |
2d8672c5 | 449 | if (*addr == 0 || (val & 0x01) == 0) { |
1da177e4 LT |
450 | printk(KERN_INFO "smsc47m1: Device is disabled, will not use\n"); |
451 | superio_exit(); | |
452 | return -ENODEV; | |
453 | } | |
454 | ||
455 | superio_exit(); | |
456 | return 0; | |
457 | } | |
458 | ||
2d8672c5 | 459 | static int smsc47m1_detect(struct i2c_adapter *adapter) |
1da177e4 LT |
460 | { |
461 | struct i2c_client *new_client; | |
462 | struct smsc47m1_data *data; | |
463 | int err = 0; | |
8eccbb6f | 464 | int fan1, fan2, fan3, pwm1, pwm2, pwm3; |
1da177e4 | 465 | |
cdaf7934 | 466 | if (!request_region(address, SMSC_EXTENT, smsc47m1_driver.driver.name)) { |
1da177e4 LT |
467 | dev_err(&adapter->dev, "Region 0x%x already in use!\n", address); |
468 | return -EBUSY; | |
469 | } | |
470 | ||
ba9c2e8d | 471 | if (!(data = kzalloc(sizeof(struct smsc47m1_data), GFP_KERNEL))) { |
1da177e4 LT |
472 | err = -ENOMEM; |
473 | goto error_release; | |
474 | } | |
1da177e4 | 475 | |
8eccbb6f | 476 | data->type = devid == 0x6B ? smsc47m2 : smsc47m1; |
1da177e4 LT |
477 | new_client = &data->client; |
478 | i2c_set_clientdata(new_client, data); | |
479 | new_client->addr = address; | |
9a61bf63 | 480 | mutex_init(&data->lock); |
1da177e4 LT |
481 | new_client->adapter = adapter; |
482 | new_client->driver = &smsc47m1_driver; | |
483 | new_client->flags = 0; | |
484 | ||
8eccbb6f JD |
485 | strlcpy(new_client->name, |
486 | data->type == smsc47m2 ? "smsc47m2" : "smsc47m1", | |
487 | I2C_NAME_SIZE); | |
9a61bf63 | 488 | mutex_init(&data->update_lock); |
1da177e4 LT |
489 | |
490 | /* If no function is properly configured, there's no point in | |
491 | actually registering the chip. */ | |
1da177e4 LT |
492 | pwm1 = (smsc47m1_read_value(new_client, SMSC47M1_REG_PPIN(0)) & 0x05) |
493 | == 0x04; | |
494 | pwm2 = (smsc47m1_read_value(new_client, SMSC47M1_REG_PPIN(1)) & 0x05) | |
495 | == 0x04; | |
8eccbb6f JD |
496 | if (data->type == smsc47m2) { |
497 | fan1 = (smsc47m1_read_value(new_client, SMSC47M2_REG_TPIN1) | |
498 | & 0x0d) == 0x09; | |
499 | fan2 = (smsc47m1_read_value(new_client, SMSC47M2_REG_TPIN2) | |
500 | & 0x0d) == 0x09; | |
501 | fan3 = (smsc47m1_read_value(new_client, SMSC47M2_REG_TPIN3) | |
502 | & 0x0d) == 0x0d; | |
503 | pwm3 = (smsc47m1_read_value(new_client, SMSC47M2_REG_PPIN3) | |
504 | & 0x0d) == 0x08; | |
505 | } else { | |
506 | fan1 = (smsc47m1_read_value(new_client, SMSC47M1_REG_TPIN(0)) | |
507 | & 0x05) == 0x05; | |
508 | fan2 = (smsc47m1_read_value(new_client, SMSC47M1_REG_TPIN(1)) | |
509 | & 0x05) == 0x05; | |
510 | fan3 = 0; | |
511 | pwm3 = 0; | |
512 | } | |
513 | if (!(fan1 || fan2 || fan3 || pwm1 || pwm2 || pwm3)) { | |
0dd7699e JD |
514 | dev_warn(&adapter->dev, "Device at 0x%x is not configured, " |
515 | "will not use\n", new_client->addr); | |
1da177e4 LT |
516 | err = -ENODEV; |
517 | goto error_free; | |
518 | } | |
519 | ||
520 | if ((err = i2c_attach_client(new_client))) | |
521 | goto error_free; | |
522 | ||
523 | /* Some values (fan min, clock dividers, pwm registers) may be | |
524 | needed before any update is triggered, so we better read them | |
525 | at least once here. We don't usually do it that way, but in | |
526 | this particular case, manually reading 5 registers out of 8 | |
527 | doesn't make much sense and we're better using the existing | |
528 | function. */ | |
529 | smsc47m1_update_device(&new_client->dev, 1); | |
530 | ||
943b0830 | 531 | /* Register sysfs hooks */ |
1da177e4 | 532 | if (fan1) { |
ce8c6ce1 JD |
533 | if ((err = device_create_file(&new_client->dev, |
534 | &dev_attr_fan1_input)) | |
535 | || (err = device_create_file(&new_client->dev, | |
536 | &dev_attr_fan1_min)) | |
537 | || (err = device_create_file(&new_client->dev, | |
538 | &dev_attr_fan1_div))) | |
539 | goto error_remove_files; | |
1da177e4 LT |
540 | } else |
541 | dev_dbg(&new_client->dev, "Fan 1 not enabled by hardware, " | |
542 | "skipping\n"); | |
543 | ||
544 | if (fan2) { | |
ce8c6ce1 JD |
545 | if ((err = device_create_file(&new_client->dev, |
546 | &dev_attr_fan2_input)) | |
547 | || (err = device_create_file(&new_client->dev, | |
548 | &dev_attr_fan2_min)) | |
549 | || (err = device_create_file(&new_client->dev, | |
550 | &dev_attr_fan2_div))) | |
551 | goto error_remove_files; | |
1da177e4 LT |
552 | } else |
553 | dev_dbg(&new_client->dev, "Fan 2 not enabled by hardware, " | |
554 | "skipping\n"); | |
555 | ||
8eccbb6f JD |
556 | if (fan3) { |
557 | if ((err = device_create_file(&new_client->dev, | |
558 | &dev_attr_fan3_input)) | |
559 | || (err = device_create_file(&new_client->dev, | |
560 | &dev_attr_fan3_min)) | |
561 | || (err = device_create_file(&new_client->dev, | |
562 | &dev_attr_fan3_div))) | |
563 | goto error_remove_files; | |
564 | } else | |
565 | dev_dbg(&new_client->dev, "Fan 3 not enabled by hardware, " | |
566 | "skipping\n"); | |
567 | ||
1da177e4 | 568 | if (pwm1) { |
ce8c6ce1 JD |
569 | if ((err = device_create_file(&new_client->dev, |
570 | &dev_attr_pwm1)) | |
571 | || (err = device_create_file(&new_client->dev, | |
572 | &dev_attr_pwm1_enable))) | |
573 | goto error_remove_files; | |
1da177e4 LT |
574 | } else |
575 | dev_dbg(&new_client->dev, "PWM 1 not enabled by hardware, " | |
576 | "skipping\n"); | |
8eccbb6f | 577 | |
1da177e4 | 578 | if (pwm2) { |
ce8c6ce1 JD |
579 | if ((err = device_create_file(&new_client->dev, |
580 | &dev_attr_pwm2)) | |
581 | || (err = device_create_file(&new_client->dev, | |
582 | &dev_attr_pwm2_enable))) | |
583 | goto error_remove_files; | |
1da177e4 LT |
584 | } else |
585 | dev_dbg(&new_client->dev, "PWM 2 not enabled by hardware, " | |
586 | "skipping\n"); | |
587 | ||
8eccbb6f JD |
588 | if (pwm3) { |
589 | if ((err = device_create_file(&new_client->dev, | |
590 | &dev_attr_pwm3)) | |
591 | || (err = device_create_file(&new_client->dev, | |
592 | &dev_attr_pwm3_enable))) | |
593 | goto error_remove_files; | |
594 | } else | |
595 | dev_dbg(&new_client->dev, "PWM 3 not enabled by hardware, " | |
596 | "skipping\n"); | |
597 | ||
ce8c6ce1 JD |
598 | if ((err = device_create_file(&new_client->dev, &dev_attr_alarms))) |
599 | goto error_remove_files; | |
600 | ||
601 | data->class_dev = hwmon_device_register(&new_client->dev); | |
602 | if (IS_ERR(data->class_dev)) { | |
603 | err = PTR_ERR(data->class_dev); | |
604 | goto error_remove_files; | |
605 | } | |
1da177e4 LT |
606 | |
607 | return 0; | |
608 | ||
ce8c6ce1 JD |
609 | error_remove_files: |
610 | sysfs_remove_group(&new_client->dev.kobj, &smsc47m1_group); | |
943b0830 | 611 | i2c_detach_client(new_client); |
1da177e4 | 612 | error_free: |
1f57ff89 | 613 | kfree(data); |
1da177e4 LT |
614 | error_release: |
615 | release_region(address, SMSC_EXTENT); | |
616 | return err; | |
617 | } | |
618 | ||
619 | static int smsc47m1_detach_client(struct i2c_client *client) | |
620 | { | |
943b0830 | 621 | struct smsc47m1_data *data = i2c_get_clientdata(client); |
1da177e4 LT |
622 | int err; |
623 | ||
943b0830 | 624 | hwmon_device_unregister(data->class_dev); |
ce8c6ce1 | 625 | sysfs_remove_group(&client->dev.kobj, &smsc47m1_group); |
943b0830 | 626 | |
7bef5594 | 627 | if ((err = i2c_detach_client(client))) |
1da177e4 | 628 | return err; |
1da177e4 LT |
629 | |
630 | release_region(client->addr, SMSC_EXTENT); | |
943b0830 | 631 | kfree(data); |
1da177e4 LT |
632 | |
633 | return 0; | |
634 | } | |
635 | ||
636 | static int smsc47m1_read_value(struct i2c_client *client, u8 reg) | |
637 | { | |
638 | int res; | |
639 | ||
9a61bf63 | 640 | mutex_lock(&((struct smsc47m1_data *) i2c_get_clientdata(client))->lock); |
1da177e4 | 641 | res = inb_p(client->addr + reg); |
9a61bf63 | 642 | mutex_unlock(&((struct smsc47m1_data *) i2c_get_clientdata(client))->lock); |
1da177e4 LT |
643 | return res; |
644 | } | |
645 | ||
646 | static void smsc47m1_write_value(struct i2c_client *client, u8 reg, u8 value) | |
647 | { | |
9a61bf63 | 648 | mutex_lock(&((struct smsc47m1_data *) i2c_get_clientdata(client))->lock); |
1da177e4 | 649 | outb_p(value, client->addr + reg); |
9a61bf63 | 650 | mutex_unlock(&((struct smsc47m1_data *) i2c_get_clientdata(client))->lock); |
1da177e4 LT |
651 | } |
652 | ||
653 | static struct smsc47m1_data *smsc47m1_update_device(struct device *dev, | |
654 | int init) | |
655 | { | |
656 | struct i2c_client *client = to_i2c_client(dev); | |
657 | struct smsc47m1_data *data = i2c_get_clientdata(client); | |
658 | ||
9a61bf63 | 659 | mutex_lock(&data->update_lock); |
1da177e4 LT |
660 | |
661 | if (time_after(jiffies, data->last_updated + HZ + HZ / 2) || init) { | |
8eccbb6f JD |
662 | int i, fan_nr; |
663 | fan_nr = data->type == smsc47m2 ? 3 : 2; | |
1da177e4 | 664 | |
8eccbb6f | 665 | for (i = 0; i < fan_nr; i++) { |
1da177e4 | 666 | data->fan[i] = smsc47m1_read_value(client, |
8eccbb6f | 667 | SMSC47M1_REG_FAN[i]); |
1da177e4 | 668 | data->fan_preload[i] = smsc47m1_read_value(client, |
8eccbb6f | 669 | SMSC47M1_REG_FAN_PRELOAD[i]); |
1da177e4 | 670 | data->pwm[i] = smsc47m1_read_value(client, |
8eccbb6f | 671 | SMSC47M1_REG_PWM[i]); |
1da177e4 LT |
672 | } |
673 | ||
674 | i = smsc47m1_read_value(client, SMSC47M1_REG_FANDIV); | |
675 | data->fan_div[0] = (i >> 4) & 0x03; | |
676 | data->fan_div[1] = i >> 6; | |
677 | ||
678 | data->alarms = smsc47m1_read_value(client, | |
679 | SMSC47M1_REG_ALARM) >> 6; | |
680 | /* Clear alarms if needed */ | |
681 | if (data->alarms) | |
682 | smsc47m1_write_value(client, SMSC47M1_REG_ALARM, 0xC0); | |
683 | ||
8eccbb6f JD |
684 | if (fan_nr >= 3) { |
685 | data->fan_div[2] = (smsc47m1_read_value(client, | |
686 | SMSC47M2_REG_FANDIV3) >> 4) & 0x03; | |
687 | data->alarms |= (smsc47m1_read_value(client, | |
688 | SMSC47M2_REG_ALARM6) & 0x40) >> 4; | |
689 | /* Clear alarm if needed */ | |
690 | if (data->alarms & 0x04) | |
691 | smsc47m1_write_value(client, | |
692 | SMSC47M2_REG_ALARM6, | |
693 | 0x40); | |
694 | } | |
695 | ||
1da177e4 LT |
696 | data->last_updated = jiffies; |
697 | } | |
698 | ||
9a61bf63 | 699 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
700 | return data; |
701 | } | |
702 | ||
703 | static int __init sm_smsc47m1_init(void) | |
704 | { | |
2d8672c5 | 705 | if (smsc47m1_find(&address)) { |
1da177e4 LT |
706 | return -ENODEV; |
707 | } | |
708 | ||
fde09509 | 709 | return i2c_isa_add_driver(&smsc47m1_driver); |
1da177e4 LT |
710 | } |
711 | ||
712 | static void __exit sm_smsc47m1_exit(void) | |
713 | { | |
fde09509 | 714 | i2c_isa_del_driver(&smsc47m1_driver); |
1da177e4 LT |
715 | } |
716 | ||
717 | MODULE_AUTHOR("Mark D. Studebaker <mdsxyz123@yahoo.com>"); | |
718 | MODULE_DESCRIPTION("SMSC LPC47M1xx fan sensors driver"); | |
719 | MODULE_LICENSE("GPL"); | |
720 | ||
721 | module_init(sm_smsc47m1_init); | |
722 | module_exit(sm_smsc47m1_exit); |