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