Commit | Line | Data |
---|---|---|
74ba9207 | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
1da177e4 | 2 | /* |
85a0c0d1 GR |
3 | * smsc47m1.c - Part of lm_sensors, Linux kernel modules |
4 | * for hardware monitoring | |
5 | * | |
6 | * Supports the SMSC LPC47B27x, LPC47M10x, LPC47M112, LPC47M13x, | |
7 | * LPC47M14x, LPC47M15x, LPC47M192, LPC47M292 and LPC47M997 | |
8 | * Super-I/O chips. | |
9 | * | |
10 | * Copyright (C) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com> | |
7c81c60f | 11 | * Copyright (C) 2004-2007 Jean Delvare <jdelvare@suse.de> |
85a0c0d1 GR |
12 | * Ported to Linux 2.6 by Gabriele Gorla <gorlik@yahoo.com> |
13 | * and Jean Delvare | |
85a0c0d1 | 14 | */ |
1da177e4 | 15 | |
512504e9 JP |
16 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
17 | ||
1da177e4 LT |
18 | #include <linux/module.h> |
19 | #include <linux/slab.h> | |
20 | #include <linux/ioport.h> | |
21 | #include <linux/jiffies.h> | |
51f2cca1 | 22 | #include <linux/platform_device.h> |
943b0830 | 23 | #include <linux/hwmon.h> |
e84cfbcb | 24 | #include <linux/hwmon-sysfs.h> |
943b0830 | 25 | #include <linux/err.h> |
1da177e4 | 26 | #include <linux/init.h> |
9a61bf63 | 27 | #include <linux/mutex.h> |
ce8c6ce1 | 28 | #include <linux/sysfs.h> |
b9acb64a | 29 | #include <linux/acpi.h> |
6055fae8 | 30 | #include <linux/io.h> |
1da177e4 | 31 | |
67b671bc JD |
32 | static unsigned short force_id; |
33 | module_param(force_id, ushort, 0); | |
34 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | |
35 | ||
51f2cca1 JD |
36 | static struct platform_device *pdev; |
37 | ||
38 | #define DRVNAME "smsc47m1" | |
8eccbb6f | 39 | enum chips { smsc47m1, smsc47m2 }; |
1da177e4 LT |
40 | |
41 | /* Super-I/0 registers and commands */ | |
42 | ||
85a0c0d1 GR |
43 | #define REG 0x2e /* The register to read/write */ |
44 | #define VAL 0x2f /* The value to read/write */ | |
1da177e4 LT |
45 | |
46 | static inline void | |
47 | superio_outb(int reg, int val) | |
48 | { | |
49 | outb(reg, REG); | |
50 | outb(val, VAL); | |
51 | } | |
52 | ||
53 | static inline int | |
54 | superio_inb(int reg) | |
55 | { | |
56 | outb(reg, REG); | |
57 | return inb(VAL); | |
58 | } | |
59 | ||
60 | /* logical device for fans is 0x0A */ | |
61 | #define superio_select() superio_outb(0x07, 0x0A) | |
62 | ||
d6410408 | 63 | static inline int |
1da177e4 LT |
64 | superio_enter(void) |
65 | { | |
d6410408 GR |
66 | if (!request_muxed_region(REG, 2, DRVNAME)) |
67 | return -EBUSY; | |
68 | ||
1da177e4 | 69 | outb(0x55, REG); |
d6410408 | 70 | return 0; |
1da177e4 LT |
71 | } |
72 | ||
73 | static inline void | |
74 | superio_exit(void) | |
75 | { | |
76 | outb(0xAA, REG); | |
d6410408 | 77 | release_region(REG, 2); |
1da177e4 LT |
78 | } |
79 | ||
80 | #define SUPERIO_REG_ACT 0x30 | |
81 | #define SUPERIO_REG_BASE 0x60 | |
82 | #define SUPERIO_REG_DEVID 0x20 | |
1b54ab45 | 83 | #define SUPERIO_REG_DEVREV 0x21 |
1da177e4 LT |
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 | 105 | |
85a0c0d1 GR |
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 ? \ | |
109 | 0 : \ | |
110 | 983040 / (((reg) - (preload)) * (div))) | |
1da177e4 LT |
111 | #define DIV_FROM_REG(reg) (1 << (reg)) |
112 | #define PWM_FROM_REG(reg) (((reg) & 0x7E) << 1) | |
113 | #define PWM_EN_FROM_REG(reg) ((~(reg)) & 0x01) | |
114 | #define PWM_TO_REG(reg) (((reg) >> 1) & 0x7E) | |
115 | ||
116 | struct smsc47m1_data { | |
51f2cca1 JD |
117 | unsigned short addr; |
118 | const char *name; | |
8eccbb6f | 119 | enum chips type; |
1beeffe4 | 120 | struct device *hwmon_dev; |
1da177e4 | 121 | |
9a61bf63 | 122 | struct mutex update_lock; |
1da177e4 LT |
123 | unsigned long last_updated; /* In jiffies */ |
124 | ||
8eccbb6f JD |
125 | u8 fan[3]; /* Register value */ |
126 | u8 fan_preload[3]; /* Register value */ | |
127 | u8 fan_div[3]; /* Register encoding, shifted right */ | |
1da177e4 | 128 | u8 alarms; /* Register encoding */ |
8eccbb6f | 129 | u8 pwm[3]; /* Register value (bit 0 is disable) */ |
1da177e4 LT |
130 | }; |
131 | ||
51f2cca1 JD |
132 | struct smsc47m1_sio_data { |
133 | enum chips type; | |
fa0bff02 | 134 | u8 activate; /* Remember initial device state */ |
51f2cca1 | 135 | }; |
1da177e4 | 136 | |
51f2cca1 | 137 | static inline int smsc47m1_read_value(struct smsc47m1_data *data, u8 reg) |
94e183fd | 138 | { |
51f2cca1 | 139 | return inb_p(data->addr + reg); |
94e183fd JD |
140 | } |
141 | ||
51f2cca1 | 142 | static inline void smsc47m1_write_value(struct smsc47m1_data *data, u8 reg, |
94e183fd JD |
143 | u8 value) |
144 | { | |
51f2cca1 | 145 | outb_p(value, data->addr + reg); |
94e183fd | 146 | } |
1da177e4 | 147 | |
e70198ac AL |
148 | static struct smsc47m1_data *smsc47m1_update_device(struct device *dev, |
149 | int init) | |
150 | { | |
151 | struct smsc47m1_data *data = dev_get_drvdata(dev); | |
152 | ||
153 | mutex_lock(&data->update_lock); | |
154 | ||
155 | if (time_after(jiffies, data->last_updated + HZ + HZ / 2) || init) { | |
156 | int i, fan_nr; | |
157 | fan_nr = data->type == smsc47m2 ? 3 : 2; | |
158 | ||
159 | for (i = 0; i < fan_nr; i++) { | |
160 | data->fan[i] = smsc47m1_read_value(data, | |
161 | SMSC47M1_REG_FAN[i]); | |
162 | data->fan_preload[i] = smsc47m1_read_value(data, | |
163 | SMSC47M1_REG_FAN_PRELOAD[i]); | |
164 | data->pwm[i] = smsc47m1_read_value(data, | |
165 | SMSC47M1_REG_PWM[i]); | |
166 | } | |
167 | ||
168 | i = smsc47m1_read_value(data, SMSC47M1_REG_FANDIV); | |
169 | data->fan_div[0] = (i >> 4) & 0x03; | |
170 | data->fan_div[1] = i >> 6; | |
171 | ||
172 | data->alarms = smsc47m1_read_value(data, | |
173 | SMSC47M1_REG_ALARM) >> 6; | |
174 | /* Clear alarms if needed */ | |
175 | if (data->alarms) | |
176 | smsc47m1_write_value(data, SMSC47M1_REG_ALARM, 0xC0); | |
177 | ||
178 | if (fan_nr >= 3) { | |
179 | data->fan_div[2] = (smsc47m1_read_value(data, | |
180 | SMSC47M2_REG_FANDIV3) >> 4) & 0x03; | |
181 | data->alarms |= (smsc47m1_read_value(data, | |
182 | SMSC47M2_REG_ALARM6) & 0x40) >> 4; | |
183 | /* Clear alarm if needed */ | |
184 | if (data->alarms & 0x04) | |
185 | smsc47m1_write_value(data, | |
186 | SMSC47M2_REG_ALARM6, | |
187 | 0x40); | |
188 | } | |
189 | ||
190 | data->last_updated = jiffies; | |
191 | } | |
192 | ||
193 | mutex_unlock(&data->update_lock); | |
194 | return data; | |
195 | } | |
1da177e4 | 196 | |
96c6f81a GR |
197 | static ssize_t fan_show(struct device *dev, struct device_attribute *devattr, |
198 | char *buf) | |
1da177e4 | 199 | { |
e84cfbcb | 200 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
1da177e4 | 201 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); |
e84cfbcb | 202 | int nr = attr->index; |
85a0c0d1 GR |
203 | /* |
204 | * This chip (stupidly) stops monitoring fan speed if PWM is | |
205 | * enabled and duty cycle is 0%. This is fine if the monitoring | |
206 | * and control concern the same fan, but troublesome if they are | |
207 | * not (which could as well happen). | |
208 | */ | |
1da177e4 LT |
209 | int rpm = (data->pwm[nr] & 0x7F) == 0x00 ? 0 : |
210 | FAN_FROM_REG(data->fan[nr], | |
211 | DIV_FROM_REG(data->fan_div[nr]), | |
212 | data->fan_preload[nr]); | |
213 | return sprintf(buf, "%d\n", rpm); | |
214 | } | |
215 | ||
96c6f81a GR |
216 | static ssize_t fan_min_show(struct device *dev, |
217 | struct device_attribute *devattr, char *buf) | |
1da177e4 | 218 | { |
e84cfbcb | 219 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
1da177e4 | 220 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); |
e84cfbcb | 221 | int nr = attr->index; |
1da177e4 LT |
222 | int rpm = MIN_FROM_REG(data->fan_preload[nr], |
223 | DIV_FROM_REG(data->fan_div[nr])); | |
224 | return sprintf(buf, "%d\n", rpm); | |
225 | } | |
226 | ||
96c6f81a GR |
227 | static ssize_t fan_div_show(struct device *dev, |
228 | struct device_attribute *devattr, char *buf) | |
1da177e4 | 229 | { |
e84cfbcb | 230 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
1da177e4 | 231 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); |
e84cfbcb | 232 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[attr->index])); |
1da177e4 LT |
233 | } |
234 | ||
96c6f81a GR |
235 | static ssize_t fan_alarm_show(struct device *dev, |
236 | struct device_attribute *devattr, char *buf) | |
1f08af7e JD |
237 | { |
238 | int bitnr = to_sensor_dev_attr(devattr)->index; | |
239 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
240 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | |
241 | } | |
242 | ||
96c6f81a GR |
243 | static ssize_t pwm_show(struct device *dev, struct device_attribute *devattr, |
244 | char *buf) | |
1da177e4 | 245 | { |
e84cfbcb | 246 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
1da177e4 | 247 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); |
e84cfbcb | 248 | return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[attr->index])); |
1da177e4 LT |
249 | } |
250 | ||
96c6f81a GR |
251 | static ssize_t pwm_en_show(struct device *dev, |
252 | struct device_attribute *devattr, char *buf) | |
1da177e4 | 253 | { |
e84cfbcb | 254 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
1da177e4 | 255 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); |
e84cfbcb | 256 | return sprintf(buf, "%d\n", PWM_EN_FROM_REG(data->pwm[attr->index])); |
1da177e4 LT |
257 | } |
258 | ||
83aa233e JL |
259 | static ssize_t alarms_show(struct device *dev, |
260 | struct device_attribute *devattr, char *buf) | |
1da177e4 LT |
261 | { |
262 | struct smsc47m1_data *data = smsc47m1_update_device(dev, 0); | |
263 | return sprintf(buf, "%d\n", data->alarms); | |
264 | } | |
265 | ||
96c6f81a GR |
266 | static ssize_t fan_min_store(struct device *dev, |
267 | struct device_attribute *devattr, | |
268 | const char *buf, size_t count) | |
1da177e4 | 269 | { |
e84cfbcb | 270 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
51f2cca1 | 271 | struct smsc47m1_data *data = dev_get_drvdata(dev); |
e84cfbcb | 272 | int nr = attr->index; |
85a0c0d1 GR |
273 | long rpmdiv; |
274 | long val; | |
275 | int err; | |
276 | ||
277 | err = kstrtol(buf, 10, &val); | |
278 | if (err) | |
279 | return err; | |
1da177e4 | 280 | |
9a61bf63 | 281 | mutex_lock(&data->update_lock); |
1da177e4 LT |
282 | rpmdiv = val * DIV_FROM_REG(data->fan_div[nr]); |
283 | ||
284 | if (983040 > 192 * rpmdiv || 2 * rpmdiv > 983040) { | |
9a61bf63 | 285 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
286 | return -EINVAL; |
287 | } | |
288 | ||
289 | data->fan_preload[nr] = 192 - ((983040 + rpmdiv / 2) / rpmdiv); | |
51f2cca1 | 290 | smsc47m1_write_value(data, SMSC47M1_REG_FAN_PRELOAD[nr], |
1da177e4 | 291 | data->fan_preload[nr]); |
9a61bf63 | 292 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
293 | |
294 | return count; | |
295 | } | |
296 | ||
85a0c0d1 GR |
297 | /* |
298 | * Note: we save and restore the fan minimum here, because its value is | |
299 | * determined in part by the fan clock divider. This follows the principle | |
300 | * of least surprise; the user doesn't expect the fan minimum to change just | |
301 | * because the divider changed. | |
302 | */ | |
96c6f81a GR |
303 | static ssize_t fan_div_store(struct device *dev, |
304 | struct device_attribute *devattr, | |
305 | const char *buf, size_t count) | |
1da177e4 | 306 | { |
e84cfbcb | 307 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
51f2cca1 | 308 | struct smsc47m1_data *data = dev_get_drvdata(dev); |
e84cfbcb | 309 | int nr = attr->index; |
85a0c0d1 GR |
310 | long new_div; |
311 | int err; | |
312 | long tmp; | |
1da177e4 LT |
313 | u8 old_div = DIV_FROM_REG(data->fan_div[nr]); |
314 | ||
85a0c0d1 GR |
315 | err = kstrtol(buf, 10, &new_div); |
316 | if (err) | |
317 | return err; | |
318 | ||
1da177e4 LT |
319 | if (new_div == old_div) /* No change */ |
320 | return count; | |
321 | ||
9a61bf63 | 322 | mutex_lock(&data->update_lock); |
1da177e4 | 323 | switch (new_div) { |
85a0c0d1 GR |
324 | case 1: |
325 | data->fan_div[nr] = 0; | |
326 | break; | |
327 | case 2: | |
328 | data->fan_div[nr] = 1; | |
329 | break; | |
330 | case 4: | |
331 | data->fan_div[nr] = 2; | |
332 | break; | |
333 | case 8: | |
334 | data->fan_div[nr] = 3; | |
335 | break; | |
1da177e4 | 336 | default: |
9a61bf63 | 337 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
338 | return -EINVAL; |
339 | } | |
340 | ||
8eccbb6f JD |
341 | switch (nr) { |
342 | case 0: | |
343 | case 1: | |
51f2cca1 | 344 | tmp = smsc47m1_read_value(data, SMSC47M1_REG_FANDIV) |
8eccbb6f JD |
345 | & ~(0x03 << (4 + 2 * nr)); |
346 | tmp |= data->fan_div[nr] << (4 + 2 * nr); | |
51f2cca1 | 347 | smsc47m1_write_value(data, SMSC47M1_REG_FANDIV, tmp); |
8eccbb6f JD |
348 | break; |
349 | case 2: | |
51f2cca1 | 350 | tmp = smsc47m1_read_value(data, SMSC47M2_REG_FANDIV3) & 0xCF; |
8eccbb6f | 351 | tmp |= data->fan_div[2] << 4; |
51f2cca1 | 352 | smsc47m1_write_value(data, SMSC47M2_REG_FANDIV3, tmp); |
8eccbb6f | 353 | break; |
5fe625c1 MY |
354 | default: |
355 | BUG(); | |
8eccbb6f | 356 | } |
1da177e4 LT |
357 | |
358 | /* Preserve fan min */ | |
359 | tmp = 192 - (old_div * (192 - data->fan_preload[nr]) | |
360 | + new_div / 2) / new_div; | |
2a844c14 | 361 | data->fan_preload[nr] = clamp_val(tmp, 0, 191); |
51f2cca1 | 362 | smsc47m1_write_value(data, SMSC47M1_REG_FAN_PRELOAD[nr], |
1da177e4 | 363 | data->fan_preload[nr]); |
9a61bf63 | 364 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
365 | |
366 | return count; | |
367 | } | |
368 | ||
96c6f81a GR |
369 | static ssize_t pwm_store(struct device *dev, struct device_attribute *devattr, |
370 | const char *buf, size_t count) | |
1da177e4 | 371 | { |
e84cfbcb | 372 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
51f2cca1 | 373 | struct smsc47m1_data *data = dev_get_drvdata(dev); |
e84cfbcb | 374 | int nr = attr->index; |
85a0c0d1 GR |
375 | long val; |
376 | int err; | |
377 | ||
378 | err = kstrtol(buf, 10, &val); | |
379 | if (err) | |
380 | return err; | |
1da177e4 LT |
381 | |
382 | if (val < 0 || val > 255) | |
383 | return -EINVAL; | |
384 | ||
9a61bf63 | 385 | mutex_lock(&data->update_lock); |
1da177e4 LT |
386 | data->pwm[nr] &= 0x81; /* Preserve additional bits */ |
387 | data->pwm[nr] |= PWM_TO_REG(val); | |
51f2cca1 | 388 | smsc47m1_write_value(data, SMSC47M1_REG_PWM[nr], |
1da177e4 | 389 | data->pwm[nr]); |
9a61bf63 | 390 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
391 | |
392 | return count; | |
393 | } | |
394 | ||
96c6f81a GR |
395 | static ssize_t pwm_en_store(struct device *dev, |
396 | struct device_attribute *devattr, const char *buf, | |
397 | size_t count) | |
1da177e4 | 398 | { |
e84cfbcb | 399 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
51f2cca1 | 400 | struct smsc47m1_data *data = dev_get_drvdata(dev); |
e84cfbcb | 401 | int nr = attr->index; |
85a0c0d1 GR |
402 | unsigned long val; |
403 | int err; | |
404 | ||
405 | err = kstrtoul(buf, 10, &val); | |
406 | if (err) | |
407 | return err; | |
408 | ||
409 | if (val > 1) | |
1da177e4 LT |
410 | return -EINVAL; |
411 | ||
9a61bf63 | 412 | mutex_lock(&data->update_lock); |
1da177e4 LT |
413 | data->pwm[nr] &= 0xFE; /* preserve the other bits */ |
414 | data->pwm[nr] |= !val; | |
51f2cca1 | 415 | smsc47m1_write_value(data, SMSC47M1_REG_PWM[nr], |
1da177e4 | 416 | data->pwm[nr]); |
9a61bf63 | 417 | mutex_unlock(&data->update_lock); |
1da177e4 LT |
418 | |
419 | return count; | |
420 | } | |
421 | ||
96c6f81a GR |
422 | static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0); |
423 | static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0); | |
424 | static SENSOR_DEVICE_ATTR_RW(fan1_div, fan_div, 0); | |
425 | static SENSOR_DEVICE_ATTR_RO(fan1_alarm, fan_alarm, 0); | |
426 | static SENSOR_DEVICE_ATTR_RW(pwm1, pwm, 0); | |
427 | static SENSOR_DEVICE_ATTR_RW(pwm1_enable, pwm_en, 0); | |
428 | static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1); | |
429 | static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1); | |
430 | static SENSOR_DEVICE_ATTR_RW(fan2_div, fan_div, 1); | |
431 | static SENSOR_DEVICE_ATTR_RO(fan2_alarm, fan_alarm, 1); | |
432 | static SENSOR_DEVICE_ATTR_RW(pwm2, pwm, 1); | |
433 | static SENSOR_DEVICE_ATTR_RW(pwm2_enable, pwm_en, 1); | |
434 | static SENSOR_DEVICE_ATTR_RO(fan3_input, fan, 2); | |
435 | static SENSOR_DEVICE_ATTR_RW(fan3_min, fan_min, 2); | |
436 | static SENSOR_DEVICE_ATTR_RW(fan3_div, fan_div, 2); | |
437 | static SENSOR_DEVICE_ATTR_RO(fan3_alarm, fan_alarm, 2); | |
438 | static SENSOR_DEVICE_ATTR_RW(pwm3, pwm, 2); | |
439 | static SENSOR_DEVICE_ATTR_RW(pwm3_enable, pwm_en, 2); | |
1da177e4 | 440 | |
83aa233e | 441 | static DEVICE_ATTR_RO(alarms); |
1da177e4 | 442 | |
83aa233e | 443 | static ssize_t name_show(struct device *dev, struct device_attribute |
51f2cca1 JD |
444 | *devattr, char *buf) |
445 | { | |
446 | struct smsc47m1_data *data = dev_get_drvdata(dev); | |
447 | ||
448 | return sprintf(buf, "%s\n", data->name); | |
449 | } | |
83aa233e | 450 | static DEVICE_ATTR_RO(name); |
51f2cca1 | 451 | |
7e612685 | 452 | static struct attribute *smsc47m1_attributes_fan1[] = { |
e84cfbcb JD |
453 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
454 | &sensor_dev_attr_fan1_min.dev_attr.attr, | |
455 | &sensor_dev_attr_fan1_div.dev_attr.attr, | |
1f08af7e | 456 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, |
7e612685 GR |
457 | NULL |
458 | }; | |
459 | ||
460 | static const struct attribute_group smsc47m1_group_fan1 = { | |
461 | .attrs = smsc47m1_attributes_fan1, | |
462 | }; | |
463 | ||
464 | static struct attribute *smsc47m1_attributes_fan2[] = { | |
e84cfbcb JD |
465 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
466 | &sensor_dev_attr_fan2_min.dev_attr.attr, | |
467 | &sensor_dev_attr_fan2_div.dev_attr.attr, | |
1f08af7e | 468 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, |
7e612685 GR |
469 | NULL |
470 | }; | |
471 | ||
472 | static const struct attribute_group smsc47m1_group_fan2 = { | |
473 | .attrs = smsc47m1_attributes_fan2, | |
474 | }; | |
475 | ||
476 | static struct attribute *smsc47m1_attributes_fan3[] = { | |
e84cfbcb JD |
477 | &sensor_dev_attr_fan3_input.dev_attr.attr, |
478 | &sensor_dev_attr_fan3_min.dev_attr.attr, | |
479 | &sensor_dev_attr_fan3_div.dev_attr.attr, | |
1f08af7e | 480 | &sensor_dev_attr_fan3_alarm.dev_attr.attr, |
7e612685 GR |
481 | NULL |
482 | }; | |
e84cfbcb | 483 | |
7e612685 GR |
484 | static const struct attribute_group smsc47m1_group_fan3 = { |
485 | .attrs = smsc47m1_attributes_fan3, | |
486 | }; | |
487 | ||
488 | static struct attribute *smsc47m1_attributes_pwm1[] = { | |
e84cfbcb JD |
489 | &sensor_dev_attr_pwm1.dev_attr.attr, |
490 | &sensor_dev_attr_pwm1_enable.dev_attr.attr, | |
7e612685 GR |
491 | NULL |
492 | }; | |
493 | ||
494 | static const struct attribute_group smsc47m1_group_pwm1 = { | |
495 | .attrs = smsc47m1_attributes_pwm1, | |
496 | }; | |
497 | ||
498 | static struct attribute *smsc47m1_attributes_pwm2[] = { | |
e84cfbcb JD |
499 | &sensor_dev_attr_pwm2.dev_attr.attr, |
500 | &sensor_dev_attr_pwm2_enable.dev_attr.attr, | |
7e612685 GR |
501 | NULL |
502 | }; | |
503 | ||
504 | static const struct attribute_group smsc47m1_group_pwm2 = { | |
505 | .attrs = smsc47m1_attributes_pwm2, | |
506 | }; | |
507 | ||
508 | static struct attribute *smsc47m1_attributes_pwm3[] = { | |
e84cfbcb JD |
509 | &sensor_dev_attr_pwm3.dev_attr.attr, |
510 | &sensor_dev_attr_pwm3_enable.dev_attr.attr, | |
7e612685 GR |
511 | NULL |
512 | }; | |
ce8c6ce1 | 513 | |
7e612685 GR |
514 | static const struct attribute_group smsc47m1_group_pwm3 = { |
515 | .attrs = smsc47m1_attributes_pwm3, | |
516 | }; | |
517 | ||
518 | static struct attribute *smsc47m1_attributes[] = { | |
ce8c6ce1 | 519 | &dev_attr_alarms.attr, |
51f2cca1 | 520 | &dev_attr_name.attr, |
ce8c6ce1 JD |
521 | NULL |
522 | }; | |
523 | ||
524 | static const struct attribute_group smsc47m1_group = { | |
525 | .attrs = smsc47m1_attributes, | |
526 | }; | |
527 | ||
1d0045ee | 528 | static int __init smsc47m1_find(struct smsc47m1_sio_data *sio_data) |
1da177e4 LT |
529 | { |
530 | u8 val; | |
1d0045ee | 531 | unsigned short addr; |
d6410408 GR |
532 | int err; |
533 | ||
534 | err = superio_enter(); | |
535 | if (err) | |
536 | return err; | |
1da177e4 | 537 | |
67b671bc | 538 | val = force_id ? force_id : superio_inb(SUPERIO_REG_DEVID); |
1da177e4 LT |
539 | |
540 | /* | |
6091780e JD |
541 | * SMSC LPC47M10x/LPC47M112/LPC47M13x (device id 0x59), LPC47M14x |
542 | * (device id 0x5F) and LPC47B27x (device id 0x51) have fan control. | |
1da177e4 | 543 | * The LPC47M15x and LPC47M192 chips "with hardware monitoring block" |
ec5ce552 | 544 | * can do much more besides (device id 0x60). |
b890a07f JD |
545 | * The LPC47M997 is undocumented, but seems to be compatible with |
546 | * the LPC47M192, and has the same device id. | |
8eccbb6f JD |
547 | * The LPC47M292 (device id 0x6B) is somewhat compatible, but it |
548 | * supports a 3rd fan, and the pin configuration registers are | |
549 | * unfortunately different. | |
1b54ab45 JD |
550 | * The LPC47M233 has the same device id (0x6B) but is not compatible. |
551 | * We check the high bit of the device revision register to | |
552 | * differentiate them. | |
1da177e4 | 553 | */ |
51f2cca1 | 554 | switch (val) { |
8eccbb6f | 555 | case 0x51: |
512504e9 | 556 | pr_info("Found SMSC LPC47B27x\n"); |
51f2cca1 | 557 | sio_data->type = smsc47m1; |
8eccbb6f JD |
558 | break; |
559 | case 0x59: | |
512504e9 | 560 | pr_info("Found SMSC LPC47M10x/LPC47M112/LPC47M13x\n"); |
51f2cca1 | 561 | sio_data->type = smsc47m1; |
8eccbb6f JD |
562 | break; |
563 | case 0x5F: | |
512504e9 | 564 | pr_info("Found SMSC LPC47M14x\n"); |
51f2cca1 | 565 | sio_data->type = smsc47m1; |
8eccbb6f JD |
566 | break; |
567 | case 0x60: | |
512504e9 | 568 | pr_info("Found SMSC LPC47M15x/LPC47M192/LPC47M997\n"); |
51f2cca1 | 569 | sio_data->type = smsc47m1; |
8eccbb6f JD |
570 | break; |
571 | case 0x6B: | |
1b54ab45 | 572 | if (superio_inb(SUPERIO_REG_DEVREV) & 0x80) { |
512504e9 | 573 | pr_debug("Found SMSC LPC47M233, unsupported\n"); |
1b54ab45 JD |
574 | superio_exit(); |
575 | return -ENODEV; | |
576 | } | |
577 | ||
512504e9 | 578 | pr_info("Found SMSC LPC47M292\n"); |
51f2cca1 | 579 | sio_data->type = smsc47m2; |
8eccbb6f JD |
580 | break; |
581 | default: | |
1da177e4 LT |
582 | superio_exit(); |
583 | return -ENODEV; | |
584 | } | |
585 | ||
586 | superio_select(); | |
1d0045ee | 587 | addr = (superio_inb(SUPERIO_REG_BASE) << 8) |
2d8672c5 | 588 | | superio_inb(SUPERIO_REG_BASE + 1); |
1d0045ee | 589 | if (addr == 0) { |
512504e9 | 590 | pr_info("Device address not set, will not use\n"); |
1da177e4 LT |
591 | superio_exit(); |
592 | return -ENODEV; | |
593 | } | |
594 | ||
85a0c0d1 GR |
595 | /* |
596 | * Enable only if address is set (needed at least on the | |
597 | * Compaq Presario S4000NX) | |
598 | */ | |
fa0bff02 JD |
599 | sio_data->activate = superio_inb(SUPERIO_REG_ACT); |
600 | if ((sio_data->activate & 0x01) == 0) { | |
512504e9 | 601 | pr_info("Enabling device\n"); |
fa0bff02 JD |
602 | superio_outb(SUPERIO_REG_ACT, sio_data->activate | 0x01); |
603 | } | |
604 | ||
1da177e4 | 605 | superio_exit(); |
1d0045ee | 606 | return addr; |
1da177e4 LT |
607 | } |
608 | ||
fa0bff02 | 609 | /* Restore device to its initial state */ |
a00d643a | 610 | static void smsc47m1_restore(const struct smsc47m1_sio_data *sio_data) |
fa0bff02 JD |
611 | { |
612 | if ((sio_data->activate & 0x01) == 0) { | |
d6410408 GR |
613 | if (!superio_enter()) { |
614 | superio_select(); | |
615 | pr_info("Disabling device\n"); | |
616 | superio_outb(SUPERIO_REG_ACT, sio_data->activate); | |
617 | superio_exit(); | |
618 | } else { | |
619 | pr_warn("Failed to disable device\n"); | |
620 | } | |
fa0bff02 JD |
621 | } |
622 | } | |
623 | ||
a0e92d70 JD |
624 | #define CHECK 1 |
625 | #define REQUEST 2 | |
a0e92d70 JD |
626 | |
627 | /* | |
628 | * This function can be used to: | |
629 | * - test for resource conflicts with ACPI | |
630 | * - request the resources | |
a0e92d70 JD |
631 | * We only allocate the I/O ports we really need, to minimize the risk of |
632 | * conflicts with ACPI or with other drivers. | |
633 | */ | |
08ad7c95 GR |
634 | static int __init smsc47m1_handle_resources(unsigned short address, |
635 | enum chips type, int action, | |
636 | struct device *dev) | |
a0e92d70 JD |
637 | { |
638 | static const u8 ports_m1[] = { | |
639 | /* register, region length */ | |
640 | 0x04, 1, | |
641 | 0x33, 4, | |
642 | 0x56, 7, | |
643 | }; | |
644 | ||
645 | static const u8 ports_m2[] = { | |
646 | /* register, region length */ | |
647 | 0x04, 1, | |
648 | 0x09, 1, | |
649 | 0x2c, 2, | |
650 | 0x35, 4, | |
651 | 0x56, 7, | |
652 | 0x69, 4, | |
653 | }; | |
654 | ||
655 | int i, ports_size, err; | |
656 | const u8 *ports; | |
657 | ||
658 | switch (type) { | |
659 | case smsc47m1: | |
660 | default: | |
661 | ports = ports_m1; | |
662 | ports_size = ARRAY_SIZE(ports_m1); | |
663 | break; | |
664 | case smsc47m2: | |
665 | ports = ports_m2; | |
666 | ports_size = ARRAY_SIZE(ports_m2); | |
667 | break; | |
668 | } | |
669 | ||
670 | for (i = 0; i + 1 < ports_size; i += 2) { | |
671 | unsigned short start = address + ports[i]; | |
672 | unsigned short len = ports[i + 1]; | |
673 | ||
674 | switch (action) { | |
675 | case CHECK: | |
676 | /* Only check for conflicts */ | |
677 | err = acpi_check_region(start, len, DRVNAME); | |
678 | if (err) | |
679 | return err; | |
680 | break; | |
681 | case REQUEST: | |
682 | /* Request the resources */ | |
08ad7c95 GR |
683 | if (!devm_request_region(dev, start, len, DRVNAME)) { |
684 | dev_err(dev, | |
685 | "Region 0x%hx-0x%hx already in use!\n", | |
686 | start, start + len); | |
a0e92d70 JD |
687 | return -EBUSY; |
688 | } | |
689 | break; | |
a0e92d70 JD |
690 | } |
691 | } | |
692 | ||
693 | return 0; | |
694 | } | |
695 | ||
7e612685 GR |
696 | static void smsc47m1_remove_files(struct device *dev) |
697 | { | |
698 | sysfs_remove_group(&dev->kobj, &smsc47m1_group); | |
699 | sysfs_remove_group(&dev->kobj, &smsc47m1_group_fan1); | |
700 | sysfs_remove_group(&dev->kobj, &smsc47m1_group_fan2); | |
701 | sysfs_remove_group(&dev->kobj, &smsc47m1_group_fan3); | |
702 | sysfs_remove_group(&dev->kobj, &smsc47m1_group_pwm1); | |
703 | sysfs_remove_group(&dev->kobj, &smsc47m1_group_pwm2); | |
704 | sysfs_remove_group(&dev->kobj, &smsc47m1_group_pwm3); | |
705 | } | |
706 | ||
3ecf44b3 | 707 | static int __init smsc47m1_probe(struct platform_device *pdev) |
1da177e4 | 708 | { |
51f2cca1 | 709 | struct device *dev = &pdev->dev; |
a8b3a3a5 | 710 | struct smsc47m1_sio_data *sio_data = dev_get_platdata(dev); |
1da177e4 | 711 | struct smsc47m1_data *data; |
51f2cca1 | 712 | struct resource *res; |
a0e92d70 | 713 | int err; |
8eccbb6f | 714 | int fan1, fan2, fan3, pwm1, pwm2, pwm3; |
1da177e4 | 715 | |
85a0c0d1 | 716 | static const char * const names[] = { |
51f2cca1 JD |
717 | "smsc47m1", |
718 | "smsc47m2", | |
719 | }; | |
720 | ||
721 | res = platform_get_resource(pdev, IORESOURCE_IO, 0); | |
a0e92d70 JD |
722 | err = smsc47m1_handle_resources(res->start, sio_data->type, |
723 | REQUEST, dev); | |
724 | if (err < 0) | |
725 | return err; | |
1da177e4 | 726 | |
08ad7c95 GR |
727 | data = devm_kzalloc(dev, sizeof(struct smsc47m1_data), GFP_KERNEL); |
728 | if (!data) | |
729 | return -ENOMEM; | |
1da177e4 | 730 | |
51f2cca1 JD |
731 | data->addr = res->start; |
732 | data->type = sio_data->type; | |
733 | data->name = names[sio_data->type]; | |
9a61bf63 | 734 | mutex_init(&data->update_lock); |
51f2cca1 | 735 | platform_set_drvdata(pdev, data); |
1da177e4 | 736 | |
85a0c0d1 GR |
737 | /* |
738 | * If no function is properly configured, there's no point in | |
739 | * actually registering the chip. | |
740 | */ | |
51f2cca1 | 741 | pwm1 = (smsc47m1_read_value(data, SMSC47M1_REG_PPIN(0)) & 0x05) |
1da177e4 | 742 | == 0x04; |
51f2cca1 | 743 | pwm2 = (smsc47m1_read_value(data, SMSC47M1_REG_PPIN(1)) & 0x05) |
1da177e4 | 744 | == 0x04; |
8eccbb6f | 745 | if (data->type == smsc47m2) { |
51f2cca1 | 746 | fan1 = (smsc47m1_read_value(data, SMSC47M2_REG_TPIN1) |
8eccbb6f | 747 | & 0x0d) == 0x09; |
51f2cca1 | 748 | fan2 = (smsc47m1_read_value(data, SMSC47M2_REG_TPIN2) |
8eccbb6f | 749 | & 0x0d) == 0x09; |
51f2cca1 | 750 | fan3 = (smsc47m1_read_value(data, SMSC47M2_REG_TPIN3) |
8eccbb6f | 751 | & 0x0d) == 0x0d; |
51f2cca1 | 752 | pwm3 = (smsc47m1_read_value(data, SMSC47M2_REG_PPIN3) |
8eccbb6f JD |
753 | & 0x0d) == 0x08; |
754 | } else { | |
51f2cca1 | 755 | fan1 = (smsc47m1_read_value(data, SMSC47M1_REG_TPIN(0)) |
8eccbb6f | 756 | & 0x05) == 0x05; |
51f2cca1 | 757 | fan2 = (smsc47m1_read_value(data, SMSC47M1_REG_TPIN(1)) |
8eccbb6f JD |
758 | & 0x05) == 0x05; |
759 | fan3 = 0; | |
760 | pwm3 = 0; | |
761 | } | |
762 | if (!(fan1 || fan2 || fan3 || pwm1 || pwm2 || pwm3)) { | |
51f2cca1 | 763 | dev_warn(dev, "Device not configured, will not use\n"); |
08ad7c95 | 764 | return -ENODEV; |
1da177e4 LT |
765 | } |
766 | ||
85a0c0d1 GR |
767 | /* |
768 | * Some values (fan min, clock dividers, pwm registers) may be | |
769 | * needed before any update is triggered, so we better read them | |
770 | * at least once here. We don't usually do it that way, but in | |
771 | * this particular case, manually reading 5 registers out of 8 | |
772 | * doesn't make much sense and we're better using the existing | |
773 | * function. | |
774 | */ | |
51f2cca1 | 775 | smsc47m1_update_device(dev, 1); |
1da177e4 | 776 | |
943b0830 | 777 | /* Register sysfs hooks */ |
1da177e4 | 778 | if (fan1) { |
7e612685 GR |
779 | err = sysfs_create_group(&dev->kobj, |
780 | &smsc47m1_group_fan1); | |
781 | if (err) | |
ce8c6ce1 | 782 | goto error_remove_files; |
1da177e4 | 783 | } else |
51f2cca1 | 784 | dev_dbg(dev, "Fan 1 not enabled by hardware, skipping\n"); |
1da177e4 LT |
785 | |
786 | if (fan2) { | |
7e612685 GR |
787 | err = sysfs_create_group(&dev->kobj, |
788 | &smsc47m1_group_fan2); | |
789 | if (err) | |
ce8c6ce1 | 790 | goto error_remove_files; |
1da177e4 | 791 | } else |
51f2cca1 | 792 | dev_dbg(dev, "Fan 2 not enabled by hardware, skipping\n"); |
1da177e4 | 793 | |
8eccbb6f | 794 | if (fan3) { |
7e612685 GR |
795 | err = sysfs_create_group(&dev->kobj, |
796 | &smsc47m1_group_fan3); | |
797 | if (err) | |
8eccbb6f | 798 | goto error_remove_files; |
8477d026 | 799 | } else if (data->type == smsc47m2) |
51f2cca1 | 800 | dev_dbg(dev, "Fan 3 not enabled by hardware, skipping\n"); |
8eccbb6f | 801 | |
1da177e4 | 802 | if (pwm1) { |
7e612685 GR |
803 | err = sysfs_create_group(&dev->kobj, |
804 | &smsc47m1_group_pwm1); | |
805 | if (err) | |
ce8c6ce1 | 806 | goto error_remove_files; |
1da177e4 | 807 | } else |
51f2cca1 | 808 | dev_dbg(dev, "PWM 1 not enabled by hardware, skipping\n"); |
8eccbb6f | 809 | |
1da177e4 | 810 | if (pwm2) { |
7e612685 GR |
811 | err = sysfs_create_group(&dev->kobj, |
812 | &smsc47m1_group_pwm2); | |
813 | if (err) | |
ce8c6ce1 | 814 | goto error_remove_files; |
1da177e4 | 815 | } else |
51f2cca1 | 816 | dev_dbg(dev, "PWM 2 not enabled by hardware, skipping\n"); |
1da177e4 | 817 | |
8eccbb6f | 818 | if (pwm3) { |
7e612685 GR |
819 | err = sysfs_create_group(&dev->kobj, |
820 | &smsc47m1_group_pwm3); | |
821 | if (err) | |
8eccbb6f | 822 | goto error_remove_files; |
8477d026 | 823 | } else if (data->type == smsc47m2) |
51f2cca1 | 824 | dev_dbg(dev, "PWM 3 not enabled by hardware, skipping\n"); |
8eccbb6f | 825 | |
7e612685 GR |
826 | err = sysfs_create_group(&dev->kobj, &smsc47m1_group); |
827 | if (err) | |
68a50b56 | 828 | goto error_remove_files; |
ce8c6ce1 | 829 | |
1beeffe4 TJ |
830 | data->hwmon_dev = hwmon_device_register(dev); |
831 | if (IS_ERR(data->hwmon_dev)) { | |
832 | err = PTR_ERR(data->hwmon_dev); | |
ce8c6ce1 JD |
833 | goto error_remove_files; |
834 | } | |
1da177e4 LT |
835 | |
836 | return 0; | |
837 | ||
ce8c6ce1 | 838 | error_remove_files: |
7e612685 | 839 | smsc47m1_remove_files(dev); |
1da177e4 LT |
840 | return err; |
841 | } | |
842 | ||
3ecf44b3 | 843 | static int __exit smsc47m1_remove(struct platform_device *pdev) |
1da177e4 | 844 | { |
51f2cca1 | 845 | struct smsc47m1_data *data = platform_get_drvdata(pdev); |
1da177e4 | 846 | |
1beeffe4 | 847 | hwmon_device_unregister(data->hwmon_dev); |
7e612685 | 848 | smsc47m1_remove_files(&pdev->dev); |
1da177e4 | 849 | |
1da177e4 LT |
850 | return 0; |
851 | } | |
852 | ||
e70198ac AL |
853 | static struct platform_driver smsc47m1_driver = { |
854 | .driver = { | |
e70198ac AL |
855 | .name = DRVNAME, |
856 | }, | |
857 | .remove = __exit_p(smsc47m1_remove), | |
858 | }; | |
1da177e4 | 859 | |
51f2cca1 JD |
860 | static int __init smsc47m1_device_add(unsigned short address, |
861 | const struct smsc47m1_sio_data *sio_data) | |
862 | { | |
863 | struct resource res = { | |
864 | .start = address, | |
865 | .end = address + SMSC_EXTENT - 1, | |
866 | .name = DRVNAME, | |
867 | .flags = IORESOURCE_IO, | |
868 | }; | |
869 | int err; | |
870 | ||
a0e92d70 | 871 | err = smsc47m1_handle_resources(address, sio_data->type, CHECK, NULL); |
b9acb64a JD |
872 | if (err) |
873 | goto exit; | |
874 | ||
51f2cca1 JD |
875 | pdev = platform_device_alloc(DRVNAME, address); |
876 | if (!pdev) { | |
877 | err = -ENOMEM; | |
512504e9 | 878 | pr_err("Device allocation failed\n"); |
51f2cca1 JD |
879 | goto exit; |
880 | } | |
881 | ||
882 | err = platform_device_add_resources(pdev, &res, 1); | |
883 | if (err) { | |
512504e9 | 884 | pr_err("Device resource addition failed (%d)\n", err); |
51f2cca1 JD |
885 | goto exit_device_put; |
886 | } | |
887 | ||
2df6d811 JD |
888 | err = platform_device_add_data(pdev, sio_data, |
889 | sizeof(struct smsc47m1_sio_data)); | |
890 | if (err) { | |
512504e9 | 891 | pr_err("Platform data allocation failed\n"); |
51f2cca1 JD |
892 | goto exit_device_put; |
893 | } | |
51f2cca1 JD |
894 | |
895 | err = platform_device_add(pdev); | |
896 | if (err) { | |
512504e9 | 897 | pr_err("Device addition failed (%d)\n", err); |
51f2cca1 JD |
898 | goto exit_device_put; |
899 | } | |
900 | ||
901 | return 0; | |
902 | ||
903 | exit_device_put: | |
904 | platform_device_put(pdev); | |
905 | exit: | |
906 | return err; | |
907 | } | |
908 | ||
1da177e4 LT |
909 | static int __init sm_smsc47m1_init(void) |
910 | { | |
51f2cca1 JD |
911 | int err; |
912 | unsigned short address; | |
913 | struct smsc47m1_sio_data sio_data; | |
914 | ||
1d0045ee GR |
915 | err = smsc47m1_find(&sio_data); |
916 | if (err < 0) | |
917 | return err; | |
918 | address = err; | |
1da177e4 | 919 | |
3ecf44b3 JD |
920 | /* Sets global pdev as a side effect */ |
921 | err = smsc47m1_device_add(address, &sio_data); | |
51f2cca1 | 922 | if (err) |
1d0045ee | 923 | return err; |
51f2cca1 | 924 | |
3ecf44b3 | 925 | err = platform_driver_probe(&smsc47m1_driver, smsc47m1_probe); |
51f2cca1 | 926 | if (err) |
3ecf44b3 | 927 | goto exit_device; |
51f2cca1 JD |
928 | |
929 | return 0; | |
930 | ||
3ecf44b3 JD |
931 | exit_device: |
932 | platform_device_unregister(pdev); | |
fa0bff02 | 933 | smsc47m1_restore(&sio_data); |
51f2cca1 | 934 | return err; |
1da177e4 LT |
935 | } |
936 | ||
937 | static void __exit sm_smsc47m1_exit(void) | |
938 | { | |
51f2cca1 | 939 | platform_driver_unregister(&smsc47m1_driver); |
a8b3a3a5 | 940 | smsc47m1_restore(dev_get_platdata(&pdev->dev)); |
3ecf44b3 | 941 | platform_device_unregister(pdev); |
1da177e4 LT |
942 | } |
943 | ||
944 | MODULE_AUTHOR("Mark D. Studebaker <mdsxyz123@yahoo.com>"); | |
945 | MODULE_DESCRIPTION("SMSC LPC47M1xx fan sensors driver"); | |
946 | MODULE_LICENSE("GPL"); | |
947 | ||
948 | module_init(sm_smsc47m1_init); | |
949 | module_exit(sm_smsc47m1_exit); |