?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
hwmon: (f71882fg) Prepare for adding F8000 support
[linux-2.6.git] / drivers / hwmon / f71882fg.c
blob2604c6d7ea58b6dc0f0f44e6fca03b1247b58a13
1 /***************************************************************************
2 * Copyright (C) 2006 by Hans Edgington <hans@edgington.nl> *
3 * Copyright (C) 2007,2008 by Hans de Goede <hdegoede@redhat.com> *
4 * *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
9 * *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
14 * *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
20
21 #include <linux/module.h>
22 #include <linux/init.h>
23 #include <linux/slab.h>
24 #include <linux/jiffies.h>
25 #include <linux/platform_device.h>
26 #include <linux/hwmon.h>
27 #include <linux/hwmon-sysfs.h>
28 #include <linux/err.h>
29 #include <linux/mutex.h>
30 #include <linux/io.h>
31
32 #define DRVNAME "f71882fg"
33
34 #define SIO_F71882FG_LD_HWM 0x04 /* Hardware monitor logical device */
35 #define SIO_UNLOCK_KEY 0x87 /* Key to enable Super-I/O */
36 #define SIO_LOCK_KEY 0xAA /* Key to diasble Super-I/O */
37
38 #define SIO_REG_LDSEL 0x07 /* Logical device select */
39 #define SIO_REG_DEVID 0x20 /* Device ID (2 bytes) */
40 #define SIO_REG_DEVREV 0x22 /* Device revision */
41 #define SIO_REG_MANID 0x23 /* Fintek ID (2 bytes) */
42 #define SIO_REG_ENABLE 0x30 /* Logical device enable */
43 #define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */
44
45 #define SIO_FINTEK_ID 0x1934 /* Manufacturers ID */
46 #define SIO_F71862_ID 0x0601 /* Chipset ID */
47 #define SIO_F71882_ID 0x0541 /* Chipset ID */
48
49 #define REGION_LENGTH 8
50 #define ADDR_REG_OFFSET 5
51 #define DATA_REG_OFFSET 6
52
53 #define F71882FG_REG_PECI 0x0A
54
55 #define F71882FG_REG_IN_STATUS 0x12 /* f71882fg only */
56 #define F71882FG_REG_IN_BEEP 0x13 /* f71882fg only */
57 #define F71882FG_REG_IN(nr) (0x20 + (nr))
58 #define F71882FG_REG_IN1_HIGH 0x32 /* f71882fg only */
59
60 #define F71882FG_REG_FAN(nr) (0xA0 + (16 * (nr)))
61 #define F71882FG_REG_FAN_TARGET(nr) (0xA2 + (16 * (nr)))
62 #define F71882FG_REG_FAN_FULL_SPEED(nr) (0xA4 + (16 * (nr)))
63 #define F71882FG_REG_FAN_STATUS 0x92
64 #define F71882FG_REG_FAN_BEEP 0x93
65
66 #define F71882FG_REG_TEMP(nr) (0x70 + 2 * (nr))
67 #define F71882FG_REG_TEMP_OVT(nr) (0x80 + 2 * (nr))
68 #define F71882FG_REG_TEMP_HIGH(nr) (0x81 + 2 * (nr))
69 #define F71882FG_REG_TEMP_STATUS 0x62
70 #define F71882FG_REG_TEMP_BEEP 0x63
71 #define F71882FG_REG_TEMP_HYST1 0x6C
72 #define F71882FG_REG_TEMP_HYST23 0x6D
73 #define F71882FG_REG_TEMP_TYPE 0x6B
74 #define F71882FG_REG_TEMP_DIODE_OPEN 0x6F
75
76 #define F71882FG_REG_PWM(nr) (0xA3 + (16 * (nr)))
77 #define F71882FG_REG_PWM_TYPE 0x94
78 #define F71882FG_REG_PWM_ENABLE 0x96
79
80 #define F71882FG_REG_FAN_HYST0 0x98
81 #define F71882FG_REG_FAN_HYST1 0x99
82
83 #define F71882FG_REG_POINT_PWM(pwm, point) (0xAA + (point) + (16 * (pwm)))
84 #define F71882FG_REG_POINT_TEMP(pwm, point) (0xA6 + (point) + (16 * (pwm)))
85 #define F71882FG_REG_POINT_MAPPING(nr) (0xAF + 16 * (nr))
86
87 #define F71882FG_REG_START 0x01
88
89 #define FAN_MIN_DETECT 366 /* Lowest detectable fanspeed */
90
91 static unsigned short force_id;
92 module_param(force_id, ushort, 0);
93 MODULE_PARM_DESC(force_id, "Override the detected device ID");
94
95 static int fan_mode[4] = { 0, 0, 0, 0 };
96 module_param_array(fan_mode, int, NULL, 0644);
97 MODULE_PARM_DESC(fan_mode, "List of fan control modes (f71882fg only) "
98 "(0=don't change, 1=pwm, 2=rpm)\n"
99 "Note: this needs a write to pwm#_enable to take effect");
100
101 enum chips { f71862fg, f71882fg };
102
103 static const char *f71882fg_names[] = {
104 "f71862fg",
105 "f71882fg",
106 };
107
108 static struct platform_device *f71882fg_pdev;
109
110 /* Super-I/O Function prototypes */
111 static inline int superio_inb(int base, int reg);
112 static inline int superio_inw(int base, int reg);
113 static inline void superio_enter(int base);
114 static inline void superio_select(int base, int ld);
115 static inline void superio_exit(int base);
116
117 struct f71882fg_sio_data {
118 enum chips type;
119 };
120
121 struct f71882fg_data {
122 unsigned short addr;
123 enum chips type;
124 struct device *hwmon_dev;
125
126 struct mutex update_lock;
127 char valid; /* !=0 if following fields are valid */
128 unsigned long last_updated; /* In jiffies */
129 unsigned long last_limits; /* In jiffies */
130
131 /* Register Values */
132 u8 in[9];
133 u8 in1_max;
134 u8 in_status;
135 u8 in_beep;
136 u16 fan[4];
137 u16 fan_target[4];
138 u16 fan_full_speed[4];
139 u8 fan_status;
140 u8 fan_beep;
141 /* Note: all models have only 3 temperature channels, but on some
142 they are addressed as 0-2 and on others as 1-3, so for coding
143 convenience we reserve space for 4 channels */
144 u8 temp[4];
145 u8 temp_ovt[4];
146 u8 temp_high[4];
147 u8 temp_hyst[4];
148 u8 temp_type[4];
149 u8 temp_status;
150 u8 temp_beep;
151 u8 temp_diode_open;
152 u8 pwm[4];
153 u8 pwm_enable;
154 u8 pwm_auto_point_hyst[2];
155 u8 pwm_auto_point_mapping[4];
156 u8 pwm_auto_point_pwm[4][5];
157 u8 pwm_auto_point_temp[4][4];
158 };
159
160 /* Sysfs in */
161 static ssize_t show_in(struct device *dev, struct device_attribute *devattr,
162 char *buf);
163 static ssize_t show_in_max(struct device *dev, struct device_attribute
164 *devattr, char *buf);
165 static ssize_t store_in_max(struct device *dev, struct device_attribute
166 *devattr, const char *buf, size_t count);
167 static ssize_t show_in_beep(struct device *dev, struct device_attribute
168 *devattr, char *buf);
169 static ssize_t store_in_beep(struct device *dev, struct device_attribute
170 *devattr, const char *buf, size_t count);
171 static ssize_t show_in_alarm(struct device *dev, struct device_attribute
172 *devattr, char *buf);
173 /* Sysfs Fan */
174 static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
175 char *buf);
176 static ssize_t show_fan_full_speed(struct device *dev,
177 struct device_attribute *devattr, char *buf);
178 static ssize_t store_fan_full_speed(struct device *dev,
179 struct device_attribute *devattr, const char *buf, size_t count);
180 static ssize_t show_fan_beep(struct device *dev, struct device_attribute
181 *devattr, char *buf);
182 static ssize_t store_fan_beep(struct device *dev, struct device_attribute
183 *devattr, const char *buf, size_t count);
184 static ssize_t show_fan_alarm(struct device *dev, struct device_attribute
185 *devattr, char *buf);
186 /* Sysfs Temp */
187 static ssize_t show_temp(struct device *dev, struct device_attribute
188 *devattr, char *buf);
189 static ssize_t show_temp_max(struct device *dev, struct device_attribute
190 *devattr, char *buf);
191 static ssize_t store_temp_max(struct device *dev, struct device_attribute
192 *devattr, const char *buf, size_t count);
193 static ssize_t show_temp_max_hyst(struct device *dev, struct device_attribute
194 *devattr, char *buf);
195 static ssize_t store_temp_max_hyst(struct device *dev, struct device_attribute
196 *devattr, const char *buf, size_t count);
197 static ssize_t show_temp_crit(struct device *dev, struct device_attribute
198 *devattr, char *buf);
199 static ssize_t store_temp_crit(struct device *dev, struct device_attribute
200 *devattr, const char *buf, size_t count);
201 static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute
202 *devattr, char *buf);
203 static ssize_t show_temp_type(struct device *dev, struct device_attribute
204 *devattr, char *buf);
205 static ssize_t show_temp_beep(struct device *dev, struct device_attribute
206 *devattr, char *buf);
207 static ssize_t store_temp_beep(struct device *dev, struct device_attribute
208 *devattr, const char *buf, size_t count);
209 static ssize_t show_temp_alarm(struct device *dev, struct device_attribute
210 *devattr, char *buf);
211 static ssize_t show_temp_fault(struct device *dev, struct device_attribute
212 *devattr, char *buf);
213 /* PWM and Auto point control */
214 static ssize_t show_pwm(struct device *dev, struct device_attribute *devattr,
215 char *buf);
216 static ssize_t store_pwm(struct device *dev, struct device_attribute *devattr,
217 const char *buf, size_t count);
218 static ssize_t show_pwm_enable(struct device *dev,
219 struct device_attribute *devattr, char *buf);
220 static ssize_t store_pwm_enable(struct device *dev,
221 struct device_attribute *devattr, const char *buf, size_t count);
222 static ssize_t show_pwm_interpolate(struct device *dev,
223 struct device_attribute *devattr, char *buf);
224 static ssize_t store_pwm_interpolate(struct device *dev,
225 struct device_attribute *devattr, const char *buf, size_t count);
226 static ssize_t show_pwm_auto_point_channel(struct device *dev,
227 struct device_attribute *devattr, char *buf);
228 static ssize_t store_pwm_auto_point_channel(struct device *dev,
229 struct device_attribute *devattr, const char *buf, size_t count);
230 static ssize_t show_pwm_auto_point_temp_hyst(struct device *dev,
231 struct device_attribute *devattr, char *buf);
232 static ssize_t store_pwm_auto_point_temp_hyst(struct device *dev,
233 struct device_attribute *devattr, const char *buf, size_t count);
234 static ssize_t show_pwm_auto_point_pwm(struct device *dev,
235 struct device_attribute *devattr, char *buf);
236 static ssize_t store_pwm_auto_point_pwm(struct device *dev,
237 struct device_attribute *devattr, const char *buf, size_t count);
238 static ssize_t show_pwm_auto_point_temp(struct device *dev,
239 struct device_attribute *devattr, char *buf);
240 static ssize_t store_pwm_auto_point_temp(struct device *dev,
241 struct device_attribute *devattr, const char *buf, size_t count);
242 /* Sysfs misc */
243 static ssize_t show_name(struct device *dev, struct device_attribute *devattr,
244 char *buf);
245
246 static int __devinit f71882fg_probe(struct platform_device * pdev);
247 static int f71882fg_remove(struct platform_device *pdev);
248
249 static struct platform_driver f71882fg_driver = {
250 .driver = {
251 .owner = THIS_MODULE,
252 .name = DRVNAME,
253 },
254 .probe = f71882fg_probe,
255 .remove = __devexit_p(f71882fg_remove),
256 };
257
258 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
259
260 static struct sensor_device_attribute_2 f718x2fg_in_temp_attr[] = {
261 SENSOR_ATTR_2(in0_input, S_IRUGO, show_in, NULL, 0, 0),
262 SENSOR_ATTR_2(in1_input, S_IRUGO, show_in, NULL, 0, 1),
263 SENSOR_ATTR_2(in2_input, S_IRUGO, show_in, NULL, 0, 2),
264 SENSOR_ATTR_2(in3_input, S_IRUGO, show_in, NULL, 0, 3),
265 SENSOR_ATTR_2(in4_input, S_IRUGO, show_in, NULL, 0, 4),
266 SENSOR_ATTR_2(in5_input, S_IRUGO, show_in, NULL, 0, 5),
267 SENSOR_ATTR_2(in6_input, S_IRUGO, show_in, NULL, 0, 6),
268 SENSOR_ATTR_2(in7_input, S_IRUGO, show_in, NULL, 0, 7),
269 SENSOR_ATTR_2(in8_input, S_IRUGO, show_in, NULL, 0, 8),
270 SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp, NULL, 0, 1),
271 SENSOR_ATTR_2(temp1_max, S_IRUGO|S_IWUSR, show_temp_max,
272 store_temp_max, 0, 1),
273 SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
274 store_temp_max_hyst, 0, 1),
275 SENSOR_ATTR_2(temp1_crit, S_IRUGO|S_IWUSR, show_temp_crit,
276 store_temp_crit, 0, 1),
277 SENSOR_ATTR_2(temp1_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
278 0, 1),
279 SENSOR_ATTR_2(temp1_type, S_IRUGO, show_temp_type, NULL, 0, 1),
280 SENSOR_ATTR_2(temp1_beep, S_IRUGO|S_IWUSR, show_temp_beep,
281 store_temp_beep, 0, 1),
282 SENSOR_ATTR_2(temp1_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 1),
283 SENSOR_ATTR_2(temp1_fault, S_IRUGO, show_temp_fault, NULL, 0, 1),
284 SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp, NULL, 0, 2),
285 SENSOR_ATTR_2(temp2_max, S_IRUGO|S_IWUSR, show_temp_max,
286 store_temp_max, 0, 2),
287 SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
288 store_temp_max_hyst, 0, 2),
289 SENSOR_ATTR_2(temp2_crit, S_IRUGO|S_IWUSR, show_temp_crit,
290 store_temp_crit, 0, 2),
291 SENSOR_ATTR_2(temp2_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
292 0, 2),
293 SENSOR_ATTR_2(temp2_type, S_IRUGO, show_temp_type, NULL, 0, 2),
294 SENSOR_ATTR_2(temp2_beep, S_IRUGO|S_IWUSR, show_temp_beep,
295 store_temp_beep, 0, 2),
296 SENSOR_ATTR_2(temp2_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 2),
297 SENSOR_ATTR_2(temp2_fault, S_IRUGO, show_temp_fault, NULL, 0, 2),
298 SENSOR_ATTR_2(temp3_input, S_IRUGO, show_temp, NULL, 0, 3),
299 SENSOR_ATTR_2(temp3_max, S_IRUGO|S_IWUSR, show_temp_max,
300 store_temp_max, 0, 3),
301 SENSOR_ATTR_2(temp3_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
302 store_temp_max_hyst, 0, 3),
303 SENSOR_ATTR_2(temp3_crit, S_IRUGO|S_IWUSR, show_temp_crit,
304 store_temp_crit, 0, 3),
305 SENSOR_ATTR_2(temp3_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
306 0, 3),
307 SENSOR_ATTR_2(temp3_type, S_IRUGO, show_temp_type, NULL, 0, 3),
308 SENSOR_ATTR_2(temp3_beep, S_IRUGO|S_IWUSR, show_temp_beep,
309 store_temp_beep, 0, 3),
310 SENSOR_ATTR_2(temp3_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 3),
311 SENSOR_ATTR_2(temp3_fault, S_IRUGO, show_temp_fault, NULL, 0, 3),
312 };
313
314 static struct sensor_device_attribute_2 f71882fg_in_temp_attr[] = {
315 SENSOR_ATTR_2(in1_max, S_IRUGO|S_IWUSR, show_in_max, store_in_max,
316 0, 1),
317 SENSOR_ATTR_2(in1_beep, S_IRUGO|S_IWUSR, show_in_beep, store_in_beep,
318 0, 1),
319 SENSOR_ATTR_2(in1_alarm, S_IRUGO, show_in_alarm, NULL, 0, 1),
320 };
321
322 static struct sensor_device_attribute_2 f718x2fg_fan_attr[] = {
323 SENSOR_ATTR_2(fan1_input, S_IRUGO, show_fan, NULL, 0, 0),
324 SENSOR_ATTR_2(fan1_full_speed, S_IRUGO|S_IWUSR,
325 show_fan_full_speed,
326 store_fan_full_speed, 0, 0),
327 SENSOR_ATTR_2(fan1_beep, S_IRUGO|S_IWUSR, show_fan_beep,
328 store_fan_beep, 0, 0),
329 SENSOR_ATTR_2(fan1_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 0),
330 SENSOR_ATTR_2(fan2_input, S_IRUGO, show_fan, NULL, 0, 1),
331 SENSOR_ATTR_2(fan2_full_speed, S_IRUGO|S_IWUSR,
332 show_fan_full_speed,
333 store_fan_full_speed, 0, 1),
334 SENSOR_ATTR_2(fan2_beep, S_IRUGO|S_IWUSR, show_fan_beep,
335 store_fan_beep, 0, 1),
336 SENSOR_ATTR_2(fan2_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 1),
337 SENSOR_ATTR_2(fan3_input, S_IRUGO, show_fan, NULL, 0, 2),
338 SENSOR_ATTR_2(fan3_full_speed, S_IRUGO|S_IWUSR,
339 show_fan_full_speed,
340 store_fan_full_speed, 0, 2),
341 SENSOR_ATTR_2(fan3_beep, S_IRUGO|S_IWUSR, show_fan_beep,
342 store_fan_beep, 0, 2),
343 SENSOR_ATTR_2(fan3_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 2),
344
345 SENSOR_ATTR_2(pwm1, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 0),
346 SENSOR_ATTR_2(pwm1_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
347 store_pwm_enable, 0, 0),
348 SENSOR_ATTR_2(pwm1_interpolate, S_IRUGO|S_IWUSR,
349 show_pwm_interpolate, store_pwm_interpolate, 0, 0),
350 SENSOR_ATTR_2(pwm1_auto_channels_temp, S_IRUGO|S_IWUSR,
351 show_pwm_auto_point_channel,
352 store_pwm_auto_point_channel, 0, 0),
353
354 SENSOR_ATTR_2(pwm2, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 1),
355 SENSOR_ATTR_2(pwm2_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
356 store_pwm_enable, 0, 1),
357 SENSOR_ATTR_2(pwm2_interpolate, S_IRUGO|S_IWUSR,
358 show_pwm_interpolate, store_pwm_interpolate, 0, 1),
359 SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
360 show_pwm_auto_point_channel,
361 store_pwm_auto_point_channel, 0, 1),
362
363 SENSOR_ATTR_2(pwm3, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 2),
364 SENSOR_ATTR_2(pwm3_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
365 store_pwm_enable, 0, 2),
366 SENSOR_ATTR_2(pwm3_interpolate, S_IRUGO|S_IWUSR,
367 show_pwm_interpolate, store_pwm_interpolate, 0, 2),
368 SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
369 show_pwm_auto_point_channel,
370 store_pwm_auto_point_channel, 0, 2),
371 };
372
373 static struct sensor_device_attribute_2 f71862fg_fan_attr[] = {
374 SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
375 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
376 1, 0),
377 SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
378 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
379 4, 0),
380 SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
381 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
382 0, 0),
383 SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
384 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
385 3, 0),
386 SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
387 show_pwm_auto_point_temp_hyst,
388 store_pwm_auto_point_temp_hyst,
389 0, 0),
390 SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
391 show_pwm_auto_point_temp_hyst, NULL, 3, 0),
392
393 SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
394 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
395 1, 1),
396 SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
397 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
398 4, 1),
399 SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
400 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
401 0, 1),
402 SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
403 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
404 3, 1),
405 SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
406 show_pwm_auto_point_temp_hyst,
407 store_pwm_auto_point_temp_hyst,
408 0, 1),
409 SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
410 show_pwm_auto_point_temp_hyst, NULL, 3, 1),
411 };
412
413 static struct sensor_device_attribute_2 f71882fg_fan_attr[] = {
414 SENSOR_ATTR_2(fan4_input, S_IRUGO, show_fan, NULL, 0, 3),
415 SENSOR_ATTR_2(fan4_full_speed, S_IRUGO|S_IWUSR,
416 show_fan_full_speed,
417 store_fan_full_speed, 0, 3),
418 SENSOR_ATTR_2(fan4_beep, S_IRUGO|S_IWUSR, show_fan_beep,
419 store_fan_beep, 0, 3),
420 SENSOR_ATTR_2(fan4_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 3),
421
422 SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
423 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
424 0, 0),
425 SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
426 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
427 1, 0),
428 SENSOR_ATTR_2(pwm1_auto_point3_pwm, S_IRUGO|S_IWUSR,
429 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
430 2, 0),
431 SENSOR_ATTR_2(pwm1_auto_point4_pwm, S_IRUGO|S_IWUSR,
432 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
433 3, 0),
434 SENSOR_ATTR_2(pwm1_auto_point5_pwm, S_IRUGO|S_IWUSR,
435 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
436 4, 0),
437 SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
438 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
439 0, 0),
440 SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
441 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
442 1, 0),
443 SENSOR_ATTR_2(pwm1_auto_point3_temp, S_IRUGO|S_IWUSR,
444 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
445 2, 0),
446 SENSOR_ATTR_2(pwm1_auto_point4_temp, S_IRUGO|S_IWUSR,
447 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
448 3, 0),
449 SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
450 show_pwm_auto_point_temp_hyst,
451 store_pwm_auto_point_temp_hyst,
452 0, 0),
453 SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
454 show_pwm_auto_point_temp_hyst, NULL, 1, 0),
455 SENSOR_ATTR_2(pwm1_auto_point3_temp_hyst, S_IRUGO,
456 show_pwm_auto_point_temp_hyst, NULL, 2, 0),
457 SENSOR_ATTR_2(pwm1_auto_point4_temp_hyst, S_IRUGO,
458 show_pwm_auto_point_temp_hyst, NULL, 3, 0),
459
460 SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
461 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
462 0, 1),
463 SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
464 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
465 1, 1),
466 SENSOR_ATTR_2(pwm2_auto_point3_pwm, S_IRUGO|S_IWUSR,
467 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
468 2, 1),
469 SENSOR_ATTR_2(pwm2_auto_point4_pwm, S_IRUGO|S_IWUSR,
470 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
471 3, 1),
472 SENSOR_ATTR_2(pwm2_auto_point5_pwm, S_IRUGO|S_IWUSR,
473 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
474 4, 1),
475 SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
476 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
477 0, 1),
478 SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
479 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
480 1, 1),
481 SENSOR_ATTR_2(pwm2_auto_point3_temp, S_IRUGO|S_IWUSR,
482 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
483 2, 1),
484 SENSOR_ATTR_2(pwm2_auto_point4_temp, S_IRUGO|S_IWUSR,
485 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
486 3, 1),
487 SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
488 show_pwm_auto_point_temp_hyst,
489 store_pwm_auto_point_temp_hyst,
490 0, 1),
491 SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
492 show_pwm_auto_point_temp_hyst, NULL, 1, 1),
493 SENSOR_ATTR_2(pwm2_auto_point3_temp_hyst, S_IRUGO,
494 show_pwm_auto_point_temp_hyst, NULL, 2, 1),
495 SENSOR_ATTR_2(pwm2_auto_point4_temp_hyst, S_IRUGO,
496 show_pwm_auto_point_temp_hyst, NULL, 3, 1),
497
498 SENSOR_ATTR_2(pwm3_auto_point1_pwm, S_IRUGO|S_IWUSR,
499 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
500 0, 2),
501 SENSOR_ATTR_2(pwm3_auto_point2_pwm, S_IRUGO|S_IWUSR,
502 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
503 1, 2),
504 SENSOR_ATTR_2(pwm3_auto_point3_pwm, S_IRUGO|S_IWUSR,
505 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
506 2, 2),
507 SENSOR_ATTR_2(pwm3_auto_point4_pwm, S_IRUGO|S_IWUSR,
508 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
509 3, 2),
510 SENSOR_ATTR_2(pwm3_auto_point5_pwm, S_IRUGO|S_IWUSR,
511 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
512 4, 2),
513 SENSOR_ATTR_2(pwm3_auto_point1_temp, S_IRUGO|S_IWUSR,
514 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
515 0, 2),
516 SENSOR_ATTR_2(pwm3_auto_point2_temp, S_IRUGO|S_IWUSR,
517 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
518 1, 2),
519 SENSOR_ATTR_2(pwm3_auto_point3_temp, S_IRUGO|S_IWUSR,
520 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
521 2, 2),
522 SENSOR_ATTR_2(pwm3_auto_point4_temp, S_IRUGO|S_IWUSR,
523 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
524 3, 2),
525 SENSOR_ATTR_2(pwm3_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
526 show_pwm_auto_point_temp_hyst,
527 store_pwm_auto_point_temp_hyst,
528 0, 2),
529 SENSOR_ATTR_2(pwm3_auto_point2_temp_hyst, S_IRUGO,
530 show_pwm_auto_point_temp_hyst, NULL, 1, 2),
531 SENSOR_ATTR_2(pwm3_auto_point3_temp_hyst, S_IRUGO,
532 show_pwm_auto_point_temp_hyst, NULL, 2, 2),
533 SENSOR_ATTR_2(pwm3_auto_point4_temp_hyst, S_IRUGO,
534 show_pwm_auto_point_temp_hyst, NULL, 3, 2),
535
536 SENSOR_ATTR_2(pwm4, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 3),
537 SENSOR_ATTR_2(pwm4_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
538 store_pwm_enable, 0, 3),
539 SENSOR_ATTR_2(pwm4_interpolate, S_IRUGO|S_IWUSR,
540 show_pwm_interpolate, store_pwm_interpolate, 0, 3),
541 SENSOR_ATTR_2(pwm4_auto_channels_temp, S_IRUGO|S_IWUSR,
542 show_pwm_auto_point_channel,
543 store_pwm_auto_point_channel, 0, 3),
544 SENSOR_ATTR_2(pwm4_auto_point1_pwm, S_IRUGO|S_IWUSR,
545 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
546 0, 3),
547 SENSOR_ATTR_2(pwm4_auto_point2_pwm, S_IRUGO|S_IWUSR,
548 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
549 1, 3),
550 SENSOR_ATTR_2(pwm4_auto_point3_pwm, S_IRUGO|S_IWUSR,
551 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
552 2, 3),
553 SENSOR_ATTR_2(pwm4_auto_point4_pwm, S_IRUGO|S_IWUSR,
554 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
555 3, 3),
556 SENSOR_ATTR_2(pwm4_auto_point5_pwm, S_IRUGO|S_IWUSR,
557 show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
558 4, 3),
559 SENSOR_ATTR_2(pwm4_auto_point1_temp, S_IRUGO|S_IWUSR,
560 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
561 0, 3),
562 SENSOR_ATTR_2(pwm4_auto_point2_temp, S_IRUGO|S_IWUSR,
563 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
564 1, 3),
565 SENSOR_ATTR_2(pwm4_auto_point3_temp, S_IRUGO|S_IWUSR,
566 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
567 2, 3),
568 SENSOR_ATTR_2(pwm4_auto_point4_temp, S_IRUGO|S_IWUSR,
569 show_pwm_auto_point_temp, store_pwm_auto_point_temp,
570 3, 3),
571 SENSOR_ATTR_2(pwm4_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
572 show_pwm_auto_point_temp_hyst,
573 store_pwm_auto_point_temp_hyst,
574 0, 3),
575 SENSOR_ATTR_2(pwm4_auto_point2_temp_hyst, S_IRUGO,
576 show_pwm_auto_point_temp_hyst, NULL, 1, 3),
577 SENSOR_ATTR_2(pwm4_auto_point3_temp_hyst, S_IRUGO,
578 show_pwm_auto_point_temp_hyst, NULL, 2, 3),
579 SENSOR_ATTR_2(pwm4_auto_point4_temp_hyst, S_IRUGO,
580 show_pwm_auto_point_temp_hyst, NULL, 3, 3),
581 };
582
583
584 /* Super I/O functions */
585 static inline int superio_inb(int base, int reg)
586 {
587 outb(reg, base);
588 return inb(base + 1);
589 }
590
591 static int superio_inw(int base, int reg)
592 {
593 int val;
594 outb(reg++, base);
595 val = inb(base + 1) << 8;
596 outb(reg, base);
597 val |= inb(base + 1);
598 return val;
599 }
600
601 static inline void superio_enter(int base)
602 {
603 /* according to the datasheet the key must be send twice! */
604 outb( SIO_UNLOCK_KEY, base);
605 outb( SIO_UNLOCK_KEY, base);
606 }
607
608 static inline void superio_select( int base, int ld)
609 {
610 outb(SIO_REG_LDSEL, base);
611 outb(ld, base + 1);
612 }
613
614 static inline void superio_exit(int base)
615 {
616 outb(SIO_LOCK_KEY, base);
617 }
618
619 static inline u16 fan_from_reg(u16 reg)
620 {
621 return reg ? (1500000 / reg) : 0;
622 }
623
624 static inline u16 fan_to_reg(u16 fan)
625 {
626 return fan ? (1500000 / fan) : 0;
627 }
628
629 static u8 f71882fg_read8(struct f71882fg_data *data, u8 reg)
630 {
631 u8 val;
632
633 outb(reg, data->addr + ADDR_REG_OFFSET);
634 val = inb(data->addr + DATA_REG_OFFSET);
635
636 return val;
637 }
638
639 static u16 f71882fg_read16(struct f71882fg_data *data, u8 reg)
640 {
641 u16 val;
642
643 outb(reg++, data->addr + ADDR_REG_OFFSET);
644 val = inb(data->addr + DATA_REG_OFFSET) << 8;
645 outb(reg, data->addr + ADDR_REG_OFFSET);
646 val |= inb(data->addr + DATA_REG_OFFSET);
647
648 return val;
649 }
650
651 static void f71882fg_write8(struct f71882fg_data *data, u8 reg, u8 val)
652 {
653 outb(reg, data->addr + ADDR_REG_OFFSET);
654 outb(val, data->addr + DATA_REG_OFFSET);
655 }
656
657 static void f71882fg_write16(struct f71882fg_data *data, u8 reg, u16 val)
658 {
659 outb(reg++, data->addr + ADDR_REG_OFFSET);
660 outb(val >> 8, data->addr + DATA_REG_OFFSET);
661 outb(reg, data->addr + ADDR_REG_OFFSET);
662 outb(val & 255, data->addr + DATA_REG_OFFSET);
663 }
664
665 static struct f71882fg_data *f71882fg_update_device(struct device *dev)
666 {
667 struct f71882fg_data *data = dev_get_drvdata(dev);
668 int nr, reg, reg2;
669 int nr_fans = (data->type == f71862fg) ? 3 : 4;
670
671 mutex_lock(&data->update_lock);
672
673 /* Update once every 60 seconds */
674 if ( time_after(jiffies, data->last_limits + 60 * HZ ) ||
675 !data->valid) {
676 if (data->type == f71882fg) {
677 data->in1_max =
678 f71882fg_read8(data, F71882FG_REG_IN1_HIGH);
679 data->in_beep =
680 f71882fg_read8(data, F71882FG_REG_IN_BEEP);
681 }
682
683 /* Get High & boundary temps*/
684 for (nr = 1; nr < 4; nr++) {
685 data->temp_ovt[nr] = f71882fg_read8(data,
686 F71882FG_REG_TEMP_OVT(nr));
687 data->temp_high[nr] = f71882fg_read8(data,
688 F71882FG_REG_TEMP_HIGH(nr));
689 }
690
691 /* Have to hardcode hyst*/
692 data->temp_hyst[1] = f71882fg_read8(data,
693 F71882FG_REG_TEMP_HYST1) >> 4;
694 /* Hyst temps 2 & 3 stored in same register */
695 reg = f71882fg_read8(data, F71882FG_REG_TEMP_HYST23);
696 data->temp_hyst[2] = reg & 0x0F;
697 data->temp_hyst[3] = reg >> 4;
698
699 /* Have to hardcode type, because temp1 is special */
700 reg = f71882fg_read8(data, F71882FG_REG_TEMP_TYPE);
701 reg2 = f71882fg_read8(data, F71882FG_REG_PECI);
702 if ((reg2 & 0x03) == 0x01)
703 data->temp_type[1] = 6 /* PECI */;
704 else if ((reg2 & 0x03) == 0x02)
705 data->temp_type[1] = 5 /* AMDSI */;
706 else
707 data->temp_type[1] = (reg & 0x02) ? 2 : 4;
708
709 data->temp_type[2] = (reg & 0x04) ? 2 : 4;
710 data->temp_type[3] = (reg & 0x08) ? 2 : 4;
711
712 data->temp_beep = f71882fg_read8(data, F71882FG_REG_TEMP_BEEP);
713
714 data->fan_beep = f71882fg_read8(data, F71882FG_REG_FAN_BEEP);
715
716 data->pwm_enable = f71882fg_read8(data,
717 F71882FG_REG_PWM_ENABLE);
718 data->pwm_auto_point_hyst[0] = f71882fg_read8(data,
719 F71882FG_REG_FAN_HYST0);
720 data->pwm_auto_point_hyst[1] = f71882fg_read8(data,
721 F71882FG_REG_FAN_HYST1);
722 for (nr = 0; nr < nr_fans; nr++) {
723 data->pwm_auto_point_mapping[nr] =
724 f71882fg_read8(data,
725 F71882FG_REG_POINT_MAPPING(nr));
726
727 if (data->type == f71882fg) {
728 int point;
729 for (point = 0; point < 5; point++) {
730 data->pwm_auto_point_pwm[nr][point] =
731 f71882fg_read8(data,
732 F71882FG_REG_POINT_PWM
733 (nr, point));
734 }
735 for (point = 0; point < 4; point++) {
736 data->pwm_auto_point_temp[nr][point] =
737 f71882fg_read8(data,
738 F71882FG_REG_POINT_TEMP
739 (nr, point));
740 }
741 } else {
742 data->pwm_auto_point_pwm[nr][1] =
743 f71882fg_read8(data,
744 F71882FG_REG_POINT_PWM
745 (nr, 1));
746 data->pwm_auto_point_pwm[nr][4] =
747 f71882fg_read8(data,
748 F71882FG_REG_POINT_PWM
749 (nr, 4));
750 data->pwm_auto_point_temp[nr][0] =
751 f71882fg_read8(data,
752 F71882FG_REG_POINT_TEMP
753 (nr, 0));
754 data->pwm_auto_point_temp[nr][3] =
755 f71882fg_read8(data,
756 F71882FG_REG_POINT_TEMP
757 (nr, 3));
758 }
759 }
760 data->last_limits = jiffies;
761 }
762
763 /* Update every second */
764 if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
765 data->temp_status = f71882fg_read8(data,
766 F71882FG_REG_TEMP_STATUS);
767 data->temp_diode_open = f71882fg_read8(data,
768 F71882FG_REG_TEMP_DIODE_OPEN);
769 for (nr = 1; nr < 4; nr++)
770 data->temp[nr] = f71882fg_read8(data,
771 F71882FG_REG_TEMP(nr));
772
773 data->fan_status = f71882fg_read8(data,
774 F71882FG_REG_FAN_STATUS);
775 for (nr = 0; nr < nr_fans; nr++) {
776 data->fan[nr] = f71882fg_read16(data,
777 F71882FG_REG_FAN(nr));
778 data->fan_target[nr] =
779 f71882fg_read16(data, F71882FG_REG_FAN_TARGET(nr));
780 data->fan_full_speed[nr] =
781 f71882fg_read16(data,
782 F71882FG_REG_FAN_FULL_SPEED(nr));
783 data->pwm[nr] =
784 f71882fg_read8(data, F71882FG_REG_PWM(nr));
785 }
786
787 if (data->type == f71882fg)
788 data->in_status = f71882fg_read8(data,
789 F71882FG_REG_IN_STATUS);
790 for (nr = 0; nr < 9; nr++)
791 data->in[nr] = f71882fg_read8(data,
792 F71882FG_REG_IN(nr));
793
794 data->last_updated = jiffies;
795 data->valid = 1;
796 }
797
798 mutex_unlock(&data->update_lock);
799
800 return data;
801 }
802
803 /* Sysfs Interface */
804 static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
805 char *buf)
806 {
807 struct f71882fg_data *data = f71882fg_update_device(dev);
808 int nr = to_sensor_dev_attr_2(devattr)->index;
809 int speed = fan_from_reg(data->fan[nr]);
810
811 if (speed == FAN_MIN_DETECT)
812 speed = 0;
813
814 return sprintf(buf, "%d\n", speed);
815 }
816
817 static ssize_t show_fan_full_speed(struct device *dev,
818 struct device_attribute *devattr, char *buf)
819 {
820 struct f71882fg_data *data = f71882fg_update_device(dev);
821 int nr = to_sensor_dev_attr_2(devattr)->index;
822 int speed = fan_from_reg(data->fan_full_speed[nr]);
823 return sprintf(buf, "%d\n", speed);
824 }
825
826 static ssize_t store_fan_full_speed(struct device *dev,
827 struct device_attribute *devattr,
828 const char *buf, size_t count)
829 {
830 struct f71882fg_data *data = dev_get_drvdata(dev);
831 int nr = to_sensor_dev_attr_2(devattr)->index;
832 long val = simple_strtol(buf, NULL, 10);
833
834 val = SENSORS_LIMIT(val, 23, 1500000);
835 val = fan_to_reg(val);
836
837 mutex_lock(&data->update_lock);
838 if (data->pwm_enable & (1 << (2 * nr)))
839 /* PWM mode */
840 count = -EINVAL;
841 else {
842 /* RPM mode */
843 f71882fg_write16(data, F71882FG_REG_FAN_FULL_SPEED(nr), val);
844 data->fan_full_speed[nr] = val;
845 }
846 mutex_unlock(&data->update_lock);
847
848 return count;
849 }
850
851 static ssize_t show_fan_beep(struct device *dev, struct device_attribute
852 *devattr, char *buf)
853 {
854 struct f71882fg_data *data = f71882fg_update_device(dev);
855 int nr = to_sensor_dev_attr_2(devattr)->index;
856
857 if (data->fan_beep & (1 << nr))
858 return sprintf(buf, "1\n");
859 else
860 return sprintf(buf, "0\n");
861 }
862
863 static ssize_t store_fan_beep(struct device *dev, struct device_attribute
864 *devattr, const char *buf, size_t count)
865 {
866 struct f71882fg_data *data = dev_get_drvdata(dev);
867 int nr = to_sensor_dev_attr_2(devattr)->index;
868 int val = simple_strtoul(buf, NULL, 10);
869
870 mutex_lock(&data->update_lock);
871 if (val)
872 data->fan_beep |= 1 << nr;
873 else
874 data->fan_beep &= ~(1 << nr);
875
876 f71882fg_write8(data, F71882FG_REG_FAN_BEEP, data->fan_beep);
877 mutex_unlock(&data->update_lock);
878
879 return count;
880 }
881
882 static ssize_t show_fan_alarm(struct device *dev, struct device_attribute
883 *devattr, char *buf)
884 {
885 struct f71882fg_data *data = f71882fg_update_device(dev);
886 int nr = to_sensor_dev_attr_2(devattr)->index;
887
888 if (data->fan_status & (1 << nr))
889 return sprintf(buf, "1\n");
890 else
891 return sprintf(buf, "0\n");
892 }
893
894 static ssize_t show_in(struct device *dev, struct device_attribute *devattr,
895 char *buf)
896 {
897 struct f71882fg_data *data = f71882fg_update_device(dev);
898 int nr = to_sensor_dev_attr_2(devattr)->index;
899
900 return sprintf(buf, "%d\n", data->in[nr] * 8);
901 }
902
903 static ssize_t show_in_max(struct device *dev, struct device_attribute
904 *devattr, char *buf)
905 {
906 struct f71882fg_data *data = f71882fg_update_device(dev);
907
908 return sprintf(buf, "%d\n", data->in1_max * 8);
909 }
910
911 static ssize_t store_in_max(struct device *dev, struct device_attribute
912 *devattr, const char *buf, size_t count)
913 {
914 struct f71882fg_data *data = dev_get_drvdata(dev);
915 int val = simple_strtoul(buf, NULL, 10) / 8;
916
917 if (val > 255)
918 val = 255;
919
920 mutex_lock(&data->update_lock);
921 f71882fg_write8(data, F71882FG_REG_IN1_HIGH, val);
922 data->in1_max = val;
923 mutex_unlock(&data->update_lock);
924
925 return count;
926 }
927
928 static ssize_t show_in_beep(struct device *dev, struct device_attribute
929 *devattr, char *buf)
930 {
931 struct f71882fg_data *data = f71882fg_update_device(dev);
932 int nr = to_sensor_dev_attr_2(devattr)->index;
933
934 if (data->in_beep & (1 << nr))
935 return sprintf(buf, "1\n");
936 else
937 return sprintf(buf, "0\n");
938 }
939
940 static ssize_t store_in_beep(struct device *dev, struct device_attribute
941 *devattr, const char *buf, size_t count)
942 {
943 struct f71882fg_data *data = dev_get_drvdata(dev);
944 int nr = to_sensor_dev_attr_2(devattr)->index;
945 int val = simple_strtoul(buf, NULL, 10);
946
947 mutex_lock(&data->update_lock);
948 if (val)
949 data->in_beep |= 1 << nr;
950 else
951 data->in_beep &= ~(1 << nr);
952
953 f71882fg_write8(data, F71882FG_REG_IN_BEEP, data->in_beep);
954 mutex_unlock(&data->update_lock);
955
956 return count;
957 }
958
959 static ssize_t show_in_alarm(struct device *dev, struct device_attribute
960 *devattr, char *buf)
961 {
962 struct f71882fg_data *data = f71882fg_update_device(dev);
963 int nr = to_sensor_dev_attr_2(devattr)->index;
964
965 if (data->in_status & (1 << nr))
966 return sprintf(buf, "1\n");
967 else
968 return sprintf(buf, "0\n");
969 }
970
971 static ssize_t show_temp(struct device *dev, struct device_attribute *devattr,
972 char *buf)
973 {
974 struct f71882fg_data *data = f71882fg_update_device(dev);
975 int nr = to_sensor_dev_attr_2(devattr)->index;
976
977 return sprintf(buf, "%d\n", data->temp[nr] * 1000);
978 }
979
980 static ssize_t show_temp_max(struct device *dev, struct device_attribute
981 *devattr, char *buf)
982 {
983 struct f71882fg_data *data = f71882fg_update_device(dev);
984 int nr = to_sensor_dev_attr_2(devattr)->index;
985
986 return sprintf(buf, "%d\n", data->temp_high[nr] * 1000);
987 }
988
989 static ssize_t store_temp_max(struct device *dev, struct device_attribute
990 *devattr, const char *buf, size_t count)
991 {
992 struct f71882fg_data *data = dev_get_drvdata(dev);
993 int nr = to_sensor_dev_attr_2(devattr)->index;
994 int val = simple_strtoul(buf, NULL, 10) / 1000;
995
996 if (val > 255)
997 val = 255;
998
999 mutex_lock(&data->update_lock);
1000 f71882fg_write8(data, F71882FG_REG_TEMP_HIGH(nr), val);
1001 data->temp_high[nr] = val;
1002 mutex_unlock(&data->update_lock);
1003
1004 return count;
1005 }
1006
1007 static ssize_t show_temp_max_hyst(struct device *dev, struct device_attribute
1008 *devattr, char *buf)
1009 {
1010 struct f71882fg_data *data = f71882fg_update_device(dev);
1011 int nr = to_sensor_dev_attr_2(devattr)->index;
1012
1013 return sprintf(buf, "%d\n",
1014 (data->temp_high[nr] - data->temp_hyst[nr]) * 1000);
1015 }
1016
1017 static ssize_t store_temp_max_hyst(struct device *dev, struct device_attribute
1018 *devattr, const char *buf, size_t count)
1019 {
1020 struct f71882fg_data *data = dev_get_drvdata(dev);
1021 int nr = to_sensor_dev_attr_2(devattr)->index;
1022 int val = simple_strtoul(buf, NULL, 10) / 1000;
1023 ssize_t ret = count;
1024
1025 mutex_lock(&data->update_lock);
1026
1027 /* convert abs to relative and check */
1028 val = data->temp_high[nr] - val;
1029 if (val < 0 || val > 15) {
1030 ret = -EINVAL;
1031 goto store_temp_max_hyst_exit;
1032 }
1033
1034 data->temp_hyst[nr] = val;
1035
1036 /* convert value to register contents */
1037 switch (nr) {
1038 case 1:
1039 val = val << 4;
1040 break;
1041 case 2:
1042 val = val | (data->temp_hyst[3] << 4);
1043 break;
1044 case 3:
1045 val = data->temp_hyst[2] | (val << 4);
1046 break;
1047 }
1048
1049 f71882fg_write8(data, (nr <= 1) ? F71882FG_REG_TEMP_HYST1 :
1050 F71882FG_REG_TEMP_HYST23, val);
1051
1052 store_temp_max_hyst_exit:
1053 mutex_unlock(&data->update_lock);
1054 return ret;
1055 }
1056
1057 static ssize_t show_temp_crit(struct device *dev, struct device_attribute
1058 *devattr, char *buf)
1059 {
1060 struct f71882fg_data *data = f71882fg_update_device(dev);
1061 int nr = to_sensor_dev_attr_2(devattr)->index;
1062
1063 return sprintf(buf, "%d\n", data->temp_ovt[nr] * 1000);
1064 }
1065
1066 static ssize_t store_temp_crit(struct device *dev, struct device_attribute
1067 *devattr, const char *buf, size_t count)
1068 {
1069 struct f71882fg_data *data = dev_get_drvdata(dev);
1070 int nr = to_sensor_dev_attr_2(devattr)->index;
1071 int val = simple_strtoul(buf, NULL, 10) / 1000;
1072
1073 if (val > 255)
1074 val = 255;
1075
1076 mutex_lock(&data->update_lock);
1077 f71882fg_write8(data, F71882FG_REG_TEMP_OVT(nr), val);
1078 data->temp_ovt[nr] = val;
1079 mutex_unlock(&data->update_lock);
1080
1081 return count;
1082 }
1083
1084 static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute
1085 *devattr, char *buf)
1086 {
1087 struct f71882fg_data *data = f71882fg_update_device(dev);
1088 int nr = to_sensor_dev_attr_2(devattr)->index;
1089
1090 return sprintf(buf, "%d\n",
1091 (data->temp_ovt[nr] - data->temp_hyst[nr]) * 1000);
1092 }
1093
1094 static ssize_t show_temp_type(struct device *dev, struct device_attribute
1095 *devattr, char *buf)
1096 {
1097 struct f71882fg_data *data = f71882fg_update_device(dev);
1098 int nr = to_sensor_dev_attr_2(devattr)->index;
1099
1100 return sprintf(buf, "%d\n", data->temp_type[nr]);
1101 }
1102
1103 static ssize_t show_temp_beep(struct device *dev, struct device_attribute
1104 *devattr, char *buf)
1105 {
1106 struct f71882fg_data *data = f71882fg_update_device(dev);
1107 int nr = to_sensor_dev_attr_2(devattr)->index;
1108
1109 if (data->temp_beep & (1 << nr))
1110 return sprintf(buf, "1\n");
1111 else
1112 return sprintf(buf, "0\n");
1113 }
1114
1115 static ssize_t store_temp_beep(struct device *dev, struct device_attribute
1116 *devattr, const char *buf, size_t count)
1117 {
1118 struct f71882fg_data *data = dev_get_drvdata(dev);
1119 int nr = to_sensor_dev_attr_2(devattr)->index;
1120 int val = simple_strtoul(buf, NULL, 10);
1121
1122 mutex_lock(&data->update_lock);
1123 if (val)
1124 data->temp_beep |= 1 << nr;
1125 else
1126 data->temp_beep &= ~(1 << nr);
1127
1128 f71882fg_write8(data, F71882FG_REG_TEMP_BEEP, data->temp_beep);
1129 mutex_unlock(&data->update_lock);
1130
1131 return count;
1132 }
1133
1134 static ssize_t show_temp_alarm(struct device *dev, struct device_attribute
1135 *devattr, char *buf)
1136 {
1137 struct f71882fg_data *data = f71882fg_update_device(dev);
1138 int nr = to_sensor_dev_attr_2(devattr)->index;
1139
1140 if (data->temp_status & (1 << nr))
1141 return sprintf(buf, "1\n");
1142 else
1143 return sprintf(buf, "0\n");
1144 }
1145
1146 static ssize_t show_temp_fault(struct device *dev, struct device_attribute
1147 *devattr, char *buf)
1148 {
1149 struct f71882fg_data *data = f71882fg_update_device(dev);
1150 int nr = to_sensor_dev_attr_2(devattr)->index;
1151
1152 if (data->temp_diode_open & (1 << nr))
1153 return sprintf(buf, "1\n");
1154 else
1155 return sprintf(buf, "0\n");
1156 }
1157
1158 static ssize_t show_pwm(struct device *dev,
1159 struct device_attribute *devattr, char *buf)
1160 {
1161 struct f71882fg_data *data = f71882fg_update_device(dev);
1162 int val, nr = to_sensor_dev_attr_2(devattr)->index;
1163 if (data->pwm_enable & (1 << (2 * nr)))
1164 /* PWM mode */
1165 val = data->pwm[nr];
1166 else {
1167 /* RPM mode */
1168 mutex_lock(&data->update_lock);
1169 val = 255 * fan_from_reg(data->fan_target[nr])
1170 / fan_from_reg(data->fan_full_speed[nr]);
1171 mutex_unlock(&data->update_lock);
1172 }
1173 return sprintf(buf, "%d\n", val);
1174 }
1175
1176 static ssize_t store_pwm(struct device *dev,
1177 struct device_attribute *devattr, const char *buf,
1178 size_t count)
1179 {
1180 /* struct f71882fg_data *data = dev_get_drvdata(dev); */
1181 struct f71882fg_data *data = f71882fg_update_device(dev);
1182 int nr = to_sensor_dev_attr_2(devattr)->index;
1183 long val = simple_strtol(buf, NULL, 10);
1184 val = SENSORS_LIMIT(val, 0, 255);
1185
1186 mutex_lock(&data->update_lock);
1187 if (data->pwm_enable & (1 << (2 * nr))) {
1188 /* PWM mode */
1189 f71882fg_write8(data, F71882FG_REG_PWM(nr), val);
1190 data->pwm[nr] = val;
1191 } else {
1192 /* RPM mode */
1193 int target = val * fan_from_reg(data->fan_full_speed[nr]) / 255;
1194 f71882fg_write16(data, F71882FG_REG_FAN_TARGET(nr),
1195 fan_to_reg(target));
1196 data->fan_target[nr] = fan_to_reg(target);
1197 }
1198 mutex_unlock(&data->update_lock);
1199
1200 return count;
1201 }
1202
1203 static ssize_t show_pwm_enable(struct device *dev,
1204 struct device_attribute *devattr, char *buf)
1205 {
1206 int result;
1207 struct f71882fg_data *data = f71882fg_update_device(dev);
1208 int nr = to_sensor_dev_attr_2(devattr)->index;
1209
1210 if (data->pwm_enable & (2 << (2 * nr)))
1211 result = 1;
1212 else
1213 result = 2;
1214
1215 return sprintf(buf, "%d\n", result);
1216 }
1217
1218 static ssize_t store_pwm_enable(struct device *dev, struct device_attribute
1219 *devattr, const char *buf, size_t count)
1220 {
1221 struct f71882fg_data *data = dev_get_drvdata(dev);
1222 int nr = to_sensor_dev_attr_2(devattr)->index;
1223 long val = simple_strtol(buf, NULL, 10);
1224 if (val < 1 || val > 2)
1225 return -EINVAL;
1226
1227 mutex_lock(&data->update_lock);
1228 switch (val) {
1229 case 1:
1230 data->pwm_enable |= 2 << (2 * nr);
1231 break; /* Manual */
1232 case 2:
1233 data->pwm_enable &= ~(2 << (2 * nr));
1234 break; /* Temperature ctrl */
1235 }
1236 if (data->type == f71882fg) {
1237 switch (fan_mode[nr]) {
1238 case 1:
1239 data->pwm_enable |= 1 << (2 * nr);
1240 break; /* Duty cycle mode */
1241 case 2:
1242 data->pwm_enable &= ~(1 << (2 * nr));
1243 break; /* RPM mode */
1244 }
1245 }
1246 f71882fg_write8(data, F71882FG_REG_PWM_ENABLE, data->pwm_enable);
1247 mutex_unlock(&data->update_lock);
1248
1249 return count;
1250 }
1251
1252 static ssize_t show_pwm_auto_point_pwm(struct device *dev,
1253 struct device_attribute *devattr,
1254 char *buf)
1255 {
1256 int result;
1257 struct f71882fg_data *data = f71882fg_update_device(dev);
1258 int pwm = to_sensor_dev_attr_2(devattr)->index;
1259 int point = to_sensor_dev_attr_2(devattr)->nr;
1260
1261 if (data->pwm_enable & (1 << (2 * pwm))) {
1262 /* PWM mode */
1263 result = data->pwm_auto_point_pwm[pwm][point];
1264 } else {
1265 /* RPM mode */
1266 result = 32 * 255 / (32 + data->pwm_auto_point_pwm[pwm][point]);
1267 }
1268
1269 return sprintf(buf, "%d\n", result);
1270 }
1271
1272 static ssize_t store_pwm_auto_point_pwm(struct device *dev,
1273 struct device_attribute *devattr,
1274 const char *buf, size_t count)
1275 {
1276 /* struct f71882fg_data *data = dev_get_drvdata(dev); */
1277 struct f71882fg_data *data = f71882fg_update_device(dev);
1278 int pwm = to_sensor_dev_attr_2(devattr)->index;
1279 int point = to_sensor_dev_attr_2(devattr)->nr;
1280 int val = simple_strtoul(buf, NULL, 10);
1281 val = SENSORS_LIMIT(val, 0, 255);
1282
1283 mutex_lock(&data->update_lock);
1284 if (data->pwm_enable & (1 << (2 * pwm))) {
1285 /* PWM mode */
1286 } else {
1287 /* RPM mode */
1288 if (val < 29) /* Prevent negative numbers */
1289 val = 255;
1290 else
1291 val = (255 - val) * 32 / val;
1292 }
1293 f71882fg_write8(data, F71882FG_REG_POINT_PWM(pwm, point), val);
1294 data->pwm_auto_point_pwm[pwm][point] = val;
1295 mutex_unlock(&data->update_lock);
1296
1297 return count;
1298 }
1299
1300 static ssize_t show_pwm_auto_point_temp_hyst(struct device *dev,
1301 struct device_attribute *devattr,
1302 char *buf)
1303 {
1304 int result = 0;
1305 struct f71882fg_data *data = f71882fg_update_device(dev);
1306 int nr = to_sensor_dev_attr_2(devattr)->index;
1307 int point = to_sensor_dev_attr_2(devattr)->nr;
1308
1309 mutex_lock(&data->update_lock);
1310 switch (nr) {
1311 case 0:
1312 result = data->pwm_auto_point_hyst[0] & 0x0f;
1313 break;
1314 case 1:
1315 result = data->pwm_auto_point_hyst[0] >> 4;
1316 break;
1317 case 2:
1318 result = data->pwm_auto_point_hyst[1] & 0x0f;
1319 break;
1320 case 3:
1321 result = data->pwm_auto_point_hyst[1] >> 4;
1322 break;
1323 }
1324 result = 1000 * (data->pwm_auto_point_temp[nr][point] - result);
1325 mutex_unlock(&data->update_lock);
1326
1327 return sprintf(buf, "%d\n", result);
1328 }
1329
1330 static ssize_t store_pwm_auto_point_temp_hyst(struct device *dev,
1331 struct device_attribute *devattr,
1332 const char *buf, size_t count)
1333 {
1334 struct f71882fg_data *data = f71882fg_update_device(dev);
1335 int nr = to_sensor_dev_attr_2(devattr)->index;
1336 int point = to_sensor_dev_attr_2(devattr)->nr;
1337 long val = simple_strtol(buf, NULL, 10) / 1000;
1338
1339 mutex_lock(&data->update_lock);
1340 val = SENSORS_LIMIT(val, data->pwm_auto_point_temp[nr][point] - 15,
1341 data->pwm_auto_point_temp[nr][point]);
1342 val = data->pwm_auto_point_temp[nr][point] - val;
1343
1344 switch (nr) {
1345 case 0:
1346 val = (data->pwm_auto_point_hyst[0] & 0xf0) | val;
1347 break;
1348 case 1:
1349 val = (data->pwm_auto_point_hyst[0] & 0x0f) | (val << 4);
1350 break;
1351 case 2:
1352 val = (data->pwm_auto_point_hyst[1] & 0xf0) | val;
1353 break;
1354 case 3:
1355 val = (data->pwm_auto_point_hyst[1] & 0x0f) | (val << 4);
1356 break;
1357 }
1358 if (nr == 0 || nr == 1) {
1359 f71882fg_write8(data, F71882FG_REG_FAN_HYST0, val);
1360 data->pwm_auto_point_hyst[0] = val;
1361 } else {
1362 f71882fg_write8(data, F71882FG_REG_FAN_HYST1, val);
1363 data->pwm_auto_point_hyst[1] = val;
1364 }
1365 mutex_unlock(&data->update_lock);
1366
1367 return count;
1368 }
1369
1370 static ssize_t show_pwm_interpolate(struct device *dev,
1371 struct device_attribute *devattr, char *buf)
1372 {
1373 int result;
1374 struct f71882fg_data *data = f71882fg_update_device(dev);
1375 int nr = to_sensor_dev_attr_2(devattr)->index;
1376
1377 result = (data->pwm_auto_point_mapping[nr] >> 4) & 1;
1378
1379 return sprintf(buf, "%d\n", result);
1380 }
1381
1382 static ssize_t store_pwm_interpolate(struct device *dev,
1383 struct device_attribute *devattr,
1384 const char *buf, size_t count)
1385 {
1386 /* struct f71882fg_data *data = dev_get_drvdata(dev); */
1387 struct f71882fg_data *data = f71882fg_update_device(dev);
1388 int nr = to_sensor_dev_attr_2(devattr)->index;
1389 int val = simple_strtoul(buf, NULL, 10);
1390 mutex_lock(&data->update_lock);
1391 if (val)
1392 val = data->pwm_auto_point_mapping[nr] | (1 << 4);
1393 else
1394 val = data->pwm_auto_point_mapping[nr] & (~(1 << 4));
1395 f71882fg_write8(data, F71882FG_REG_POINT_MAPPING(nr), val);
1396 data->pwm_auto_point_mapping[nr] = val;
1397 mutex_unlock(&data->update_lock);
1398
1399 return count;
1400 }
1401
1402 static ssize_t show_pwm_auto_point_channel(struct device *dev,
1403 struct device_attribute *devattr,
1404 char *buf)
1405 {
1406 int result;
1407 struct f71882fg_data *data = f71882fg_update_device(dev);
1408 int nr = to_sensor_dev_attr_2(devattr)->index;
1409
1410 result = 1 << ((data->pwm_auto_point_mapping[nr] & 3) - 1);
1411
1412 return sprintf(buf, "%d\n", result);
1413 }
1414
1415 static ssize_t store_pwm_auto_point_channel(struct device *dev,
1416 struct device_attribute *devattr,
1417 const char *buf, size_t count)
1418 {
1419 /* struct f71882fg_data *data = dev_get_drvdata(dev); */
1420 struct f71882fg_data *data = f71882fg_update_device(dev);
1421 int nr = to_sensor_dev_attr_2(devattr)->index;
1422 long val = simple_strtol(buf, NULL, 10);
1423 switch (val) {
1424 case 1:
1425 val = 1;
1426 break;
1427 case 2:
1428 val = 2;
1429 break;
1430 case 4:
1431 val = 3;
1432 break;
1433 default:
1434 return -EINVAL;
1435 }
1436 mutex_lock(&data->update_lock);
1437 val = (data->pwm_auto_point_mapping[nr] & 0xfc) | val;
1438 f71882fg_write8(data, F71882FG_REG_POINT_MAPPING(nr), val);
1439 data->pwm_auto_point_mapping[nr] = val;
1440 mutex_unlock(&data->update_lock);
1441
1442 return count;
1443 }
1444
1445 static ssize_t show_pwm_auto_point_temp(struct device *dev,
1446 struct device_attribute *devattr,
1447 char *buf)
1448 {
1449 int result;
1450 struct f71882fg_data *data = f71882fg_update_device(dev);
1451 int pwm = to_sensor_dev_attr_2(devattr)->index;
1452 int point = to_sensor_dev_attr_2(devattr)->nr;
1453
1454 result = data->pwm_auto_point_temp[pwm][point];
1455 return sprintf(buf, "%d\n", 1000 * result);
1456 }
1457
1458 static ssize_t store_pwm_auto_point_temp(struct device *dev,
1459 struct device_attribute *devattr,
1460 const char *buf, size_t count)
1461 {
1462 /* struct f71882fg_data *data = dev_get_drvdata(dev); */
1463 struct f71882fg_data *data = f71882fg_update_device(dev);
1464 int pwm = to_sensor_dev_attr_2(devattr)->index;
1465 int point = to_sensor_dev_attr_2(devattr)->nr;
1466 long val = simple_strtol(buf, NULL, 10) / 1000;
1467 val = SENSORS_LIMIT(val, 0, 255);
1468
1469 mutex_lock(&data->update_lock);
1470 f71882fg_write8(data, F71882FG_REG_POINT_TEMP(pwm, point), val);
1471 data->pwm_auto_point_temp[pwm][point] = val;
1472 mutex_unlock(&data->update_lock);
1473
1474 return count;
1475 }
1476
1477 static ssize_t show_name(struct device *dev, struct device_attribute *devattr,
1478 char *buf)
1479 {
1480 struct f71882fg_data *data = dev_get_drvdata(dev);
1481 return sprintf(buf, "%s\n", f71882fg_names[data->type]);
1482 }
1483
1484 static int __devinit f71882fg_create_sysfs_files(struct platform_device *pdev,
1485 struct sensor_device_attribute_2 *attr, int count)
1486 {
1487 int err, i;
1488
1489 for (i = 0; i < count; i++) {
1490 err = device_create_file(&pdev->dev, &attr[i].dev_attr);
1491 if (err)
1492 return err;
1493 }
1494 return 0;
1495 }
1496
1497 static int __devinit f71882fg_probe(struct platform_device *pdev)
1498 {
1499 struct f71882fg_data *data;
1500 struct f71882fg_sio_data *sio_data = pdev->dev.platform_data;
1501 int err;
1502 u8 start_reg;
1503
1504 data = kzalloc(sizeof(struct f71882fg_data), GFP_KERNEL);
1505 if (!data)
1506 return -ENOMEM;
1507
1508 data->addr = platform_get_resource(pdev, IORESOURCE_IO, 0)->start;
1509 data->type = sio_data->type;
1510 mutex_init(&data->update_lock);
1511 platform_set_drvdata(pdev, data);
1512
1513 start_reg = f71882fg_read8(data, F71882FG_REG_START);
1514 if (!(start_reg & 0x03)) {
1515 dev_warn(&pdev->dev, "Hardware monitoring not activated\n");
1516 err = -ENODEV;
1517 goto exit_free;
1518 }
1519
1520 /* If it is a 71862 and the fan / pwm part is enabled sanity check
1521 the pwm settings */
1522 if (data->type == f71862fg && (start_reg & 0x02)) {
1523 u8 reg = f71882fg_read8(data, F71882FG_REG_PWM_ENABLE);
1524 if ((reg & 0x15) != 0x15) {
1525 dev_err(&pdev->dev,
1526 "Invalid (reserved) pwm settings: 0x%02x\n",
1527 (unsigned int)reg);
1528 err = -ENODEV;
1529 goto exit_free;
1530 }
1531 }
1532
1533 /* Register sysfs interface files */
1534 err = device_create_file(&pdev->dev, &dev_attr_name);
1535 if (err)
1536 goto exit_unregister_sysfs;
1537
1538 if (start_reg & 0x01) {
1539 err = f71882fg_create_sysfs_files(pdev, f718x2fg_in_temp_attr,
1540 ARRAY_SIZE(f718x2fg_in_temp_attr));
1541 if (err)
1542 goto exit_unregister_sysfs;
1543
1544 if (data->type == f71882fg) {
1545 err = f71882fg_create_sysfs_files(pdev,
1546 f71882fg_in_temp_attr,
1547 ARRAY_SIZE(f71882fg_in_temp_attr));
1548 if (err)
1549 goto exit_unregister_sysfs;
1550 }
1551 }
1552
1553 if (start_reg & 0x02) {
1554 err = f71882fg_create_sysfs_files(pdev, f718x2fg_fan_attr,
1555 ARRAY_SIZE(f718x2fg_fan_attr));
1556 if (err)
1557 goto exit_unregister_sysfs;
1558
1559 if (data->type == f71862fg) {
1560 err = f71882fg_create_sysfs_files(pdev,
1561 f71862fg_fan_attr,
1562 ARRAY_SIZE(f71862fg_fan_attr));
1563 } else {
1564 err = f71882fg_create_sysfs_files(pdev,
1565 f71882fg_fan_attr,
1566 ARRAY_SIZE(f71882fg_fan_attr));
1567 }
1568 if (err)
1569 goto exit_unregister_sysfs;
1570 }
1571
1572 data->hwmon_dev = hwmon_device_register(&pdev->dev);
1573 if (IS_ERR(data->hwmon_dev)) {
1574 err = PTR_ERR(data->hwmon_dev);
1575 data->hwmon_dev = NULL;
1576 goto exit_unregister_sysfs;
1577 }
1578
1579 return 0;
1580
1581 exit_unregister_sysfs:
1582 f71882fg_remove(pdev); /* Will unregister the sysfs files for us */
1583 return err; /* f71882fg_remove() also frees our data */
1584 exit_free:
1585 kfree(data);
1586 return err;
1587 }
1588
1589 static int f71882fg_remove(struct platform_device *pdev)
1590 {
1591 int i;
1592 struct f71882fg_data *data = platform_get_drvdata(pdev);
1593
1594 platform_set_drvdata(pdev, NULL);
1595 if (data->hwmon_dev)
1596 hwmon_device_unregister(data->hwmon_dev);
1597
1598 device_remove_file(&pdev->dev, &dev_attr_name);
1599
1600 for (i = 0; i < ARRAY_SIZE(f718x2fg_in_temp_attr); i++)
1601 device_remove_file(&pdev->dev,
1602 &f718x2fg_in_temp_attr[i].dev_attr);
1603
1604 for (i = 0; i < ARRAY_SIZE(f71882fg_in_temp_attr); i++)
1605 device_remove_file(&pdev->dev,
1606 &f71882fg_in_temp_attr[i].dev_attr);
1607
1608 for (i = 0; i < ARRAY_SIZE(f718x2fg_fan_attr); i++)
1609 device_remove_file(&pdev->dev, &f718x2fg_fan_attr[i].dev_attr);
1610
1611 for (i = 0; i < ARRAY_SIZE(f71862fg_fan_attr); i++)
1612 device_remove_file(&pdev->dev, &f71862fg_fan_attr[i].dev_attr);
1613
1614 for (i = 0; i < ARRAY_SIZE(f71882fg_fan_attr); i++)
1615 device_remove_file(&pdev->dev, &f71882fg_fan_attr[i].dev_attr);
1616
1617 kfree(data);
1618
1619 return 0;
1620 }
1621
1622 static int __init f71882fg_find(int sioaddr, unsigned short *address,
1623 struct f71882fg_sio_data *sio_data)
1624 {
1625 int err = -ENODEV;
1626 u16 devid;
1627
1628 superio_enter(sioaddr);
1629
1630 devid = superio_inw(sioaddr, SIO_REG_MANID);
1631 if (devid != SIO_FINTEK_ID) {
1632 printk(KERN_INFO DRVNAME ": Not a Fintek device\n");
1633 goto exit;
1634 }
1635
1636 devid = force_id ? force_id : superio_inw(sioaddr, SIO_REG_DEVID);
1637 switch (devid) {
1638 case SIO_F71862_ID:
1639 sio_data->type = f71862fg;
1640 break;
1641 case SIO_F71882_ID:
1642 sio_data->type = f71882fg;
1643 break;
1644 default:
1645 printk(KERN_INFO DRVNAME ": Unsupported Fintek device\n");
1646 goto exit;
1647 }
1648
1649 superio_select(sioaddr, SIO_F71882FG_LD_HWM);
1650 if (!(superio_inb(sioaddr, SIO_REG_ENABLE) & 0x01)) {
1651 printk(KERN_WARNING DRVNAME ": Device not activated\n");
1652 goto exit;
1653 }
1654
1655 *address = superio_inw(sioaddr, SIO_REG_ADDR);
1656 if (*address == 0)
1657 {
1658 printk(KERN_WARNING DRVNAME ": Base address not set\n");
1659 goto exit;
1660 }
1661 *address &= ~(REGION_LENGTH - 1); /* Ignore 3 LSB */
1662
1663 err = 0;
1664 printk(KERN_INFO DRVNAME ": Found %s chip at %#x, revision %d\n",
1665 f71882fg_names[sio_data->type], (unsigned int)*address,
1666 (int)superio_inb(sioaddr, SIO_REG_DEVREV));
1667 exit:
1668 superio_exit(sioaddr);
1669 return err;
1670 }
1671
1672 static int __init f71882fg_device_add(unsigned short address,
1673 const struct f71882fg_sio_data *sio_data)
1674 {
1675 struct resource res = {
1676 .start = address,
1677 .end = address + REGION_LENGTH - 1,
1678 .flags = IORESOURCE_IO,
1679 };
1680 int err;
1681
1682 f71882fg_pdev = platform_device_alloc(DRVNAME, address);
1683 if (!f71882fg_pdev)
1684 return -ENOMEM;
1685
1686 res.name = f71882fg_pdev->name;
1687 err = platform_device_add_resources(f71882fg_pdev, &res, 1);
1688 if (err) {
1689 printk(KERN_ERR DRVNAME ": Device resource addition failed\n");
1690 goto exit_device_put;
1691 }
1692
1693 err = platform_device_add_data(f71882fg_pdev, sio_data,
1694 sizeof(struct f71882fg_sio_data));
1695 if (err) {
1696 printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
1697 goto exit_device_put;
1698 }
1699
1700 err = platform_device_add(f71882fg_pdev);
1701 if (err) {
1702 printk(KERN_ERR DRVNAME ": Device addition failed\n");
1703 goto exit_device_put;
1704 }
1705
1706 return 0;
1707
1708 exit_device_put:
1709 platform_device_put(f71882fg_pdev);
1710
1711 return err;
1712 }
1713
1714 static int __init f71882fg_init(void)
1715 {
1716 int err = -ENODEV;
1717 unsigned short address;
1718 struct f71882fg_sio_data sio_data;
1719
1720 memset(&sio_data, 0, sizeof(sio_data));
1721
1722 if (f71882fg_find(0x2e, &address, &sio_data) &&
1723 f71882fg_find(0x4e, &address, &sio_data))
1724 goto exit;
1725
1726 err = platform_driver_register(&f71882fg_driver);
1727 if (err)
1728 goto exit;
1729
1730 err = f71882fg_device_add(address, &sio_data);
1731 if (err)
1732 goto exit_driver;
1733
1734 return 0;
1735
1736 exit_driver:
1737 platform_driver_unregister(&f71882fg_driver);
1738 exit:
1739 return err;
1740 }
1741
1742 static void __exit f71882fg_exit(void)
1743 {
1744 platform_device_unregister(f71882fg_pdev);
1745 platform_driver_unregister(&f71882fg_driver);
1746 }
1747
1748 MODULE_DESCRIPTION("F71882FG Hardware Monitoring Driver");
1749 MODULE_AUTHOR("Hans Edgington, Hans de Goede (hdegoede@redhat.com)");
1750 MODULE_LICENSE("GPL");
1751
1752 module_init(f71882fg_init);
1753 module_exit(f71882fg_exit);
Linus' kernel tree