[PATCH] ocfs2: fix oops in mmap_truncate testing
[sfrench/cifs-2.6.git] / drivers / hwmon / gl518sm.c
1 /*
2  * gl518sm.c - Part of lm_sensors, Linux kernel modules for hardware
3  *             monitoring
4  * Copyright (C) 1998, 1999 Frodo Looijaard <frodol@dds.nl> and
5  * Kyosti Malkki <kmalkki@cc.hut.fi>
6  * Copyright (C) 2004 Hong-Gunn Chew <hglinux@gunnet.org> and
7  * Jean Delvare <khali@linux-fr.org>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22  *
23  * Ported to Linux 2.6 by Hong-Gunn Chew with the help of Jean Delvare
24  * and advice of Greg Kroah-Hartman.
25  *
26  * Notes about the port:
27  * Release 0x00 of the GL518SM chipset doesn't support reading of in0,
28  * in1 nor in2. The original driver had an ugly workaround to get them
29  * anyway (changing limits and watching alarms trigger and wear off).
30  * We did not keep that part of the original driver in the Linux 2.6
31  * version, since it was making the driver significantly more complex
32  * with no real benefit.
33  */
34
35 #include <linux/module.h>
36 #include <linux/init.h>
37 #include <linux/slab.h>
38 #include <linux/jiffies.h>
39 #include <linux/i2c.h>
40 #include <linux/hwmon.h>
41 #include <linux/hwmon-sysfs.h>
42 #include <linux/err.h>
43 #include <linux/mutex.h>
44 #include <linux/sysfs.h>
45
46 /* Addresses to scan */
47 static const unsigned short normal_i2c[] = { 0x2c, 0x2d, I2C_CLIENT_END };
48
49 /* Insmod parameters */
50 I2C_CLIENT_INSMOD_2(gl518sm_r00, gl518sm_r80);
51
52 /* Many GL518 constants specified below */
53
54 /* The GL518 registers */
55 #define GL518_REG_CHIP_ID       0x00
56 #define GL518_REG_REVISION      0x01
57 #define GL518_REG_VENDOR_ID     0x02
58 #define GL518_REG_CONF          0x03
59 #define GL518_REG_TEMP_IN       0x04
60 #define GL518_REG_TEMP_MAX      0x05
61 #define GL518_REG_TEMP_HYST     0x06
62 #define GL518_REG_FAN_COUNT     0x07
63 #define GL518_REG_FAN_LIMIT     0x08
64 #define GL518_REG_VIN1_LIMIT    0x09
65 #define GL518_REG_VIN2_LIMIT    0x0a
66 #define GL518_REG_VIN3_LIMIT    0x0b
67 #define GL518_REG_VDD_LIMIT     0x0c
68 #define GL518_REG_VIN3          0x0d
69 #define GL518_REG_MISC          0x0f
70 #define GL518_REG_ALARM         0x10
71 #define GL518_REG_MASK          0x11
72 #define GL518_REG_INT           0x12
73 #define GL518_REG_VIN2          0x13
74 #define GL518_REG_VIN1          0x14
75 #define GL518_REG_VDD           0x15
76
77
78 /*
79  * Conversions. Rounding and limit checking is only done on the TO_REG
80  * variants. Note that you should be a bit careful with which arguments
81  * these macros are called: arguments may be evaluated more than once.
82  * Fixing this is just not worth it.
83  */
84
85 #define RAW_FROM_REG(val)       val
86
87 #define BOOL_FROM_REG(val)      ((val)?0:1)
88 #define BOOL_TO_REG(val)        ((val)?0:1)
89
90 #define TEMP_TO_REG(val)        (SENSORS_LIMIT(((((val)<0? \
91                                 (val)-500:(val)+500)/1000)+119),0,255))
92 #define TEMP_FROM_REG(val)      (((val) - 119) * 1000)
93
94 static inline u8 FAN_TO_REG(long rpm, int div)
95 {
96         long rpmdiv;
97         if (rpm == 0)
98                 return 0;
99         rpmdiv = SENSORS_LIMIT(rpm, 1, 960000) * div;
100         return SENSORS_LIMIT((480000 + rpmdiv / 2) / rpmdiv, 1, 255);
101 }
102 #define FAN_FROM_REG(val,div)   ((val)==0 ? 0 : (480000/((val)*(div))))
103
104 #define IN_TO_REG(val)          (SENSORS_LIMIT((((val)+9)/19),0,255))
105 #define IN_FROM_REG(val)        ((val)*19)
106
107 #define VDD_TO_REG(val)         (SENSORS_LIMIT((((val)*4+47)/95),0,255))
108 #define VDD_FROM_REG(val)       (((val)*95+2)/4)
109
110 #define DIV_FROM_REG(val)       (1 << (val))
111
112 #define BEEP_MASK_TO_REG(val)   ((val) & 0x7f & data->alarm_mask)
113 #define BEEP_MASK_FROM_REG(val) ((val) & 0x7f)
114
115 /* Each client has this additional data */
116 struct gl518_data {
117         struct i2c_client client;
118         struct device *hwmon_dev;
119         enum chips type;
120
121         struct mutex update_lock;
122         char valid;             /* !=0 if following fields are valid */
123         unsigned long last_updated;     /* In jiffies */
124
125         u8 voltage_in[4];       /* Register values; [0] = VDD */
126         u8 voltage_min[4];      /* Register values; [0] = VDD */
127         u8 voltage_max[4];      /* Register values; [0] = VDD */
128         u8 fan_in[2];
129         u8 fan_min[2];
130         u8 fan_div[2];          /* Register encoding, shifted right */
131         u8 fan_auto1;           /* Boolean */
132         u8 temp_in;             /* Register values */
133         u8 temp_max;            /* Register values */
134         u8 temp_hyst;           /* Register values */
135         u8 alarms;              /* Register value */
136         u8 alarm_mask;
137         u8 beep_mask;           /* Register value */
138         u8 beep_enable;         /* Boolean */
139 };
140
141 static int gl518_attach_adapter(struct i2c_adapter *adapter);
142 static int gl518_detect(struct i2c_adapter *adapter, int address, int kind);
143 static void gl518_init_client(struct i2c_client *client);
144 static int gl518_detach_client(struct i2c_client *client);
145 static int gl518_read_value(struct i2c_client *client, u8 reg);
146 static int gl518_write_value(struct i2c_client *client, u8 reg, u16 value);
147 static struct gl518_data *gl518_update_device(struct device *dev);
148
149 /* This is the driver that will be inserted */
150 static struct i2c_driver gl518_driver = {
151         .driver = {
152                 .name   = "gl518sm",
153         },
154         .attach_adapter = gl518_attach_adapter,
155         .detach_client  = gl518_detach_client,
156 };
157
158 /*
159  * Sysfs stuff
160  */
161
162 #define show(type, suffix, value)                                       \
163 static ssize_t show_##suffix(struct device *dev, struct device_attribute *attr, char *buf)              \
164 {                                                                       \
165         struct gl518_data *data = gl518_update_device(dev);             \
166         return sprintf(buf, "%d\n", type##_FROM_REG(data->value));      \
167 }
168
169 show(TEMP, temp_input1, temp_in);
170 show(TEMP, temp_max1, temp_max);
171 show(TEMP, temp_hyst1, temp_hyst);
172 show(BOOL, fan_auto1, fan_auto1);
173 show(VDD, in_input0, voltage_in[0]);
174 show(IN, in_input1, voltage_in[1]);
175 show(IN, in_input2, voltage_in[2]);
176 show(IN, in_input3, voltage_in[3]);
177 show(VDD, in_min0, voltage_min[0]);
178 show(IN, in_min1, voltage_min[1]);
179 show(IN, in_min2, voltage_min[2]);
180 show(IN, in_min3, voltage_min[3]);
181 show(VDD, in_max0, voltage_max[0]);
182 show(IN, in_max1, voltage_max[1]);
183 show(IN, in_max2, voltage_max[2]);
184 show(IN, in_max3, voltage_max[3]);
185 show(RAW, alarms, alarms);
186 show(BOOL, beep_enable, beep_enable);
187 show(BEEP_MASK, beep_mask, beep_mask);
188
189 static ssize_t show_fan_input(struct device *dev,
190                               struct device_attribute *attr, char *buf)
191 {
192         int nr = to_sensor_dev_attr(attr)->index;
193         struct gl518_data *data = gl518_update_device(dev);
194         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_in[nr],
195                                         DIV_FROM_REG(data->fan_div[nr])));
196 }
197
198 static ssize_t show_fan_min(struct device *dev,
199                             struct device_attribute *attr, char *buf)
200 {
201         int nr = to_sensor_dev_attr(attr)->index;
202         struct gl518_data *data = gl518_update_device(dev);
203         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr],
204                                         DIV_FROM_REG(data->fan_div[nr])));
205 }
206
207 static ssize_t show_fan_div(struct device *dev,
208                             struct device_attribute *attr, char *buf)
209 {
210         int nr = to_sensor_dev_attr(attr)->index;
211         struct gl518_data *data = gl518_update_device(dev);
212         return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]));
213 }
214
215 #define set(type, suffix, value, reg)                                   \
216 static ssize_t set_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \
217         size_t count)                                                   \
218 {                                                                       \
219         struct i2c_client *client = to_i2c_client(dev);                 \
220         struct gl518_data *data = i2c_get_clientdata(client);           \
221         long val = simple_strtol(buf, NULL, 10);                        \
222                                                                         \
223         mutex_lock(&data->update_lock);                                 \
224         data->value = type##_TO_REG(val);                               \
225         gl518_write_value(client, reg, data->value);                    \
226         mutex_unlock(&data->update_lock);                               \
227         return count;                                                   \
228 }
229
230 #define set_bits(type, suffix, value, reg, mask, shift)                 \
231 static ssize_t set_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \
232         size_t count)                                                   \
233 {                                                                       \
234         struct i2c_client *client = to_i2c_client(dev);                 \
235         struct gl518_data *data = i2c_get_clientdata(client);           \
236         int regvalue;                                                   \
237         unsigned long val = simple_strtoul(buf, NULL, 10);              \
238                                                                         \
239         mutex_lock(&data->update_lock);                                 \
240         regvalue = gl518_read_value(client, reg);                       \
241         data->value = type##_TO_REG(val);                               \
242         regvalue = (regvalue & ~mask) | (data->value << shift);         \
243         gl518_write_value(client, reg, regvalue);                       \
244         mutex_unlock(&data->update_lock);                               \
245         return count;                                                   \
246 }
247
248 #define set_low(type, suffix, value, reg)                               \
249         set_bits(type, suffix, value, reg, 0x00ff, 0)
250 #define set_high(type, suffix, value, reg)                              \
251         set_bits(type, suffix, value, reg, 0xff00, 8)
252
253 set(TEMP, temp_max1, temp_max, GL518_REG_TEMP_MAX);
254 set(TEMP, temp_hyst1, temp_hyst, GL518_REG_TEMP_HYST);
255 set_bits(BOOL, fan_auto1, fan_auto1, GL518_REG_MISC, 0x08, 3);
256 set_low(VDD, in_min0, voltage_min[0], GL518_REG_VDD_LIMIT);
257 set_low(IN, in_min1, voltage_min[1], GL518_REG_VIN1_LIMIT);
258 set_low(IN, in_min2, voltage_min[2], GL518_REG_VIN2_LIMIT);
259 set_low(IN, in_min3, voltage_min[3], GL518_REG_VIN3_LIMIT);
260 set_high(VDD, in_max0, voltage_max[0], GL518_REG_VDD_LIMIT);
261 set_high(IN, in_max1, voltage_max[1], GL518_REG_VIN1_LIMIT);
262 set_high(IN, in_max2, voltage_max[2], GL518_REG_VIN2_LIMIT);
263 set_high(IN, in_max3, voltage_max[3], GL518_REG_VIN3_LIMIT);
264 set_bits(BOOL, beep_enable, beep_enable, GL518_REG_CONF, 0x04, 2);
265 set(BEEP_MASK, beep_mask, beep_mask, GL518_REG_ALARM);
266
267 static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
268                            const char *buf, size_t count)
269 {
270         struct i2c_client *client = to_i2c_client(dev);
271         struct gl518_data *data = i2c_get_clientdata(client);
272         int nr = to_sensor_dev_attr(attr)->index;
273         int regvalue;
274         unsigned long val = simple_strtoul(buf, NULL, 10);
275
276         mutex_lock(&data->update_lock);
277         regvalue = gl518_read_value(client, GL518_REG_FAN_LIMIT);
278         data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
279         regvalue = (regvalue & (0xff << (8 * nr)))
280                  | (data->fan_min[nr] << (8 * (1 - nr)));
281         gl518_write_value(client, GL518_REG_FAN_LIMIT, regvalue);
282
283         data->beep_mask = gl518_read_value(client, GL518_REG_ALARM);
284         if (data->fan_min[nr] == 0)
285                 data->alarm_mask &= ~(0x20 << nr);
286         else
287                 data->alarm_mask |= (0x20 << nr);
288         data->beep_mask &= data->alarm_mask;
289         gl518_write_value(client, GL518_REG_ALARM, data->beep_mask);
290
291         mutex_unlock(&data->update_lock);
292         return count;
293 }
294
295 static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr,
296                            const char *buf, size_t count)
297 {
298         struct i2c_client *client = to_i2c_client(dev);
299         struct gl518_data *data = i2c_get_clientdata(client);
300         int nr = to_sensor_dev_attr(attr)->index;
301         int regvalue;
302         unsigned long val = simple_strtoul(buf, NULL, 10);
303
304         switch (val) {
305         case 1: val = 0; break;
306         case 2: val = 1; break;
307         case 4: val = 2; break;
308         case 8: val = 3; break;
309         default:
310                 dev_err(dev, "Invalid fan clock divider %lu, choose one "
311                         "of 1, 2, 4 or 8\n", val);
312                 return -EINVAL;
313         }
314
315         mutex_lock(&data->update_lock);
316         regvalue = gl518_read_value(client, GL518_REG_MISC);
317         data->fan_div[nr] = val;
318         regvalue = (regvalue & ~(0xc0 >> (2 * nr)))
319                  | (data->fan_div[nr] << (6 - 2 * nr));
320         gl518_write_value(client, GL518_REG_MISC, regvalue);
321         mutex_unlock(&data->update_lock);
322         return count;
323 }
324
325 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp_input1, NULL);
326 static DEVICE_ATTR(temp1_max, S_IWUSR|S_IRUGO, show_temp_max1, set_temp_max1);
327 static DEVICE_ATTR(temp1_max_hyst, S_IWUSR|S_IRUGO,
328         show_temp_hyst1, set_temp_hyst1);
329 static DEVICE_ATTR(fan1_auto, S_IWUSR|S_IRUGO, show_fan_auto1, set_fan_auto1);
330 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan_input, NULL, 0);
331 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan_input, NULL, 1);
332 static SENSOR_DEVICE_ATTR(fan1_min, S_IWUSR|S_IRUGO,
333         show_fan_min, set_fan_min, 0);
334 static SENSOR_DEVICE_ATTR(fan2_min, S_IWUSR|S_IRUGO,
335         show_fan_min, set_fan_min, 1);
336 static SENSOR_DEVICE_ATTR(fan1_div, S_IWUSR|S_IRUGO,
337         show_fan_div, set_fan_div, 0);
338 static SENSOR_DEVICE_ATTR(fan2_div, S_IWUSR|S_IRUGO,
339         show_fan_div, set_fan_div, 1);
340 static DEVICE_ATTR(in0_input, S_IRUGO, show_in_input0, NULL);
341 static DEVICE_ATTR(in1_input, S_IRUGO, show_in_input1, NULL);
342 static DEVICE_ATTR(in2_input, S_IRUGO, show_in_input2, NULL);
343 static DEVICE_ATTR(in3_input, S_IRUGO, show_in_input3, NULL);
344 static DEVICE_ATTR(in0_min, S_IWUSR|S_IRUGO, show_in_min0, set_in_min0);
345 static DEVICE_ATTR(in1_min, S_IWUSR|S_IRUGO, show_in_min1, set_in_min1);
346 static DEVICE_ATTR(in2_min, S_IWUSR|S_IRUGO, show_in_min2, set_in_min2);
347 static DEVICE_ATTR(in3_min, S_IWUSR|S_IRUGO, show_in_min3, set_in_min3);
348 static DEVICE_ATTR(in0_max, S_IWUSR|S_IRUGO, show_in_max0, set_in_max0);
349 static DEVICE_ATTR(in1_max, S_IWUSR|S_IRUGO, show_in_max1, set_in_max1);
350 static DEVICE_ATTR(in2_max, S_IWUSR|S_IRUGO, show_in_max2, set_in_max2);
351 static DEVICE_ATTR(in3_max, S_IWUSR|S_IRUGO, show_in_max3, set_in_max3);
352 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
353 static DEVICE_ATTR(beep_enable, S_IWUSR|S_IRUGO,
354         show_beep_enable, set_beep_enable);
355 static DEVICE_ATTR(beep_mask, S_IWUSR|S_IRUGO,
356         show_beep_mask, set_beep_mask);
357
358 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
359                           char *buf)
360 {
361         int bitnr = to_sensor_dev_attr(attr)->index;
362         struct gl518_data *data = gl518_update_device(dev);
363         return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
364 }
365
366 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
367 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
368 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
369 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
370 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
371 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 5);
372 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 6);
373
374 static ssize_t show_beep(struct device *dev, struct device_attribute *attr,
375                           char *buf)
376 {
377         int bitnr = to_sensor_dev_attr(attr)->index;
378         struct gl518_data *data = gl518_update_device(dev);
379         return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
380 }
381
382 static ssize_t set_beep(struct device *dev, struct device_attribute *attr,
383                         const char *buf, size_t count)
384 {
385         struct i2c_client *client = to_i2c_client(dev);
386         struct gl518_data *data = i2c_get_clientdata(client);
387         int bitnr = to_sensor_dev_attr(attr)->index;
388         unsigned long bit;
389
390         bit = simple_strtoul(buf, NULL, 10);
391         if (bit & ~1)
392                 return -EINVAL;
393
394         mutex_lock(&data->update_lock);
395         data->beep_mask = gl518_read_value(client, GL518_REG_ALARM);
396         if (bit)
397                 data->beep_mask |= (1 << bitnr);
398         else
399                 data->beep_mask &= ~(1 << bitnr);
400         gl518_write_value(client, GL518_REG_ALARM, data->beep_mask);
401         mutex_unlock(&data->update_lock);
402         return count;
403 }
404
405 static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 0);
406 static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 1);
407 static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 2);
408 static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 3);
409 static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 4);
410 static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 5);
411 static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 6);
412
413 static struct attribute *gl518_attributes[] = {
414         &dev_attr_in3_input.attr,
415         &dev_attr_in0_min.attr,
416         &dev_attr_in1_min.attr,
417         &dev_attr_in2_min.attr,
418         &dev_attr_in3_min.attr,
419         &dev_attr_in0_max.attr,
420         &dev_attr_in1_max.attr,
421         &dev_attr_in2_max.attr,
422         &dev_attr_in3_max.attr,
423         &sensor_dev_attr_in0_alarm.dev_attr.attr,
424         &sensor_dev_attr_in1_alarm.dev_attr.attr,
425         &sensor_dev_attr_in2_alarm.dev_attr.attr,
426         &sensor_dev_attr_in3_alarm.dev_attr.attr,
427         &sensor_dev_attr_in0_beep.dev_attr.attr,
428         &sensor_dev_attr_in1_beep.dev_attr.attr,
429         &sensor_dev_attr_in2_beep.dev_attr.attr,
430         &sensor_dev_attr_in3_beep.dev_attr.attr,
431
432         &dev_attr_fan1_auto.attr,
433         &sensor_dev_attr_fan1_input.dev_attr.attr,
434         &sensor_dev_attr_fan2_input.dev_attr.attr,
435         &sensor_dev_attr_fan1_min.dev_attr.attr,
436         &sensor_dev_attr_fan2_min.dev_attr.attr,
437         &sensor_dev_attr_fan1_div.dev_attr.attr,
438         &sensor_dev_attr_fan2_div.dev_attr.attr,
439         &sensor_dev_attr_fan1_alarm.dev_attr.attr,
440         &sensor_dev_attr_fan2_alarm.dev_attr.attr,
441         &sensor_dev_attr_fan1_beep.dev_attr.attr,
442         &sensor_dev_attr_fan2_beep.dev_attr.attr,
443
444         &dev_attr_temp1_input.attr,
445         &dev_attr_temp1_max.attr,
446         &dev_attr_temp1_max_hyst.attr,
447         &sensor_dev_attr_temp1_alarm.dev_attr.attr,
448         &sensor_dev_attr_temp1_beep.dev_attr.attr,
449
450         &dev_attr_alarms.attr,
451         &dev_attr_beep_enable.attr,
452         &dev_attr_beep_mask.attr,
453         NULL
454 };
455
456 static const struct attribute_group gl518_group = {
457         .attrs = gl518_attributes,
458 };
459
460 static struct attribute *gl518_attributes_r80[] = {
461         &dev_attr_in0_input.attr,
462         &dev_attr_in1_input.attr,
463         &dev_attr_in2_input.attr,
464         NULL
465 };
466
467 static const struct attribute_group gl518_group_r80 = {
468         .attrs = gl518_attributes_r80,
469 };
470
471 /*
472  * Real code
473  */
474
475 static int gl518_attach_adapter(struct i2c_adapter *adapter)
476 {
477         if (!(adapter->class & I2C_CLASS_HWMON))
478                 return 0;
479         return i2c_probe(adapter, &addr_data, gl518_detect);
480 }
481
482 static int gl518_detect(struct i2c_adapter *adapter, int address, int kind)
483 {
484         int i;
485         struct i2c_client *client;
486         struct gl518_data *data;
487         int err = 0;
488
489         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
490                                      I2C_FUNC_SMBUS_WORD_DATA))
491                 goto exit;
492
493         /* OK. For now, we presume we have a valid client. We now create the
494            client structure, even though we cannot fill it completely yet.
495            But it allows us to access gl518_{read,write}_value. */
496
497         if (!(data = kzalloc(sizeof(struct gl518_data), GFP_KERNEL))) {
498                 err = -ENOMEM;
499                 goto exit;
500         }
501
502         client = &data->client;
503         i2c_set_clientdata(client, data);
504
505         client->addr = address;
506         client->adapter = adapter;
507         client->driver = &gl518_driver;
508
509         /* Now, we do the remaining detection. */
510
511         if (kind < 0) {
512                 if ((gl518_read_value(client, GL518_REG_CHIP_ID) != 0x80)
513                  || (gl518_read_value(client, GL518_REG_CONF) & 0x80))
514                         goto exit_free;
515         }
516
517         /* Determine the chip type. */
518         if (kind <= 0) {
519                 i = gl518_read_value(client, GL518_REG_REVISION);
520                 if (i == 0x00) {
521                         kind = gl518sm_r00;
522                 } else if (i == 0x80) {
523                         kind = gl518sm_r80;
524                 } else {
525                         if (kind <= 0)
526                                 dev_info(&adapter->dev,
527                                     "Ignoring 'force' parameter for unknown "
528                                     "chip at adapter %d, address 0x%02x\n",
529                                     i2c_adapter_id(adapter), address);
530                         goto exit_free;
531                 }
532         }
533
534         /* Fill in the remaining client fields */
535         strlcpy(client->name, "gl518sm", I2C_NAME_SIZE);
536         data->type = kind;
537         mutex_init(&data->update_lock);
538
539         /* Tell the I2C layer a new client has arrived */
540         if ((err = i2c_attach_client(client)))
541                 goto exit_free;
542
543         /* Initialize the GL518SM chip */
544         data->alarm_mask = 0xff;
545         gl518_init_client(client);
546
547         /* Register sysfs hooks */
548         if ((err = sysfs_create_group(&client->dev.kobj, &gl518_group)))
549                 goto exit_detach;
550         if (data->type == gl518sm_r80)
551                 if ((err = sysfs_create_group(&client->dev.kobj,
552                                               &gl518_group_r80)))
553                         goto exit_remove_files;
554
555         data->hwmon_dev = hwmon_device_register(&client->dev);
556         if (IS_ERR(data->hwmon_dev)) {
557                 err = PTR_ERR(data->hwmon_dev);
558                 goto exit_remove_files;
559         }
560
561         return 0;
562
563 exit_remove_files:
564         sysfs_remove_group(&client->dev.kobj, &gl518_group);
565         if (data->type == gl518sm_r80)
566                 sysfs_remove_group(&client->dev.kobj, &gl518_group_r80);
567 exit_detach:
568         i2c_detach_client(client);
569 exit_free:
570         kfree(data);
571 exit:
572         return err;
573 }
574
575
576 /* Called when we have found a new GL518SM.
577    Note that we preserve D4:NoFan2 and D2:beep_enable. */
578 static void gl518_init_client(struct i2c_client *client)
579 {
580         /* Make sure we leave D7:Reset untouched */
581         u8 regvalue = gl518_read_value(client, GL518_REG_CONF) & 0x7f;
582
583         /* Comparator mode (D3=0), standby mode (D6=0) */
584         gl518_write_value(client, GL518_REG_CONF, (regvalue &= 0x37));
585
586         /* Never interrupts */
587         gl518_write_value(client, GL518_REG_MASK, 0x00);
588
589         /* Clear status register (D5=1), start (D6=1) */
590         gl518_write_value(client, GL518_REG_CONF, 0x20 | regvalue);
591         gl518_write_value(client, GL518_REG_CONF, 0x40 | regvalue);
592 }
593
594 static int gl518_detach_client(struct i2c_client *client)
595 {
596         struct gl518_data *data = i2c_get_clientdata(client);
597         int err;
598
599         hwmon_device_unregister(data->hwmon_dev);
600         sysfs_remove_group(&client->dev.kobj, &gl518_group);
601         if (data->type == gl518sm_r80)
602                 sysfs_remove_group(&client->dev.kobj, &gl518_group_r80);
603
604         if ((err = i2c_detach_client(client)))
605                 return err;
606
607         kfree(data);
608         return 0;
609 }
610
611 /* Registers 0x07 to 0x0c are word-sized, others are byte-sized
612    GL518 uses a high-byte first convention, which is exactly opposite to
613    the SMBus standard. */
614 static int gl518_read_value(struct i2c_client *client, u8 reg)
615 {
616         if ((reg >= 0x07) && (reg <= 0x0c))
617                 return swab16(i2c_smbus_read_word_data(client, reg));
618         else
619                 return i2c_smbus_read_byte_data(client, reg);
620 }
621
622 static int gl518_write_value(struct i2c_client *client, u8 reg, u16 value)
623 {
624         if ((reg >= 0x07) && (reg <= 0x0c))
625                 return i2c_smbus_write_word_data(client, reg, swab16(value));
626         else
627                 return i2c_smbus_write_byte_data(client, reg, value);
628 }
629
630 static struct gl518_data *gl518_update_device(struct device *dev)
631 {
632         struct i2c_client *client = to_i2c_client(dev);
633         struct gl518_data *data = i2c_get_clientdata(client);
634         int val;
635
636         mutex_lock(&data->update_lock);
637
638         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
639             || !data->valid) {
640                 dev_dbg(&client->dev, "Starting gl518 update\n");
641
642                 data->alarms = gl518_read_value(client, GL518_REG_INT);
643                 data->beep_mask = gl518_read_value(client, GL518_REG_ALARM);
644
645                 val = gl518_read_value(client, GL518_REG_VDD_LIMIT);
646                 data->voltage_min[0] = val & 0xff;
647                 data->voltage_max[0] = (val >> 8) & 0xff;
648                 val = gl518_read_value(client, GL518_REG_VIN1_LIMIT);
649                 data->voltage_min[1] = val & 0xff;
650                 data->voltage_max[1] = (val >> 8) & 0xff;
651                 val = gl518_read_value(client, GL518_REG_VIN2_LIMIT);
652                 data->voltage_min[2] = val & 0xff;
653                 data->voltage_max[2] = (val >> 8) & 0xff;
654                 val = gl518_read_value(client, GL518_REG_VIN3_LIMIT);
655                 data->voltage_min[3] = val & 0xff;
656                 data->voltage_max[3] = (val >> 8) & 0xff;
657
658                 val = gl518_read_value(client, GL518_REG_FAN_COUNT);
659                 data->fan_in[0] = (val >> 8) & 0xff;
660                 data->fan_in[1] = val & 0xff;
661
662                 val = gl518_read_value(client, GL518_REG_FAN_LIMIT);
663                 data->fan_min[0] = (val >> 8) & 0xff;
664                 data->fan_min[1] = val & 0xff;
665
666                 data->temp_in = gl518_read_value(client, GL518_REG_TEMP_IN);
667                 data->temp_max =
668                     gl518_read_value(client, GL518_REG_TEMP_MAX);
669                 data->temp_hyst =
670                     gl518_read_value(client, GL518_REG_TEMP_HYST);
671
672                 val = gl518_read_value(client, GL518_REG_MISC);
673                 data->fan_div[0] = (val >> 6) & 0x03;
674                 data->fan_div[1] = (val >> 4) & 0x03;
675                 data->fan_auto1  = (val >> 3) & 0x01;
676
677                 data->alarms &= data->alarm_mask;
678
679                 val = gl518_read_value(client, GL518_REG_CONF);
680                 data->beep_enable = (val >> 2) & 1;
681
682                 if (data->type != gl518sm_r00) {
683                         data->voltage_in[0] =
684                             gl518_read_value(client, GL518_REG_VDD);
685                         data->voltage_in[1] =
686                             gl518_read_value(client, GL518_REG_VIN1);
687                         data->voltage_in[2] =
688                             gl518_read_value(client, GL518_REG_VIN2);
689                 }
690                 data->voltage_in[3] =
691                     gl518_read_value(client, GL518_REG_VIN3);
692
693                 data->last_updated = jiffies;
694                 data->valid = 1;
695         }
696
697         mutex_unlock(&data->update_lock);
698
699         return data;
700 }
701
702 static int __init sensors_gl518sm_init(void)
703 {
704         return i2c_add_driver(&gl518_driver);
705 }
706
707 static void __exit sensors_gl518sm_exit(void)
708 {
709         i2c_del_driver(&gl518_driver);
710 }
711
712 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
713         "Kyosti Malkki <kmalkki@cc.hut.fi> and "
714         "Hong-Gunn Chew <hglinux@gunnet.org>");
715 MODULE_DESCRIPTION("GL518SM driver");
716 MODULE_LICENSE("GPL");
717
718 module_init(sensors_gl518sm_init);
719 module_exit(sensors_gl518sm_exit);