xref: /openbmc/linux/drivers/hwmon/fschmd.c (revision 2504075d)
1 /* fschmd.c
2  *
3  * Copyright (C) 2007 - 2009 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 Free Software
17  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
18  */
19 
20 /*
21  *  Merged Fujitsu Siemens hwmon driver, supporting the Poseidon, Hermes,
22  *  Scylla, Heracles, Heimdall, Hades and Syleus chips
23  *
24  *  Based on the original 2.4 fscscy, 2.6 fscpos, 2.6 fscher and 2.6
25  *  (candidate) fschmd drivers:
26  *  Copyright (C) 2006 Thilo Cestonaro
27  *			<thilo.cestonaro.external@fujitsu-siemens.com>
28  *  Copyright (C) 2004, 2005 Stefan Ott <stefan@desire.ch>
29  *  Copyright (C) 2003, 2004 Reinhard Nissl <rnissl@gmx.de>
30  *  Copyright (c) 2001 Martin Knoblauch <mkn@teraport.de, knobi@knobisoft.de>
31  *  Copyright (C) 2000 Hermann Jung <hej@odn.de>
32  */
33 
34 #include <linux/module.h>
35 #include <linux/init.h>
36 #include <linux/slab.h>
37 #include <linux/jiffies.h>
38 #include <linux/i2c.h>
39 #include <linux/hwmon.h>
40 #include <linux/hwmon-sysfs.h>
41 #include <linux/err.h>
42 #include <linux/mutex.h>
43 #include <linux/sysfs.h>
44 #include <linux/dmi.h>
45 #include <linux/fs.h>
46 #include <linux/watchdog.h>
47 #include <linux/miscdevice.h>
48 #include <linux/uaccess.h>
49 #include <linux/kref.h>
50 
51 /* Addresses to scan */
52 static DEFINE_MUTEX(watchdog_mutex);
53 static const unsigned short normal_i2c[] = { 0x73, I2C_CLIENT_END };
54 
55 /* Insmod parameters */
56 static int nowayout = WATCHDOG_NOWAYOUT;
57 module_param(nowayout, int, 0);
58 MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default="
59 	__MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
60 
61 enum chips { fscpos, fscher, fscscy, fschrc, fschmd, fschds, fscsyl };
62 
63 /*
64  * The FSCHMD registers and other defines
65  */
66 
67 /* chip identification */
68 #define FSCHMD_REG_IDENT_0		0x00
69 #define FSCHMD_REG_IDENT_1		0x01
70 #define FSCHMD_REG_IDENT_2		0x02
71 #define FSCHMD_REG_REVISION		0x03
72 
73 /* global control and status */
74 #define FSCHMD_REG_EVENT_STATE		0x04
75 #define FSCHMD_REG_CONTROL		0x05
76 
77 #define FSCHMD_CONTROL_ALERT_LED	0x01
78 
79 /* watchdog */
80 static const u8 FSCHMD_REG_WDOG_CONTROL[7] =
81 	{ 0x21, 0x21, 0x21, 0x21, 0x21, 0x28, 0x28 };
82 static const u8 FSCHMD_REG_WDOG_STATE[7] =
83 	{ 0x23, 0x23, 0x23, 0x23, 0x23, 0x29, 0x29 };
84 static const u8 FSCHMD_REG_WDOG_PRESET[7] =
85 	{ 0x28, 0x28, 0x28, 0x28, 0x28, 0x2a, 0x2a };
86 
87 #define FSCHMD_WDOG_CONTROL_TRIGGER	0x10
88 #define FSCHMD_WDOG_CONTROL_STARTED	0x10 /* the same as trigger */
89 #define FSCHMD_WDOG_CONTROL_STOP	0x20
90 #define FSCHMD_WDOG_CONTROL_RESOLUTION	0x40
91 
92 #define FSCHMD_WDOG_STATE_CARDRESET	0x02
93 
94 /* voltages, weird order is to keep the same order as the old drivers */
95 static const u8 FSCHMD_REG_VOLT[7][6] = {
96 	{ 0x45, 0x42, 0x48 },				/* pos */
97 	{ 0x45, 0x42, 0x48 },				/* her */
98 	{ 0x45, 0x42, 0x48 },				/* scy */
99 	{ 0x45, 0x42, 0x48 },				/* hrc */
100 	{ 0x45, 0x42, 0x48 },				/* hmd */
101 	{ 0x21, 0x20, 0x22 },				/* hds */
102 	{ 0x21, 0x20, 0x22, 0x23, 0x24, 0x25 },		/* syl */
103 };
104 
105 static const int FSCHMD_NO_VOLT_SENSORS[7] = { 3, 3, 3, 3, 3, 3, 6 };
106 
107 /* minimum pwm at which the fan is driven (pwm can by increased depending on
108    the temp. Notice that for the scy some fans share there minimum speed.
109    Also notice that with the scy the sensor order is different than with the
110    other chips, this order was in the 2.4 driver and kept for consistency. */
111 static const u8 FSCHMD_REG_FAN_MIN[7][7] = {
112 	{ 0x55, 0x65 },					/* pos */
113 	{ 0x55, 0x65, 0xb5 },				/* her */
114 	{ 0x65, 0x65, 0x55, 0xa5, 0x55, 0xa5 },		/* scy */
115 	{ 0x55, 0x65, 0xa5, 0xb5 },			/* hrc */
116 	{ 0x55, 0x65, 0xa5, 0xb5, 0xc5 },		/* hmd */
117 	{ 0x55, 0x65, 0xa5, 0xb5, 0xc5 },		/* hds */
118 	{ 0x54, 0x64, 0x74, 0x84, 0x94, 0xa4, 0xb4 },	/* syl */
119 };
120 
121 /* actual fan speed */
122 static const u8 FSCHMD_REG_FAN_ACT[7][7] = {
123 	{ 0x0e, 0x6b, 0xab },				/* pos */
124 	{ 0x0e, 0x6b, 0xbb },				/* her */
125 	{ 0x6b, 0x6c, 0x0e, 0xab, 0x5c, 0xbb },		/* scy */
126 	{ 0x0e, 0x6b, 0xab, 0xbb },			/* hrc */
127 	{ 0x5b, 0x6b, 0xab, 0xbb, 0xcb },		/* hmd */
128 	{ 0x5b, 0x6b, 0xab, 0xbb, 0xcb },		/* hds */
129 	{ 0x57, 0x67, 0x77, 0x87, 0x97, 0xa7, 0xb7 },	/* syl */
130 };
131 
132 /* fan status registers */
133 static const u8 FSCHMD_REG_FAN_STATE[7][7] = {
134 	{ 0x0d, 0x62, 0xa2 },				/* pos */
135 	{ 0x0d, 0x62, 0xb2 },				/* her */
136 	{ 0x62, 0x61, 0x0d, 0xa2, 0x52, 0xb2 },		/* scy */
137 	{ 0x0d, 0x62, 0xa2, 0xb2 },			/* hrc */
138 	{ 0x52, 0x62, 0xa2, 0xb2, 0xc2 },		/* hmd */
139 	{ 0x52, 0x62, 0xa2, 0xb2, 0xc2 },		/* hds */
140 	{ 0x50, 0x60, 0x70, 0x80, 0x90, 0xa0, 0xb0 },	/* syl */
141 };
142 
143 /* fan ripple / divider registers */
144 static const u8 FSCHMD_REG_FAN_RIPPLE[7][7] = {
145 	{ 0x0f, 0x6f, 0xaf },				/* pos */
146 	{ 0x0f, 0x6f, 0xbf },				/* her */
147 	{ 0x6f, 0x6f, 0x0f, 0xaf, 0x0f, 0xbf },		/* scy */
148 	{ 0x0f, 0x6f, 0xaf, 0xbf },			/* hrc */
149 	{ 0x5f, 0x6f, 0xaf, 0xbf, 0xcf },		/* hmd */
150 	{ 0x5f, 0x6f, 0xaf, 0xbf, 0xcf },		/* hds */
151 	{ 0x56, 0x66, 0x76, 0x86, 0x96, 0xa6, 0xb6 },	/* syl */
152 };
153 
154 static const int FSCHMD_NO_FAN_SENSORS[7] = { 3, 3, 6, 4, 5, 5, 7 };
155 
156 /* Fan status register bitmasks */
157 #define FSCHMD_FAN_ALARM	0x04 /* called fault by FSC! */
158 #define FSCHMD_FAN_NOT_PRESENT	0x08
159 #define FSCHMD_FAN_DISABLED	0x80
160 
161 
162 /* actual temperature registers */
163 static const u8 FSCHMD_REG_TEMP_ACT[7][11] = {
164 	{ 0x64, 0x32, 0x35 },				/* pos */
165 	{ 0x64, 0x32, 0x35 },				/* her */
166 	{ 0x64, 0xD0, 0x32, 0x35 },			/* scy */
167 	{ 0x64, 0x32, 0x35 },				/* hrc */
168 	{ 0x70, 0x80, 0x90, 0xd0, 0xe0 },		/* hmd */
169 	{ 0x70, 0x80, 0x90, 0xd0, 0xe0 },		/* hds */
170 	{ 0x58, 0x68, 0x78, 0x88, 0x98, 0xa8,		/* syl */
171 	  0xb8, 0xc8, 0xd8, 0xe8, 0xf8 },
172 };
173 
174 /* temperature state registers */
175 static const u8 FSCHMD_REG_TEMP_STATE[7][11] = {
176 	{ 0x71, 0x81, 0x91 },				/* pos */
177 	{ 0x71, 0x81, 0x91 },				/* her */
178 	{ 0x71, 0xd1, 0x81, 0x91 },			/* scy */
179 	{ 0x71, 0x81, 0x91 },				/* hrc */
180 	{ 0x71, 0x81, 0x91, 0xd1, 0xe1 },		/* hmd */
181 	{ 0x71, 0x81, 0x91, 0xd1, 0xe1 },		/* hds */
182 	{ 0x59, 0x69, 0x79, 0x89, 0x99, 0xa9,		/* syl */
183 	  0xb9, 0xc9, 0xd9, 0xe9, 0xf9 },
184 };
185 
186 /* temperature high limit registers, FSC does not document these. Proven to be
187    there with field testing on the fscher and fschrc, already supported / used
188    in the fscscy 2.4 driver. FSC has confirmed that the fschmd has registers
189    at these addresses, but doesn't want to confirm they are the same as with
190    the fscher?? */
191 static const u8 FSCHMD_REG_TEMP_LIMIT[7][11] = {
192 	{ 0, 0, 0 },					/* pos */
193 	{ 0x76, 0x86, 0x96 },				/* her */
194 	{ 0x76, 0xd6, 0x86, 0x96 },			/* scy */
195 	{ 0x76, 0x86, 0x96 },				/* hrc */
196 	{ 0x76, 0x86, 0x96, 0xd6, 0xe6 },		/* hmd */
197 	{ 0x76, 0x86, 0x96, 0xd6, 0xe6 },		/* hds */
198 	{ 0x5a, 0x6a, 0x7a, 0x8a, 0x9a, 0xaa,		/* syl */
199 	  0xba, 0xca, 0xda, 0xea, 0xfa },
200 };
201 
202 /* These were found through experimenting with an fscher, currently they are
203    not used, but we keep them around for future reference.
204    On the fscsyl AUTOP1 lives at 0x#c (so 0x5c for fan1, 0x6c for fan2, etc),
205    AUTOP2 lives at 0x#e, and 0x#1 is a bitmask defining which temps influence
206    the fan speed.
207 static const u8 FSCHER_REG_TEMP_AUTOP1[] =	{ 0x73, 0x83, 0x93 };
208 static const u8 FSCHER_REG_TEMP_AUTOP2[] =	{ 0x75, 0x85, 0x95 }; */
209 
210 static const int FSCHMD_NO_TEMP_SENSORS[7] = { 3, 3, 4, 3, 5, 5, 11 };
211 
212 /* temp status register bitmasks */
213 #define FSCHMD_TEMP_WORKING	0x01
214 #define FSCHMD_TEMP_ALERT	0x02
215 #define FSCHMD_TEMP_DISABLED	0x80
216 /* there only really is an alarm if the sensor is working and alert == 1 */
217 #define FSCHMD_TEMP_ALARM_MASK \
218 	(FSCHMD_TEMP_WORKING | FSCHMD_TEMP_ALERT)
219 
220 /*
221  * Functions declarations
222  */
223 
224 static int fschmd_probe(struct i2c_client *client,
225 			const struct i2c_device_id *id);
226 static int fschmd_detect(struct i2c_client *client,
227 			 struct i2c_board_info *info);
228 static int fschmd_remove(struct i2c_client *client);
229 static struct fschmd_data *fschmd_update_device(struct device *dev);
230 
231 /*
232  * Driver data (common to all clients)
233  */
234 
235 static const struct i2c_device_id fschmd_id[] = {
236 	{ "fscpos", fscpos },
237 	{ "fscher", fscher },
238 	{ "fscscy", fscscy },
239 	{ "fschrc", fschrc },
240 	{ "fschmd", fschmd },
241 	{ "fschds", fschds },
242 	{ "fscsyl", fscsyl },
243 	{ }
244 };
245 MODULE_DEVICE_TABLE(i2c, fschmd_id);
246 
247 static struct i2c_driver fschmd_driver = {
248 	.class		= I2C_CLASS_HWMON,
249 	.driver = {
250 		.name	= "fschmd",
251 	},
252 	.probe		= fschmd_probe,
253 	.remove		= fschmd_remove,
254 	.id_table	= fschmd_id,
255 	.detect		= fschmd_detect,
256 	.address_list	= normal_i2c,
257 };
258 
259 /*
260  * Client data (each client gets its own)
261  */
262 
263 struct fschmd_data {
264 	struct i2c_client *client;
265 	struct device *hwmon_dev;
266 	struct mutex update_lock;
267 	struct mutex watchdog_lock;
268 	struct list_head list; /* member of the watchdog_data_list */
269 	struct kref kref;
270 	struct miscdevice watchdog_miscdev;
271 	enum chips kind;
272 	unsigned long watchdog_is_open;
273 	char watchdog_expect_close;
274 	char watchdog_name[10]; /* must be unique to avoid sysfs conflict */
275 	char valid; /* zero until following fields are valid */
276 	unsigned long last_updated; /* in jiffies */
277 
278 	/* register values */
279 	u8 revision;            /* chip revision */
280 	u8 global_control;	/* global control register */
281 	u8 watchdog_control;    /* watchdog control register */
282 	u8 watchdog_state;      /* watchdog status register */
283 	u8 watchdog_preset;     /* watchdog counter preset on trigger val */
284 	u8 volt[6];		/* voltage */
285 	u8 temp_act[11];	/* temperature */
286 	u8 temp_status[11];	/* status of sensor */
287 	u8 temp_max[11];	/* high temp limit, notice: undocumented! */
288 	u8 fan_act[7];		/* fans revolutions per second */
289 	u8 fan_status[7];	/* fan status */
290 	u8 fan_min[7];		/* fan min value for rps */
291 	u8 fan_ripple[7];	/* divider for rps */
292 };
293 
294 /* Global variables to hold information read from special DMI tables, which are
295    available on FSC machines with an fscher or later chip. There is no need to
296    protect these with a lock as they are only modified from our attach function
297    which always gets called with the i2c-core lock held and never accessed
298    before the attach function is done with them. */
299 static int dmi_mult[6] = { 490, 200, 100, 100, 200, 100 };
300 static int dmi_offset[6] = { 0, 0, 0, 0, 0, 0 };
301 static int dmi_vref = -1;
302 
303 /* Somewhat ugly :( global data pointer list with all fschmd devices, so that
304    we can find our device data as when using misc_register there is no other
305    method to get to ones device data from the open fop. */
306 static LIST_HEAD(watchdog_data_list);
307 /* Note this lock not only protect list access, but also data.kref access */
308 static DEFINE_MUTEX(watchdog_data_mutex);
309 
310 /* Release our data struct when we're detached from the i2c client *and* all
311    references to our watchdog device are released */
312 static void fschmd_release_resources(struct kref *ref)
313 {
314 	struct fschmd_data *data = container_of(ref, struct fschmd_data, kref);
315 	kfree(data);
316 }
317 
318 /*
319  * Sysfs attr show / store functions
320  */
321 
322 static ssize_t show_in_value(struct device *dev,
323 	struct device_attribute *devattr, char *buf)
324 {
325 	const int max_reading[3] = { 14200, 6600, 3300 };
326 	int index = to_sensor_dev_attr(devattr)->index;
327 	struct fschmd_data *data = fschmd_update_device(dev);
328 
329 	if (data->kind == fscher || data->kind >= fschrc)
330 		return sprintf(buf, "%d\n", (data->volt[index] * dmi_vref *
331 			dmi_mult[index]) / 255 + dmi_offset[index]);
332 	else
333 		return sprintf(buf, "%d\n", (data->volt[index] *
334 			max_reading[index] + 128) / 255);
335 }
336 
337 
338 #define TEMP_FROM_REG(val)	(((val) - 128) * 1000)
339 
340 static ssize_t show_temp_value(struct device *dev,
341 	struct device_attribute *devattr, char *buf)
342 {
343 	int index = to_sensor_dev_attr(devattr)->index;
344 	struct fschmd_data *data = fschmd_update_device(dev);
345 
346 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_act[index]));
347 }
348 
349 static ssize_t show_temp_max(struct device *dev,
350 	struct device_attribute *devattr, char *buf)
351 {
352 	int index = to_sensor_dev_attr(devattr)->index;
353 	struct fschmd_data *data = fschmd_update_device(dev);
354 
355 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[index]));
356 }
357 
358 static ssize_t store_temp_max(struct device *dev, struct device_attribute
359 	*devattr, const char *buf, size_t count)
360 {
361 	int index = to_sensor_dev_attr(devattr)->index;
362 	struct fschmd_data *data = dev_get_drvdata(dev);
363 	long v = simple_strtol(buf, NULL, 10) / 1000;
364 
365 	v = SENSORS_LIMIT(v, -128, 127) + 128;
366 
367 	mutex_lock(&data->update_lock);
368 	i2c_smbus_write_byte_data(to_i2c_client(dev),
369 		FSCHMD_REG_TEMP_LIMIT[data->kind][index], v);
370 	data->temp_max[index] = v;
371 	mutex_unlock(&data->update_lock);
372 
373 	return count;
374 }
375 
376 static ssize_t show_temp_fault(struct device *dev,
377 	struct device_attribute *devattr, char *buf)
378 {
379 	int index = to_sensor_dev_attr(devattr)->index;
380 	struct fschmd_data *data = fschmd_update_device(dev);
381 
382 	/* bit 0 set means sensor working ok, so no fault! */
383 	if (data->temp_status[index] & FSCHMD_TEMP_WORKING)
384 		return sprintf(buf, "0\n");
385 	else
386 		return sprintf(buf, "1\n");
387 }
388 
389 static ssize_t show_temp_alarm(struct device *dev,
390 	struct device_attribute *devattr, char *buf)
391 {
392 	int index = to_sensor_dev_attr(devattr)->index;
393 	struct fschmd_data *data = fschmd_update_device(dev);
394 
395 	if ((data->temp_status[index] & FSCHMD_TEMP_ALARM_MASK) ==
396 			FSCHMD_TEMP_ALARM_MASK)
397 		return sprintf(buf, "1\n");
398 	else
399 		return sprintf(buf, "0\n");
400 }
401 
402 
403 #define RPM_FROM_REG(val)	((val) * 60)
404 
405 static ssize_t show_fan_value(struct device *dev,
406 	struct device_attribute *devattr, char *buf)
407 {
408 	int index = to_sensor_dev_attr(devattr)->index;
409 	struct fschmd_data *data = fschmd_update_device(dev);
410 
411 	return sprintf(buf, "%u\n", RPM_FROM_REG(data->fan_act[index]));
412 }
413 
414 static ssize_t show_fan_div(struct device *dev,
415 	struct device_attribute *devattr, char *buf)
416 {
417 	int index = to_sensor_dev_attr(devattr)->index;
418 	struct fschmd_data *data = fschmd_update_device(dev);
419 
420 	/* bits 2..7 reserved => mask with 3 */
421 	return sprintf(buf, "%d\n", 1 << (data->fan_ripple[index] & 3));
422 }
423 
424 static ssize_t store_fan_div(struct device *dev, struct device_attribute
425 	*devattr, const char *buf, size_t count)
426 {
427 	u8 reg;
428 	int index = to_sensor_dev_attr(devattr)->index;
429 	struct fschmd_data *data = dev_get_drvdata(dev);
430 	/* supported values: 2, 4, 8 */
431 	unsigned long v = simple_strtoul(buf, NULL, 10);
432 
433 	switch (v) {
434 	case 2: v = 1; break;
435 	case 4: v = 2; break;
436 	case 8: v = 3; break;
437 	default:
438 		dev_err(dev, "fan_div value %lu not supported. "
439 			"Choose one of 2, 4 or 8!\n", v);
440 		return -EINVAL;
441 	}
442 
443 	mutex_lock(&data->update_lock);
444 
445 	reg = i2c_smbus_read_byte_data(to_i2c_client(dev),
446 		FSCHMD_REG_FAN_RIPPLE[data->kind][index]);
447 
448 	/* bits 2..7 reserved => mask with 0x03 */
449 	reg &= ~0x03;
450 	reg |= v;
451 
452 	i2c_smbus_write_byte_data(to_i2c_client(dev),
453 		FSCHMD_REG_FAN_RIPPLE[data->kind][index], reg);
454 
455 	data->fan_ripple[index] = reg;
456 
457 	mutex_unlock(&data->update_lock);
458 
459 	return count;
460 }
461 
462 static ssize_t show_fan_alarm(struct device *dev,
463 	struct device_attribute *devattr, char *buf)
464 {
465 	int index = to_sensor_dev_attr(devattr)->index;
466 	struct fschmd_data *data = fschmd_update_device(dev);
467 
468 	if (data->fan_status[index] & FSCHMD_FAN_ALARM)
469 		return sprintf(buf, "1\n");
470 	else
471 		return sprintf(buf, "0\n");
472 }
473 
474 static ssize_t show_fan_fault(struct device *dev,
475 	struct device_attribute *devattr, char *buf)
476 {
477 	int index = to_sensor_dev_attr(devattr)->index;
478 	struct fschmd_data *data = fschmd_update_device(dev);
479 
480 	if (data->fan_status[index] & FSCHMD_FAN_NOT_PRESENT)
481 		return sprintf(buf, "1\n");
482 	else
483 		return sprintf(buf, "0\n");
484 }
485 
486 
487 static ssize_t show_pwm_auto_point1_pwm(struct device *dev,
488 	struct device_attribute *devattr, char *buf)
489 {
490 	int index = to_sensor_dev_attr(devattr)->index;
491 	struct fschmd_data *data = fschmd_update_device(dev);
492 	int val = data->fan_min[index];
493 
494 	/* 0 = allow turning off (except on the syl), 1-255 = 50-100% */
495 	if (val || data->kind == fscsyl)
496 		val = val / 2 + 128;
497 
498 	return sprintf(buf, "%d\n", val);
499 }
500 
501 static ssize_t store_pwm_auto_point1_pwm(struct device *dev,
502 	struct device_attribute *devattr, const char *buf, size_t count)
503 {
504 	int index = to_sensor_dev_attr(devattr)->index;
505 	struct fschmd_data *data = dev_get_drvdata(dev);
506 	unsigned long v = simple_strtoul(buf, NULL, 10);
507 
508 	/* reg: 0 = allow turning off (except on the syl), 1-255 = 50-100% */
509 	if (v || data->kind == fscsyl) {
510 		v = SENSORS_LIMIT(v, 128, 255);
511 		v = (v - 128) * 2 + 1;
512 	}
513 
514 	mutex_lock(&data->update_lock);
515 
516 	i2c_smbus_write_byte_data(to_i2c_client(dev),
517 		FSCHMD_REG_FAN_MIN[data->kind][index], v);
518 	data->fan_min[index] = v;
519 
520 	mutex_unlock(&data->update_lock);
521 
522 	return count;
523 }
524 
525 
526 /* The FSC hwmon family has the ability to force an attached alert led to flash
527    from software, we export this as an alert_led sysfs attr */
528 static ssize_t show_alert_led(struct device *dev,
529 	struct device_attribute *devattr, char *buf)
530 {
531 	struct fschmd_data *data = fschmd_update_device(dev);
532 
533 	if (data->global_control & FSCHMD_CONTROL_ALERT_LED)
534 		return sprintf(buf, "1\n");
535 	else
536 		return sprintf(buf, "0\n");
537 }
538 
539 static ssize_t store_alert_led(struct device *dev,
540 	struct device_attribute *devattr, const char *buf, size_t count)
541 {
542 	u8 reg;
543 	struct fschmd_data *data = dev_get_drvdata(dev);
544 	unsigned long v = simple_strtoul(buf, NULL, 10);
545 
546 	mutex_lock(&data->update_lock);
547 
548 	reg = i2c_smbus_read_byte_data(to_i2c_client(dev), FSCHMD_REG_CONTROL);
549 
550 	if (v)
551 		reg |= FSCHMD_CONTROL_ALERT_LED;
552 	else
553 		reg &= ~FSCHMD_CONTROL_ALERT_LED;
554 
555 	i2c_smbus_write_byte_data(to_i2c_client(dev), FSCHMD_REG_CONTROL, reg);
556 
557 	data->global_control = reg;
558 
559 	mutex_unlock(&data->update_lock);
560 
561 	return count;
562 }
563 
564 static DEVICE_ATTR(alert_led, 0644, show_alert_led, store_alert_led);
565 
566 static struct sensor_device_attribute fschmd_attr[] = {
567 	SENSOR_ATTR(in0_input, 0444, show_in_value, NULL, 0),
568 	SENSOR_ATTR(in1_input, 0444, show_in_value, NULL, 1),
569 	SENSOR_ATTR(in2_input, 0444, show_in_value, NULL, 2),
570 	SENSOR_ATTR(in3_input, 0444, show_in_value, NULL, 3),
571 	SENSOR_ATTR(in4_input, 0444, show_in_value, NULL, 4),
572 	SENSOR_ATTR(in5_input, 0444, show_in_value, NULL, 5),
573 };
574 
575 static struct sensor_device_attribute fschmd_temp_attr[] = {
576 	SENSOR_ATTR(temp1_input, 0444, show_temp_value, NULL, 0),
577 	SENSOR_ATTR(temp1_max,   0644, show_temp_max, store_temp_max, 0),
578 	SENSOR_ATTR(temp1_fault, 0444, show_temp_fault, NULL, 0),
579 	SENSOR_ATTR(temp1_alarm, 0444, show_temp_alarm, NULL, 0),
580 	SENSOR_ATTR(temp2_input, 0444, show_temp_value, NULL, 1),
581 	SENSOR_ATTR(temp2_max,   0644, show_temp_max, store_temp_max, 1),
582 	SENSOR_ATTR(temp2_fault, 0444, show_temp_fault, NULL, 1),
583 	SENSOR_ATTR(temp2_alarm, 0444, show_temp_alarm, NULL, 1),
584 	SENSOR_ATTR(temp3_input, 0444, show_temp_value, NULL, 2),
585 	SENSOR_ATTR(temp3_max,   0644, show_temp_max, store_temp_max, 2),
586 	SENSOR_ATTR(temp3_fault, 0444, show_temp_fault, NULL, 2),
587 	SENSOR_ATTR(temp3_alarm, 0444, show_temp_alarm, NULL, 2),
588 	SENSOR_ATTR(temp4_input, 0444, show_temp_value, NULL, 3),
589 	SENSOR_ATTR(temp4_max,   0644, show_temp_max, store_temp_max, 3),
590 	SENSOR_ATTR(temp4_fault, 0444, show_temp_fault, NULL, 3),
591 	SENSOR_ATTR(temp4_alarm, 0444, show_temp_alarm, NULL, 3),
592 	SENSOR_ATTR(temp5_input, 0444, show_temp_value, NULL, 4),
593 	SENSOR_ATTR(temp5_max,   0644, show_temp_max, store_temp_max, 4),
594 	SENSOR_ATTR(temp5_fault, 0444, show_temp_fault, NULL, 4),
595 	SENSOR_ATTR(temp5_alarm, 0444, show_temp_alarm, NULL, 4),
596 	SENSOR_ATTR(temp6_input, 0444, show_temp_value, NULL, 5),
597 	SENSOR_ATTR(temp6_max,   0644, show_temp_max, store_temp_max, 5),
598 	SENSOR_ATTR(temp6_fault, 0444, show_temp_fault, NULL, 5),
599 	SENSOR_ATTR(temp6_alarm, 0444, show_temp_alarm, NULL, 5),
600 	SENSOR_ATTR(temp7_input, 0444, show_temp_value, NULL, 6),
601 	SENSOR_ATTR(temp7_max,   0644, show_temp_max, store_temp_max, 6),
602 	SENSOR_ATTR(temp7_fault, 0444, show_temp_fault, NULL, 6),
603 	SENSOR_ATTR(temp7_alarm, 0444, show_temp_alarm, NULL, 6),
604 	SENSOR_ATTR(temp8_input, 0444, show_temp_value, NULL, 7),
605 	SENSOR_ATTR(temp8_max,   0644, show_temp_max, store_temp_max, 7),
606 	SENSOR_ATTR(temp8_fault, 0444, show_temp_fault, NULL, 7),
607 	SENSOR_ATTR(temp8_alarm, 0444, show_temp_alarm, NULL, 7),
608 	SENSOR_ATTR(temp9_input, 0444, show_temp_value, NULL, 8),
609 	SENSOR_ATTR(temp9_max,   0644, show_temp_max, store_temp_max, 8),
610 	SENSOR_ATTR(temp9_fault, 0444, show_temp_fault, NULL, 8),
611 	SENSOR_ATTR(temp9_alarm, 0444, show_temp_alarm, NULL, 8),
612 	SENSOR_ATTR(temp10_input, 0444, show_temp_value, NULL, 9),
613 	SENSOR_ATTR(temp10_max,   0644, show_temp_max, store_temp_max, 9),
614 	SENSOR_ATTR(temp10_fault, 0444, show_temp_fault, NULL, 9),
615 	SENSOR_ATTR(temp10_alarm, 0444, show_temp_alarm, NULL, 9),
616 	SENSOR_ATTR(temp11_input, 0444, show_temp_value, NULL, 10),
617 	SENSOR_ATTR(temp11_max,   0644, show_temp_max, store_temp_max, 10),
618 	SENSOR_ATTR(temp11_fault, 0444, show_temp_fault, NULL, 10),
619 	SENSOR_ATTR(temp11_alarm, 0444, show_temp_alarm, NULL, 10),
620 };
621 
622 static struct sensor_device_attribute fschmd_fan_attr[] = {
623 	SENSOR_ATTR(fan1_input, 0444, show_fan_value, NULL, 0),
624 	SENSOR_ATTR(fan1_div,   0644, show_fan_div, store_fan_div, 0),
625 	SENSOR_ATTR(fan1_alarm, 0444, show_fan_alarm, NULL, 0),
626 	SENSOR_ATTR(fan1_fault, 0444, show_fan_fault, NULL, 0),
627 	SENSOR_ATTR(pwm1_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
628 		store_pwm_auto_point1_pwm, 0),
629 	SENSOR_ATTR(fan2_input, 0444, show_fan_value, NULL, 1),
630 	SENSOR_ATTR(fan2_div,   0644, show_fan_div, store_fan_div, 1),
631 	SENSOR_ATTR(fan2_alarm, 0444, show_fan_alarm, NULL, 1),
632 	SENSOR_ATTR(fan2_fault, 0444, show_fan_fault, NULL, 1),
633 	SENSOR_ATTR(pwm2_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
634 		store_pwm_auto_point1_pwm, 1),
635 	SENSOR_ATTR(fan3_input, 0444, show_fan_value, NULL, 2),
636 	SENSOR_ATTR(fan3_div,   0644, show_fan_div, store_fan_div, 2),
637 	SENSOR_ATTR(fan3_alarm, 0444, show_fan_alarm, NULL, 2),
638 	SENSOR_ATTR(fan3_fault, 0444, show_fan_fault, NULL, 2),
639 	SENSOR_ATTR(pwm3_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
640 		store_pwm_auto_point1_pwm, 2),
641 	SENSOR_ATTR(fan4_input, 0444, show_fan_value, NULL, 3),
642 	SENSOR_ATTR(fan4_div,   0644, show_fan_div, store_fan_div, 3),
643 	SENSOR_ATTR(fan4_alarm, 0444, show_fan_alarm, NULL, 3),
644 	SENSOR_ATTR(fan4_fault, 0444, show_fan_fault, NULL, 3),
645 	SENSOR_ATTR(pwm4_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
646 		store_pwm_auto_point1_pwm, 3),
647 	SENSOR_ATTR(fan5_input, 0444, show_fan_value, NULL, 4),
648 	SENSOR_ATTR(fan5_div,   0644, show_fan_div, store_fan_div, 4),
649 	SENSOR_ATTR(fan5_alarm, 0444, show_fan_alarm, NULL, 4),
650 	SENSOR_ATTR(fan5_fault, 0444, show_fan_fault, NULL, 4),
651 	SENSOR_ATTR(pwm5_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
652 		store_pwm_auto_point1_pwm, 4),
653 	SENSOR_ATTR(fan6_input, 0444, show_fan_value, NULL, 5),
654 	SENSOR_ATTR(fan6_div,   0644, show_fan_div, store_fan_div, 5),
655 	SENSOR_ATTR(fan6_alarm, 0444, show_fan_alarm, NULL, 5),
656 	SENSOR_ATTR(fan6_fault, 0444, show_fan_fault, NULL, 5),
657 	SENSOR_ATTR(pwm6_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
658 		store_pwm_auto_point1_pwm, 5),
659 	SENSOR_ATTR(fan7_input, 0444, show_fan_value, NULL, 6),
660 	SENSOR_ATTR(fan7_div,   0644, show_fan_div, store_fan_div, 6),
661 	SENSOR_ATTR(fan7_alarm, 0444, show_fan_alarm, NULL, 6),
662 	SENSOR_ATTR(fan7_fault, 0444, show_fan_fault, NULL, 6),
663 	SENSOR_ATTR(pwm7_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
664 		store_pwm_auto_point1_pwm, 6),
665 };
666 
667 
668 /*
669  * Watchdog routines
670  */
671 
672 static int watchdog_set_timeout(struct fschmd_data *data, int timeout)
673 {
674 	int ret, resolution;
675 	int kind = data->kind + 1; /* 0-x array index -> 1-x module param */
676 
677 	/* 2 second or 60 second resolution? */
678 	if (timeout <= 510 || kind == fscpos || kind == fscscy)
679 		resolution = 2;
680 	else
681 		resolution = 60;
682 
683 	if (timeout < resolution || timeout > (resolution * 255))
684 		return -EINVAL;
685 
686 	mutex_lock(&data->watchdog_lock);
687 	if (!data->client) {
688 		ret = -ENODEV;
689 		goto leave;
690 	}
691 
692 	if (resolution == 2)
693 		data->watchdog_control &= ~FSCHMD_WDOG_CONTROL_RESOLUTION;
694 	else
695 		data->watchdog_control |= FSCHMD_WDOG_CONTROL_RESOLUTION;
696 
697 	data->watchdog_preset = DIV_ROUND_UP(timeout, resolution);
698 
699 	/* Write new timeout value */
700 	i2c_smbus_write_byte_data(data->client,
701 		FSCHMD_REG_WDOG_PRESET[data->kind], data->watchdog_preset);
702 	/* Write new control register, do not trigger! */
703 	i2c_smbus_write_byte_data(data->client,
704 		FSCHMD_REG_WDOG_CONTROL[data->kind],
705 		data->watchdog_control & ~FSCHMD_WDOG_CONTROL_TRIGGER);
706 
707 	ret = data->watchdog_preset * resolution;
708 
709 leave:
710 	mutex_unlock(&data->watchdog_lock);
711 	return ret;
712 }
713 
714 static int watchdog_get_timeout(struct fschmd_data *data)
715 {
716 	int timeout;
717 
718 	mutex_lock(&data->watchdog_lock);
719 	if (data->watchdog_control & FSCHMD_WDOG_CONTROL_RESOLUTION)
720 		timeout = data->watchdog_preset * 60;
721 	else
722 		timeout = data->watchdog_preset * 2;
723 	mutex_unlock(&data->watchdog_lock);
724 
725 	return timeout;
726 }
727 
728 static int watchdog_trigger(struct fschmd_data *data)
729 {
730 	int ret = 0;
731 
732 	mutex_lock(&data->watchdog_lock);
733 	if (!data->client) {
734 		ret = -ENODEV;
735 		goto leave;
736 	}
737 
738 	data->watchdog_control |= FSCHMD_WDOG_CONTROL_TRIGGER;
739 	i2c_smbus_write_byte_data(data->client,
740 				  FSCHMD_REG_WDOG_CONTROL[data->kind],
741 				  data->watchdog_control);
742 leave:
743 	mutex_unlock(&data->watchdog_lock);
744 	return ret;
745 }
746 
747 static int watchdog_stop(struct fschmd_data *data)
748 {
749 	int ret = 0;
750 
751 	mutex_lock(&data->watchdog_lock);
752 	if (!data->client) {
753 		ret = -ENODEV;
754 		goto leave;
755 	}
756 
757 	data->watchdog_control &= ~FSCHMD_WDOG_CONTROL_STARTED;
758 	/* Don't store the stop flag in our watchdog control register copy, as
759 	   its a write only bit (read always returns 0) */
760 	i2c_smbus_write_byte_data(data->client,
761 		FSCHMD_REG_WDOG_CONTROL[data->kind],
762 		data->watchdog_control | FSCHMD_WDOG_CONTROL_STOP);
763 leave:
764 	mutex_unlock(&data->watchdog_lock);
765 	return ret;
766 }
767 
768 static int watchdog_open(struct inode *inode, struct file *filp)
769 {
770 	struct fschmd_data *pos, *data = NULL;
771 	int watchdog_is_open;
772 
773 	/* We get called from drivers/char/misc.c with misc_mtx hold, and we
774 	   call misc_register() from fschmd_probe() with watchdog_data_mutex
775 	   hold, as misc_register() takes the misc_mtx lock, this is a possible
776 	   deadlock, so we use mutex_trylock here. */
777 	if (!mutex_trylock(&watchdog_data_mutex))
778 		return -ERESTARTSYS;
779 	list_for_each_entry(pos, &watchdog_data_list, list) {
780 		if (pos->watchdog_miscdev.minor == iminor(inode)) {
781 			data = pos;
782 			break;
783 		}
784 	}
785 	/* Note we can never not have found data, so we don't check for this */
786 	watchdog_is_open = test_and_set_bit(0, &data->watchdog_is_open);
787 	if (!watchdog_is_open)
788 		kref_get(&data->kref);
789 	mutex_unlock(&watchdog_data_mutex);
790 
791 	if (watchdog_is_open)
792 		return -EBUSY;
793 
794 	/* Start the watchdog */
795 	watchdog_trigger(data);
796 	filp->private_data = data;
797 
798 	return nonseekable_open(inode, filp);
799 }
800 
801 static int watchdog_release(struct inode *inode, struct file *filp)
802 {
803 	struct fschmd_data *data = filp->private_data;
804 
805 	if (data->watchdog_expect_close) {
806 		watchdog_stop(data);
807 		data->watchdog_expect_close = 0;
808 	} else {
809 		watchdog_trigger(data);
810 		dev_crit(&data->client->dev,
811 			"unexpected close, not stopping watchdog!\n");
812 	}
813 
814 	clear_bit(0, &data->watchdog_is_open);
815 
816 	mutex_lock(&watchdog_data_mutex);
817 	kref_put(&data->kref, fschmd_release_resources);
818 	mutex_unlock(&watchdog_data_mutex);
819 
820 	return 0;
821 }
822 
823 static ssize_t watchdog_write(struct file *filp, const char __user *buf,
824 	size_t count, loff_t *offset)
825 {
826 	int ret;
827 	struct fschmd_data *data = filp->private_data;
828 
829 	if (count) {
830 		if (!nowayout) {
831 			size_t i;
832 
833 			/* Clear it in case it was set with a previous write */
834 			data->watchdog_expect_close = 0;
835 
836 			for (i = 0; i != count; i++) {
837 				char c;
838 				if (get_user(c, buf + i))
839 					return -EFAULT;
840 				if (c == 'V')
841 					data->watchdog_expect_close = 1;
842 			}
843 		}
844 		ret = watchdog_trigger(data);
845 		if (ret < 0)
846 			return ret;
847 	}
848 	return count;
849 }
850 
851 static long watchdog_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
852 {
853 	static struct watchdog_info ident = {
854 		.options = WDIOF_KEEPALIVEPING | WDIOF_SETTIMEOUT |
855 				WDIOF_CARDRESET,
856 		.identity = "FSC watchdog"
857 	};
858 	int i, ret = 0;
859 	struct fschmd_data *data = filp->private_data;
860 
861 	mutex_lock(&watchdog_mutex);
862 	switch (cmd) {
863 	case WDIOC_GETSUPPORT:
864 		ident.firmware_version = data->revision;
865 		if (!nowayout)
866 			ident.options |= WDIOF_MAGICCLOSE;
867 		if (copy_to_user((void __user *)arg, &ident, sizeof(ident)))
868 			ret = -EFAULT;
869 		break;
870 
871 	case WDIOC_GETSTATUS:
872 		ret = put_user(0, (int __user *)arg);
873 		break;
874 
875 	case WDIOC_GETBOOTSTATUS:
876 		if (data->watchdog_state & FSCHMD_WDOG_STATE_CARDRESET)
877 			ret = put_user(WDIOF_CARDRESET, (int __user *)arg);
878 		else
879 			ret = put_user(0, (int __user *)arg);
880 		break;
881 
882 	case WDIOC_KEEPALIVE:
883 		ret = watchdog_trigger(data);
884 		break;
885 
886 	case WDIOC_GETTIMEOUT:
887 		i = watchdog_get_timeout(data);
888 		ret = put_user(i, (int __user *)arg);
889 		break;
890 
891 	case WDIOC_SETTIMEOUT:
892 		if (get_user(i, (int __user *)arg)) {
893 			ret = -EFAULT;
894 			break;
895 		}
896 		ret = watchdog_set_timeout(data, i);
897 		if (ret > 0)
898 			ret = put_user(ret, (int __user *)arg);
899 		break;
900 
901 	case WDIOC_SETOPTIONS:
902 		if (get_user(i, (int __user *)arg)) {
903 			ret = -EFAULT;
904 			break;
905 		}
906 
907 		if (i & WDIOS_DISABLECARD)
908 			ret = watchdog_stop(data);
909 		else if (i & WDIOS_ENABLECARD)
910 			ret = watchdog_trigger(data);
911 		else
912 			ret = -EINVAL;
913 
914 		break;
915 	default:
916 		ret = -ENOTTY;
917 	}
918 	mutex_unlock(&watchdog_mutex);
919 	return ret;
920 }
921 
922 static const struct file_operations watchdog_fops = {
923 	.owner = THIS_MODULE,
924 	.llseek = no_llseek,
925 	.open = watchdog_open,
926 	.release = watchdog_release,
927 	.write = watchdog_write,
928 	.unlocked_ioctl = watchdog_ioctl,
929 };
930 
931 
932 /*
933  * Detect, register, unregister and update device functions
934  */
935 
936 /* DMI decode routine to read voltage scaling factors from special DMI tables,
937    which are available on FSC machines with an fscher or later chip. */
938 static void fschmd_dmi_decode(const struct dmi_header *header, void *dummy)
939 {
940 	int i, mult[3] = { 0 }, offset[3] = { 0 }, vref = 0, found = 0;
941 
942 	/* dmi code ugliness, we get passed the address of the contents of
943 	   a complete DMI record, but in the form of a dmi_header pointer, in
944 	   reality this address holds header->length bytes of which the header
945 	   are the first 4 bytes */
946 	u8 *dmi_data = (u8 *)header;
947 
948 	/* We are looking for OEM-specific type 185 */
949 	if (header->type != 185)
950 		return;
951 
952 	/* we are looking for what Siemens calls "subtype" 19, the subtype
953 	   is stored in byte 5 of the dmi block */
954 	if (header->length < 5 || dmi_data[4] != 19)
955 		return;
956 
957 	/* After the subtype comes 1 unknown byte and then blocks of 5 bytes,
958 	   consisting of what Siemens calls an "Entity" number, followed by
959 	   2 16-bit words in LSB first order */
960 	for (i = 6; (i + 4) < header->length; i += 5) {
961 		/* entity 1 - 3: voltage multiplier and offset */
962 		if (dmi_data[i] >= 1 && dmi_data[i] <= 3) {
963 			/* Our in sensors order and the DMI order differ */
964 			const int shuffle[3] = { 1, 0, 2 };
965 			int in = shuffle[dmi_data[i] - 1];
966 
967 			/* Check for twice the same entity */
968 			if (found & (1 << in))
969 				return;
970 
971 			mult[in] = dmi_data[i + 1] | (dmi_data[i + 2] << 8);
972 			offset[in] = dmi_data[i + 3] | (dmi_data[i + 4] << 8);
973 
974 			found |= 1 << in;
975 		}
976 
977 		/* entity 7: reference voltage */
978 		if (dmi_data[i] == 7) {
979 			/* Check for twice the same entity */
980 			if (found & 0x08)
981 				return;
982 
983 			vref = dmi_data[i + 1] | (dmi_data[i + 2] << 8);
984 
985 			found |= 0x08;
986 		}
987 	}
988 
989 	if (found == 0x0F) {
990 		for (i = 0; i < 3; i++) {
991 			dmi_mult[i] = mult[i] * 10;
992 			dmi_offset[i] = offset[i] * 10;
993 		}
994 		/* According to the docs there should be separate dmi entries
995 		   for the mult's and offsets of in3-5 of the syl, but on
996 		   my test machine these are not present */
997 		dmi_mult[3] = dmi_mult[2];
998 		dmi_mult[4] = dmi_mult[1];
999 		dmi_mult[5] = dmi_mult[2];
1000 		dmi_offset[3] = dmi_offset[2];
1001 		dmi_offset[4] = dmi_offset[1];
1002 		dmi_offset[5] = dmi_offset[2];
1003 		dmi_vref = vref;
1004 	}
1005 }
1006 
1007 static int fschmd_detect(struct i2c_client *client,
1008 			 struct i2c_board_info *info)
1009 {
1010 	enum chips kind;
1011 	struct i2c_adapter *adapter = client->adapter;
1012 	char id[4];
1013 
1014 	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1015 		return -ENODEV;
1016 
1017 	/* Detect & Identify the chip */
1018 	id[0] = i2c_smbus_read_byte_data(client, FSCHMD_REG_IDENT_0);
1019 	id[1] = i2c_smbus_read_byte_data(client, FSCHMD_REG_IDENT_1);
1020 	id[2] = i2c_smbus_read_byte_data(client, FSCHMD_REG_IDENT_2);
1021 	id[3] = '\0';
1022 
1023 	if (!strcmp(id, "PEG"))
1024 		kind = fscpos;
1025 	else if (!strcmp(id, "HER"))
1026 		kind = fscher;
1027 	else if (!strcmp(id, "SCY"))
1028 		kind = fscscy;
1029 	else if (!strcmp(id, "HRC"))
1030 		kind = fschrc;
1031 	else if (!strcmp(id, "HMD"))
1032 		kind = fschmd;
1033 	else if (!strcmp(id, "HDS"))
1034 		kind = fschds;
1035 	else if (!strcmp(id, "SYL"))
1036 		kind = fscsyl;
1037 	else
1038 		return -ENODEV;
1039 
1040 	strlcpy(info->type, fschmd_id[kind].name, I2C_NAME_SIZE);
1041 
1042 	return 0;
1043 }
1044 
1045 static int fschmd_probe(struct i2c_client *client,
1046 			const struct i2c_device_id *id)
1047 {
1048 	struct fschmd_data *data;
1049 	const char * const names[7] = { "Poseidon", "Hermes", "Scylla",
1050 				"Heracles", "Heimdall", "Hades", "Syleus" };
1051 	const int watchdog_minors[] = { WATCHDOG_MINOR, 212, 213, 214, 215 };
1052 	int i, err;
1053 	enum chips kind = id->driver_data;
1054 
1055 	data = kzalloc(sizeof(struct fschmd_data), GFP_KERNEL);
1056 	if (!data)
1057 		return -ENOMEM;
1058 
1059 	i2c_set_clientdata(client, data);
1060 	mutex_init(&data->update_lock);
1061 	mutex_init(&data->watchdog_lock);
1062 	INIT_LIST_HEAD(&data->list);
1063 	kref_init(&data->kref);
1064 	/* Store client pointer in our data struct for watchdog usage
1065 	   (where the client is found through a data ptr instead of the
1066 	   otherway around) */
1067 	data->client = client;
1068 	data->kind = kind;
1069 
1070 	if (kind == fscpos) {
1071 		/* The Poseidon has hardwired temp limits, fill these
1072 		   in for the alarm resetting code */
1073 		data->temp_max[0] = 70 + 128;
1074 		data->temp_max[1] = 50 + 128;
1075 		data->temp_max[2] = 50 + 128;
1076 	}
1077 
1078 	/* Read the special DMI table for fscher and newer chips */
1079 	if ((kind == fscher || kind >= fschrc) && dmi_vref == -1) {
1080 		dmi_walk(fschmd_dmi_decode, NULL);
1081 		if (dmi_vref == -1) {
1082 			dev_warn(&client->dev,
1083 				"Couldn't get voltage scaling factors from "
1084 				"BIOS DMI table, using builtin defaults\n");
1085 			dmi_vref = 33;
1086 		}
1087 	}
1088 
1089 	/* Read in some never changing registers */
1090 	data->revision = i2c_smbus_read_byte_data(client, FSCHMD_REG_REVISION);
1091 	data->global_control = i2c_smbus_read_byte_data(client,
1092 					FSCHMD_REG_CONTROL);
1093 	data->watchdog_control = i2c_smbus_read_byte_data(client,
1094 					FSCHMD_REG_WDOG_CONTROL[data->kind]);
1095 	data->watchdog_state = i2c_smbus_read_byte_data(client,
1096 					FSCHMD_REG_WDOG_STATE[data->kind]);
1097 	data->watchdog_preset = i2c_smbus_read_byte_data(client,
1098 					FSCHMD_REG_WDOG_PRESET[data->kind]);
1099 
1100 	err = device_create_file(&client->dev, &dev_attr_alert_led);
1101 	if (err)
1102 		goto exit_detach;
1103 
1104 	for (i = 0; i < FSCHMD_NO_VOLT_SENSORS[data->kind]; i++) {
1105 		err = device_create_file(&client->dev,
1106 					&fschmd_attr[i].dev_attr);
1107 		if (err)
1108 			goto exit_detach;
1109 	}
1110 
1111 	for (i = 0; i < (FSCHMD_NO_TEMP_SENSORS[data->kind] * 4); i++) {
1112 		/* Poseidon doesn't have TEMP_LIMIT registers */
1113 		if (kind == fscpos && fschmd_temp_attr[i].dev_attr.show ==
1114 				show_temp_max)
1115 			continue;
1116 
1117 		if (kind == fscsyl) {
1118 			if (i % 4 == 0)
1119 				data->temp_status[i / 4] =
1120 					i2c_smbus_read_byte_data(client,
1121 						FSCHMD_REG_TEMP_STATE
1122 						[data->kind][i / 4]);
1123 			if (data->temp_status[i / 4] & FSCHMD_TEMP_DISABLED)
1124 				continue;
1125 		}
1126 
1127 		err = device_create_file(&client->dev,
1128 					&fschmd_temp_attr[i].dev_attr);
1129 		if (err)
1130 			goto exit_detach;
1131 	}
1132 
1133 	for (i = 0; i < (FSCHMD_NO_FAN_SENSORS[data->kind] * 5); i++) {
1134 		/* Poseidon doesn't have a FAN_MIN register for its 3rd fan */
1135 		if (kind == fscpos &&
1136 				!strcmp(fschmd_fan_attr[i].dev_attr.attr.name,
1137 					"pwm3_auto_point1_pwm"))
1138 			continue;
1139 
1140 		if (kind == fscsyl) {
1141 			if (i % 5 == 0)
1142 				data->fan_status[i / 5] =
1143 					i2c_smbus_read_byte_data(client,
1144 						FSCHMD_REG_FAN_STATE
1145 						[data->kind][i / 5]);
1146 			if (data->fan_status[i / 5] & FSCHMD_FAN_DISABLED)
1147 				continue;
1148 		}
1149 
1150 		err = device_create_file(&client->dev,
1151 					&fschmd_fan_attr[i].dev_attr);
1152 		if (err)
1153 			goto exit_detach;
1154 	}
1155 
1156 	data->hwmon_dev = hwmon_device_register(&client->dev);
1157 	if (IS_ERR(data->hwmon_dev)) {
1158 		err = PTR_ERR(data->hwmon_dev);
1159 		data->hwmon_dev = NULL;
1160 		goto exit_detach;
1161 	}
1162 
1163 	/* We take the data_mutex lock early so that watchdog_open() cannot
1164 	   run when misc_register() has completed, but we've not yet added
1165 	   our data to the watchdog_data_list (and set the default timeout) */
1166 	mutex_lock(&watchdog_data_mutex);
1167 	for (i = 0; i < ARRAY_SIZE(watchdog_minors); i++) {
1168 		/* Register our watchdog part */
1169 		snprintf(data->watchdog_name, sizeof(data->watchdog_name),
1170 			"watchdog%c", (i == 0) ? '\0' : ('0' + i));
1171 		data->watchdog_miscdev.name = data->watchdog_name;
1172 		data->watchdog_miscdev.fops = &watchdog_fops;
1173 		data->watchdog_miscdev.minor = watchdog_minors[i];
1174 		err = misc_register(&data->watchdog_miscdev);
1175 		if (err == -EBUSY)
1176 			continue;
1177 		if (err) {
1178 			data->watchdog_miscdev.minor = 0;
1179 			dev_err(&client->dev,
1180 				"Registering watchdog chardev: %d\n", err);
1181 			break;
1182 		}
1183 
1184 		list_add(&data->list, &watchdog_data_list);
1185 		watchdog_set_timeout(data, 60);
1186 		dev_info(&client->dev,
1187 			"Registered watchdog chardev major 10, minor: %d\n",
1188 			watchdog_minors[i]);
1189 		break;
1190 	}
1191 	if (i == ARRAY_SIZE(watchdog_minors)) {
1192 		data->watchdog_miscdev.minor = 0;
1193 		dev_warn(&client->dev, "Couldn't register watchdog chardev "
1194 			"(due to no free minor)\n");
1195 	}
1196 	mutex_unlock(&watchdog_data_mutex);
1197 
1198 	dev_info(&client->dev, "Detected FSC %s chip, revision: %d\n",
1199 		names[data->kind], (int) data->revision);
1200 
1201 	return 0;
1202 
1203 exit_detach:
1204 	fschmd_remove(client); /* will also free data for us */
1205 	return err;
1206 }
1207 
1208 static int fschmd_remove(struct i2c_client *client)
1209 {
1210 	struct fschmd_data *data = i2c_get_clientdata(client);
1211 	int i;
1212 
1213 	/* Unregister the watchdog (if registered) */
1214 	if (data->watchdog_miscdev.minor) {
1215 		misc_deregister(&data->watchdog_miscdev);
1216 		if (data->watchdog_is_open) {
1217 			dev_warn(&client->dev,
1218 				"i2c client detached with watchdog open! "
1219 				"Stopping watchdog.\n");
1220 			watchdog_stop(data);
1221 		}
1222 		mutex_lock(&watchdog_data_mutex);
1223 		list_del(&data->list);
1224 		mutex_unlock(&watchdog_data_mutex);
1225 		/* Tell the watchdog code the client is gone */
1226 		mutex_lock(&data->watchdog_lock);
1227 		data->client = NULL;
1228 		mutex_unlock(&data->watchdog_lock);
1229 	}
1230 
1231 	/* Check if registered in case we're called from fschmd_detect
1232 	   to cleanup after an error */
1233 	if (data->hwmon_dev)
1234 		hwmon_device_unregister(data->hwmon_dev);
1235 
1236 	device_remove_file(&client->dev, &dev_attr_alert_led);
1237 	for (i = 0; i < (FSCHMD_NO_VOLT_SENSORS[data->kind]); i++)
1238 		device_remove_file(&client->dev, &fschmd_attr[i].dev_attr);
1239 	for (i = 0; i < (FSCHMD_NO_TEMP_SENSORS[data->kind] * 4); i++)
1240 		device_remove_file(&client->dev,
1241 					&fschmd_temp_attr[i].dev_attr);
1242 	for (i = 0; i < (FSCHMD_NO_FAN_SENSORS[data->kind] * 5); i++)
1243 		device_remove_file(&client->dev,
1244 					&fschmd_fan_attr[i].dev_attr);
1245 
1246 	mutex_lock(&watchdog_data_mutex);
1247 	kref_put(&data->kref, fschmd_release_resources);
1248 	mutex_unlock(&watchdog_data_mutex);
1249 
1250 	return 0;
1251 }
1252 
1253 static struct fschmd_data *fschmd_update_device(struct device *dev)
1254 {
1255 	struct i2c_client *client = to_i2c_client(dev);
1256 	struct fschmd_data *data = i2c_get_clientdata(client);
1257 	int i;
1258 
1259 	mutex_lock(&data->update_lock);
1260 
1261 	if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) {
1262 
1263 		for (i = 0; i < FSCHMD_NO_TEMP_SENSORS[data->kind]; i++) {
1264 			data->temp_act[i] = i2c_smbus_read_byte_data(client,
1265 					FSCHMD_REG_TEMP_ACT[data->kind][i]);
1266 			data->temp_status[i] = i2c_smbus_read_byte_data(client,
1267 					FSCHMD_REG_TEMP_STATE[data->kind][i]);
1268 
1269 			/* The fscpos doesn't have TEMP_LIMIT registers */
1270 			if (FSCHMD_REG_TEMP_LIMIT[data->kind][i])
1271 				data->temp_max[i] = i2c_smbus_read_byte_data(
1272 					client,
1273 					FSCHMD_REG_TEMP_LIMIT[data->kind][i]);
1274 
1275 			/* reset alarm if the alarm condition is gone,
1276 			   the chip doesn't do this itself */
1277 			if ((data->temp_status[i] & FSCHMD_TEMP_ALARM_MASK) ==
1278 					FSCHMD_TEMP_ALARM_MASK &&
1279 					data->temp_act[i] < data->temp_max[i])
1280 				i2c_smbus_write_byte_data(client,
1281 					FSCHMD_REG_TEMP_STATE[data->kind][i],
1282 					data->temp_status[i]);
1283 		}
1284 
1285 		for (i = 0; i < FSCHMD_NO_FAN_SENSORS[data->kind]; i++) {
1286 			data->fan_act[i] = i2c_smbus_read_byte_data(client,
1287 					FSCHMD_REG_FAN_ACT[data->kind][i]);
1288 			data->fan_status[i] = i2c_smbus_read_byte_data(client,
1289 					FSCHMD_REG_FAN_STATE[data->kind][i]);
1290 			data->fan_ripple[i] = i2c_smbus_read_byte_data(client,
1291 					FSCHMD_REG_FAN_RIPPLE[data->kind][i]);
1292 
1293 			/* The fscpos third fan doesn't have a fan_min */
1294 			if (FSCHMD_REG_FAN_MIN[data->kind][i])
1295 				data->fan_min[i] = i2c_smbus_read_byte_data(
1296 					client,
1297 					FSCHMD_REG_FAN_MIN[data->kind][i]);
1298 
1299 			/* reset fan status if speed is back to > 0 */
1300 			if ((data->fan_status[i] & FSCHMD_FAN_ALARM) &&
1301 					data->fan_act[i])
1302 				i2c_smbus_write_byte_data(client,
1303 					FSCHMD_REG_FAN_STATE[data->kind][i],
1304 					data->fan_status[i]);
1305 		}
1306 
1307 		for (i = 0; i < FSCHMD_NO_VOLT_SENSORS[data->kind]; i++)
1308 			data->volt[i] = i2c_smbus_read_byte_data(client,
1309 					       FSCHMD_REG_VOLT[data->kind][i]);
1310 
1311 		data->last_updated = jiffies;
1312 		data->valid = 1;
1313 	}
1314 
1315 	mutex_unlock(&data->update_lock);
1316 
1317 	return data;
1318 }
1319 
1320 static int __init fschmd_init(void)
1321 {
1322 	return i2c_add_driver(&fschmd_driver);
1323 }
1324 
1325 static void __exit fschmd_exit(void)
1326 {
1327 	i2c_del_driver(&fschmd_driver);
1328 }
1329 
1330 MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
1331 MODULE_DESCRIPTION("FSC Poseidon, Hermes, Scylla, Heracles, Heimdall, Hades "
1332 			"and Syleus driver");
1333 MODULE_LICENSE("GPL");
1334 
1335 module_init(fschmd_init);
1336 module_exit(fschmd_exit);
1337