RDMA/rdma_cm: Fix use after free race with process_one_req
[platform/kernel/linux-rpi.git] / drivers / hwmon / gl520sm.c
1 /*
2  * gl520sm.c - Part of lm_sensors, Linux kernel modules for hardware
3  *             monitoring
4  * Copyright (c) 1998, 1999  Frodo Looijaard <frodol@dds.nl>,
5  *                           Kyösti Mälkki <kmalkki@cc.hut.fi>
6  * Copyright (c) 2005   Maarten Deprez <maartendeprez@users.sourceforge.net>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21  *
22  */
23
24 #include <linux/module.h>
25 #include <linux/init.h>
26 #include <linux/slab.h>
27 #include <linux/jiffies.h>
28 #include <linux/i2c.h>
29 #include <linux/hwmon.h>
30 #include <linux/hwmon-sysfs.h>
31 #include <linux/hwmon-vid.h>
32 #include <linux/err.h>
33 #include <linux/mutex.h>
34 #include <linux/sysfs.h>
35
36 /* Type of the extra sensor */
37 static unsigned short extra_sensor_type;
38 module_param(extra_sensor_type, ushort, 0);
39 MODULE_PARM_DESC(extra_sensor_type, "Type of extra sensor (0=autodetect, 1=temperature, 2=voltage)");
40
41 /* Addresses to scan */
42 static const unsigned short normal_i2c[] = { 0x2c, 0x2d, I2C_CLIENT_END };
43
44 /*
45  * Many GL520 constants specified below
46  * One of the inputs can be configured as either temp or voltage.
47  * That's why _TEMP2 and _IN4 access the same register
48  */
49
50 /* The GL520 registers */
51 #define GL520_REG_CHIP_ID               0x00
52 #define GL520_REG_REVISION              0x01
53 #define GL520_REG_CONF                  0x03
54 #define GL520_REG_MASK                  0x11
55
56 #define GL520_REG_VID_INPUT             0x02
57
58 static const u8 GL520_REG_IN_INPUT[]    = { 0x15, 0x14, 0x13, 0x0d, 0x0e };
59 static const u8 GL520_REG_IN_LIMIT[]    = { 0x0c, 0x09, 0x0a, 0x0b };
60 static const u8 GL520_REG_IN_MIN[]      = { 0x0c, 0x09, 0x0a, 0x0b, 0x18 };
61 static const u8 GL520_REG_IN_MAX[]      = { 0x0c, 0x09, 0x0a, 0x0b, 0x17 };
62
63 static const u8 GL520_REG_TEMP_INPUT[]          = { 0x04, 0x0e };
64 static const u8 GL520_REG_TEMP_MAX[]            = { 0x05, 0x17 };
65 static const u8 GL520_REG_TEMP_MAX_HYST[]       = { 0x06, 0x18 };
66
67 #define GL520_REG_FAN_INPUT             0x07
68 #define GL520_REG_FAN_MIN               0x08
69 #define GL520_REG_FAN_DIV               0x0f
70 #define GL520_REG_FAN_OFF               GL520_REG_FAN_DIV
71
72 #define GL520_REG_ALARMS                0x12
73 #define GL520_REG_BEEP_MASK             0x10
74 #define GL520_REG_BEEP_ENABLE           GL520_REG_CONF
75
76 /* Client data */
77 struct gl520_data {
78         struct i2c_client *client;
79         const struct attribute_group *groups[3];
80         struct mutex update_lock;
81         char valid;             /* zero until the following fields are valid */
82         unsigned long last_updated;     /* in jiffies */
83
84         u8 vid;
85         u8 vrm;
86         u8 in_input[5];         /* [0] = VVD */
87         u8 in_min[5];           /* [0] = VDD */
88         u8 in_max[5];           /* [0] = VDD */
89         u8 fan_input[2];
90         u8 fan_min[2];
91         u8 fan_div[2];
92         u8 fan_off;
93         u8 temp_input[2];
94         u8 temp_max[2];
95         u8 temp_max_hyst[2];
96         u8 alarms;
97         u8 beep_enable;
98         u8 beep_mask;
99         u8 alarm_mask;
100         u8 two_temps;
101 };
102
103 /*
104  * Registers 0x07 to 0x0c are word-sized, others are byte-sized
105  * GL520 uses a high-byte first convention
106  */
107 static int gl520_read_value(struct i2c_client *client, u8 reg)
108 {
109         if ((reg >= 0x07) && (reg <= 0x0c))
110                 return i2c_smbus_read_word_swapped(client, reg);
111         else
112                 return i2c_smbus_read_byte_data(client, reg);
113 }
114
115 static int gl520_write_value(struct i2c_client *client, u8 reg, u16 value)
116 {
117         if ((reg >= 0x07) && (reg <= 0x0c))
118                 return i2c_smbus_write_word_swapped(client, reg, value);
119         else
120                 return i2c_smbus_write_byte_data(client, reg, value);
121 }
122
123 static struct gl520_data *gl520_update_device(struct device *dev)
124 {
125         struct gl520_data *data = dev_get_drvdata(dev);
126         struct i2c_client *client = data->client;
127         int val, i;
128
129         mutex_lock(&data->update_lock);
130
131         if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) {
132
133                 dev_dbg(&client->dev, "Starting gl520sm update\n");
134
135                 data->alarms = gl520_read_value(client, GL520_REG_ALARMS);
136                 data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK);
137                 data->vid = gl520_read_value(client,
138                                              GL520_REG_VID_INPUT) & 0x1f;
139
140                 for (i = 0; i < 4; i++) {
141                         data->in_input[i] = gl520_read_value(client,
142                                                         GL520_REG_IN_INPUT[i]);
143                         val = gl520_read_value(client, GL520_REG_IN_LIMIT[i]);
144                         data->in_min[i] = val & 0xff;
145                         data->in_max[i] = (val >> 8) & 0xff;
146                 }
147
148                 val = gl520_read_value(client, GL520_REG_FAN_INPUT);
149                 data->fan_input[0] = (val >> 8) & 0xff;
150                 data->fan_input[1] = val & 0xff;
151
152                 val = gl520_read_value(client, GL520_REG_FAN_MIN);
153                 data->fan_min[0] = (val >> 8) & 0xff;
154                 data->fan_min[1] = val & 0xff;
155
156                 data->temp_input[0] = gl520_read_value(client,
157                                                 GL520_REG_TEMP_INPUT[0]);
158                 data->temp_max[0] = gl520_read_value(client,
159                                                 GL520_REG_TEMP_MAX[0]);
160                 data->temp_max_hyst[0] = gl520_read_value(client,
161                                                 GL520_REG_TEMP_MAX_HYST[0]);
162
163                 val = gl520_read_value(client, GL520_REG_FAN_DIV);
164                 data->fan_div[0] = (val >> 6) & 0x03;
165                 data->fan_div[1] = (val >> 4) & 0x03;
166                 data->fan_off = (val >> 2) & 0x01;
167
168                 data->alarms &= data->alarm_mask;
169
170                 val = gl520_read_value(client, GL520_REG_CONF);
171                 data->beep_enable = !((val >> 2) & 1);
172
173                 /* Temp1 and Vin4 are the same input */
174                 if (data->two_temps) {
175                         data->temp_input[1] = gl520_read_value(client,
176                                                 GL520_REG_TEMP_INPUT[1]);
177                         data->temp_max[1] = gl520_read_value(client,
178                                                 GL520_REG_TEMP_MAX[1]);
179                         data->temp_max_hyst[1] = gl520_read_value(client,
180                                                 GL520_REG_TEMP_MAX_HYST[1]);
181                 } else {
182                         data->in_input[4] = gl520_read_value(client,
183                                                 GL520_REG_IN_INPUT[4]);
184                         data->in_min[4] = gl520_read_value(client,
185                                                 GL520_REG_IN_MIN[4]);
186                         data->in_max[4] = gl520_read_value(client,
187                                                 GL520_REG_IN_MAX[4]);
188                 }
189
190                 data->last_updated = jiffies;
191                 data->valid = 1;
192         }
193
194         mutex_unlock(&data->update_lock);
195
196         return data;
197 }
198
199 /*
200  * Sysfs stuff
201  */
202
203 static ssize_t cpu0_vid_show(struct device *dev,
204                              struct device_attribute *attr, char *buf)
205 {
206         struct gl520_data *data = gl520_update_device(dev);
207         return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm));
208 }
209 static DEVICE_ATTR_RO(cpu0_vid);
210
211 #define VDD_FROM_REG(val)       DIV_ROUND_CLOSEST((val) * 95, 4)
212 #define VDD_CLAMP(val)          clamp_val(val, 0, 255 * 95 / 4)
213 #define VDD_TO_REG(val)         DIV_ROUND_CLOSEST(VDD_CLAMP(val) * 4, 95)
214
215 #define IN_FROM_REG(val)        ((val) * 19)
216 #define IN_CLAMP(val)           clamp_val(val, 0, 255 * 19)
217 #define IN_TO_REG(val)          DIV_ROUND_CLOSEST(IN_CLAMP(val), 19)
218
219 static ssize_t get_in_input(struct device *dev, struct device_attribute *attr,
220                             char *buf)
221 {
222         int n = to_sensor_dev_attr(attr)->index;
223         struct gl520_data *data = gl520_update_device(dev);
224         u8 r = data->in_input[n];
225
226         if (n == 0)
227                 return sprintf(buf, "%d\n", VDD_FROM_REG(r));
228         else
229                 return sprintf(buf, "%d\n", IN_FROM_REG(r));
230 }
231
232 static ssize_t get_in_min(struct device *dev, struct device_attribute *attr,
233                           char *buf)
234 {
235         int n = to_sensor_dev_attr(attr)->index;
236         struct gl520_data *data = gl520_update_device(dev);
237         u8 r = data->in_min[n];
238
239         if (n == 0)
240                 return sprintf(buf, "%d\n", VDD_FROM_REG(r));
241         else
242                 return sprintf(buf, "%d\n", IN_FROM_REG(r));
243 }
244
245 static ssize_t get_in_max(struct device *dev, struct device_attribute *attr,
246                           char *buf)
247 {
248         int n = to_sensor_dev_attr(attr)->index;
249         struct gl520_data *data = gl520_update_device(dev);
250         u8 r = data->in_max[n];
251
252         if (n == 0)
253                 return sprintf(buf, "%d\n", VDD_FROM_REG(r));
254         else
255                 return sprintf(buf, "%d\n", IN_FROM_REG(r));
256 }
257
258 static ssize_t set_in_min(struct device *dev, struct device_attribute *attr,
259                           const char *buf, size_t count)
260 {
261         struct gl520_data *data = dev_get_drvdata(dev);
262         struct i2c_client *client = data->client;
263         int n = to_sensor_dev_attr(attr)->index;
264         u8 r;
265         long v;
266         int err;
267
268         err = kstrtol(buf, 10, &v);
269         if (err)
270                 return err;
271
272         mutex_lock(&data->update_lock);
273
274         if (n == 0)
275                 r = VDD_TO_REG(v);
276         else
277                 r = IN_TO_REG(v);
278
279         data->in_min[n] = r;
280
281         if (n < 4)
282                 gl520_write_value(client, GL520_REG_IN_MIN[n],
283                                   (gl520_read_value(client, GL520_REG_IN_MIN[n])
284                                    & ~0xff) | r);
285         else
286                 gl520_write_value(client, GL520_REG_IN_MIN[n], r);
287
288         mutex_unlock(&data->update_lock);
289         return count;
290 }
291
292 static ssize_t set_in_max(struct device *dev, struct device_attribute *attr,
293                           const char *buf, size_t count)
294 {
295         struct gl520_data *data = dev_get_drvdata(dev);
296         struct i2c_client *client = data->client;
297         int n = to_sensor_dev_attr(attr)->index;
298         u8 r;
299         long v;
300         int err;
301
302         err = kstrtol(buf, 10, &v);
303         if (err)
304                 return err;
305
306         if (n == 0)
307                 r = VDD_TO_REG(v);
308         else
309                 r = IN_TO_REG(v);
310
311         mutex_lock(&data->update_lock);
312
313         data->in_max[n] = r;
314
315         if (n < 4)
316                 gl520_write_value(client, GL520_REG_IN_MAX[n],
317                                   (gl520_read_value(client, GL520_REG_IN_MAX[n])
318                                    & ~0xff00) | (r << 8));
319         else
320                 gl520_write_value(client, GL520_REG_IN_MAX[n], r);
321
322         mutex_unlock(&data->update_lock);
323         return count;
324 }
325
326 static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, get_in_input, NULL, 0);
327 static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, get_in_input, NULL, 1);
328 static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, get_in_input, NULL, 2);
329 static SENSOR_DEVICE_ATTR(in3_input, S_IRUGO, get_in_input, NULL, 3);
330 static SENSOR_DEVICE_ATTR(in4_input, S_IRUGO, get_in_input, NULL, 4);
331 static SENSOR_DEVICE_ATTR(in0_min, S_IRUGO | S_IWUSR,
332                 get_in_min, set_in_min, 0);
333 static SENSOR_DEVICE_ATTR(in1_min, S_IRUGO | S_IWUSR,
334                 get_in_min, set_in_min, 1);
335 static SENSOR_DEVICE_ATTR(in2_min, S_IRUGO | S_IWUSR,
336                 get_in_min, set_in_min, 2);
337 static SENSOR_DEVICE_ATTR(in3_min, S_IRUGO | S_IWUSR,
338                 get_in_min, set_in_min, 3);
339 static SENSOR_DEVICE_ATTR(in4_min, S_IRUGO | S_IWUSR,
340                 get_in_min, set_in_min, 4);
341 static SENSOR_DEVICE_ATTR(in0_max, S_IRUGO | S_IWUSR,
342                 get_in_max, set_in_max, 0);
343 static SENSOR_DEVICE_ATTR(in1_max, S_IRUGO | S_IWUSR,
344                 get_in_max, set_in_max, 1);
345 static SENSOR_DEVICE_ATTR(in2_max, S_IRUGO | S_IWUSR,
346                 get_in_max, set_in_max, 2);
347 static SENSOR_DEVICE_ATTR(in3_max, S_IRUGO | S_IWUSR,
348                 get_in_max, set_in_max, 3);
349 static SENSOR_DEVICE_ATTR(in4_max, S_IRUGO | S_IWUSR,
350                 get_in_max, set_in_max, 4);
351
352 #define DIV_FROM_REG(val) (1 << (val))
353 #define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : (480000 / ((val) << (div))))
354
355 #define FAN_BASE(div)           (480000 >> (div))
356 #define FAN_CLAMP(val, div)     clamp_val(val, FAN_BASE(div) / 255, \
357                                           FAN_BASE(div))
358 #define FAN_TO_REG(val, div)    ((val) == 0 ? 0 : \
359                                  DIV_ROUND_CLOSEST(480000, \
360                                                 FAN_CLAMP(val, div) << (div)))
361
362 static ssize_t get_fan_input(struct device *dev, struct device_attribute *attr,
363                              char *buf)
364 {
365         int n = to_sensor_dev_attr(attr)->index;
366         struct gl520_data *data = gl520_update_device(dev);
367
368         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_input[n],
369                                                  data->fan_div[n]));
370 }
371
372 static ssize_t get_fan_min(struct device *dev, struct device_attribute *attr,
373                            char *buf)
374 {
375         int n = to_sensor_dev_attr(attr)->index;
376         struct gl520_data *data = gl520_update_device(dev);
377
378         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[n],
379                                                  data->fan_div[n]));
380 }
381
382 static ssize_t get_fan_div(struct device *dev, struct device_attribute *attr,
383                            char *buf)
384 {
385         int n = to_sensor_dev_attr(attr)->index;
386         struct gl520_data *data = gl520_update_device(dev);
387
388         return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[n]));
389 }
390
391 static ssize_t fan1_off_show(struct device *dev,
392                              struct device_attribute *attr, char *buf)
393 {
394         struct gl520_data *data = gl520_update_device(dev);
395         return sprintf(buf, "%d\n", data->fan_off);
396 }
397
398 static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
399                            const char *buf, size_t count)
400 {
401         struct gl520_data *data = dev_get_drvdata(dev);
402         struct i2c_client *client = data->client;
403         int n = to_sensor_dev_attr(attr)->index;
404         u8 r;
405         unsigned long v;
406         int err;
407
408         err = kstrtoul(buf, 10, &v);
409         if (err)
410                 return err;
411
412         mutex_lock(&data->update_lock);
413         r = FAN_TO_REG(v, data->fan_div[n]);
414         data->fan_min[n] = r;
415
416         if (n == 0)
417                 gl520_write_value(client, GL520_REG_FAN_MIN,
418                                   (gl520_read_value(client, GL520_REG_FAN_MIN)
419                                    & ~0xff00) | (r << 8));
420         else
421                 gl520_write_value(client, GL520_REG_FAN_MIN,
422                                   (gl520_read_value(client, GL520_REG_FAN_MIN)
423                                    & ~0xff) | r);
424
425         data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK);
426         if (data->fan_min[n] == 0)
427                 data->alarm_mask &= (n == 0) ? ~0x20 : ~0x40;
428         else
429                 data->alarm_mask |= (n == 0) ? 0x20 : 0x40;
430         data->beep_mask &= data->alarm_mask;
431         gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask);
432
433         mutex_unlock(&data->update_lock);
434         return count;
435 }
436
437 static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr,
438                            const char *buf, size_t count)
439 {
440         struct gl520_data *data = dev_get_drvdata(dev);
441         struct i2c_client *client = data->client;
442         int n = to_sensor_dev_attr(attr)->index;
443         u8 r;
444         unsigned long v;
445         int err;
446
447         err = kstrtoul(buf, 10, &v);
448         if (err)
449                 return err;
450
451         switch (v) {
452         case 1:
453                 r = 0;
454                 break;
455         case 2:
456                 r = 1;
457                 break;
458         case 4:
459                 r = 2;
460                 break;
461         case 8:
462                 r = 3;
463                 break;
464         default:
465                 dev_err(&client->dev,
466         "fan_div value %ld not supported. Choose one of 1, 2, 4 or 8!\n", v);
467                 return -EINVAL;
468         }
469
470         mutex_lock(&data->update_lock);
471         data->fan_div[n] = r;
472
473         if (n == 0)
474                 gl520_write_value(client, GL520_REG_FAN_DIV,
475                                   (gl520_read_value(client, GL520_REG_FAN_DIV)
476                                    & ~0xc0) | (r << 6));
477         else
478                 gl520_write_value(client, GL520_REG_FAN_DIV,
479                                   (gl520_read_value(client, GL520_REG_FAN_DIV)
480                                    & ~0x30) | (r << 4));
481
482         mutex_unlock(&data->update_lock);
483         return count;
484 }
485
486 static ssize_t fan1_off_store(struct device *dev,
487                               struct device_attribute *attr, const char *buf,
488                               size_t count)
489 {
490         struct gl520_data *data = dev_get_drvdata(dev);
491         struct i2c_client *client = data->client;
492         u8 r;
493         unsigned long v;
494         int err;
495
496         err = kstrtoul(buf, 10, &v);
497         if (err)
498                 return err;
499
500         r = (v ? 1 : 0);
501
502         mutex_lock(&data->update_lock);
503         data->fan_off = r;
504         gl520_write_value(client, GL520_REG_FAN_OFF,
505                           (gl520_read_value(client, GL520_REG_FAN_OFF)
506                            & ~0x0c) | (r << 2));
507         mutex_unlock(&data->update_lock);
508         return count;
509 }
510
511 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, get_fan_input, NULL, 0);
512 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, get_fan_input, NULL, 1);
513 static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO | S_IWUSR,
514                 get_fan_min, set_fan_min, 0);
515 static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO | S_IWUSR,
516                 get_fan_min, set_fan_min, 1);
517 static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
518                 get_fan_div, set_fan_div, 0);
519 static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
520                 get_fan_div, set_fan_div, 1);
521 static DEVICE_ATTR_RW(fan1_off);
522
523 #define TEMP_FROM_REG(val)      (((val) - 130) * 1000)
524 #define TEMP_CLAMP(val)         clamp_val(val, -130000, 125000)
525 #define TEMP_TO_REG(val)        (DIV_ROUND_CLOSEST(TEMP_CLAMP(val), 1000) + 130)
526
527 static ssize_t get_temp_input(struct device *dev, struct device_attribute *attr,
528                               char *buf)
529 {
530         int n = to_sensor_dev_attr(attr)->index;
531         struct gl520_data *data = gl520_update_device(dev);
532
533         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_input[n]));
534 }
535
536 static ssize_t get_temp_max(struct device *dev, struct device_attribute *attr,
537                             char *buf)
538 {
539         int n = to_sensor_dev_attr(attr)->index;
540         struct gl520_data *data = gl520_update_device(dev);
541
542         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[n]));
543 }
544
545 static ssize_t get_temp_max_hyst(struct device *dev,
546                                  struct device_attribute *attr, char *buf)
547 {
548         int n = to_sensor_dev_attr(attr)->index;
549         struct gl520_data *data = gl520_update_device(dev);
550
551         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max_hyst[n]));
552 }
553
554 static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
555                             const char *buf, size_t count)
556 {
557         struct gl520_data *data = dev_get_drvdata(dev);
558         struct i2c_client *client = data->client;
559         int n = to_sensor_dev_attr(attr)->index;
560         long v;
561         int err;
562
563         err = kstrtol(buf, 10, &v);
564         if (err)
565                 return err;
566
567         mutex_lock(&data->update_lock);
568         data->temp_max[n] = TEMP_TO_REG(v);
569         gl520_write_value(client, GL520_REG_TEMP_MAX[n], data->temp_max[n]);
570         mutex_unlock(&data->update_lock);
571         return count;
572 }
573
574 static ssize_t set_temp_max_hyst(struct device *dev, struct device_attribute
575                                  *attr, const char *buf, size_t count)
576 {
577         struct gl520_data *data = dev_get_drvdata(dev);
578         struct i2c_client *client = data->client;
579         int n = to_sensor_dev_attr(attr)->index;
580         long v;
581         int err;
582
583         err = kstrtol(buf, 10, &v);
584         if (err)
585                 return err;
586
587         mutex_lock(&data->update_lock);
588         data->temp_max_hyst[n] = TEMP_TO_REG(v);
589         gl520_write_value(client, GL520_REG_TEMP_MAX_HYST[n],
590                           data->temp_max_hyst[n]);
591         mutex_unlock(&data->update_lock);
592         return count;
593 }
594
595 static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, get_temp_input, NULL, 0);
596 static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, get_temp_input, NULL, 1);
597 static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
598                 get_temp_max, set_temp_max, 0);
599 static SENSOR_DEVICE_ATTR(temp2_max, S_IRUGO | S_IWUSR,
600                 get_temp_max, set_temp_max, 1);
601 static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
602                 get_temp_max_hyst, set_temp_max_hyst, 0);
603 static SENSOR_DEVICE_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR,
604                 get_temp_max_hyst, set_temp_max_hyst, 1);
605
606 static ssize_t alarms_show(struct device *dev, struct device_attribute *attr,
607                            char *buf)
608 {
609         struct gl520_data *data = gl520_update_device(dev);
610         return sprintf(buf, "%d\n", data->alarms);
611 }
612
613 static ssize_t beep_enable_show(struct device *dev,
614                                 struct device_attribute *attr, char *buf)
615 {
616         struct gl520_data *data = gl520_update_device(dev);
617         return sprintf(buf, "%d\n", data->beep_enable);
618 }
619
620 static ssize_t beep_mask_show(struct device *dev,
621                               struct device_attribute *attr, char *buf)
622 {
623         struct gl520_data *data = gl520_update_device(dev);
624         return sprintf(buf, "%d\n", data->beep_mask);
625 }
626
627 static ssize_t beep_enable_store(struct device *dev,
628                                  struct device_attribute *attr,
629                                  const char *buf, size_t count)
630 {
631         struct gl520_data *data = dev_get_drvdata(dev);
632         struct i2c_client *client = data->client;
633         u8 r;
634         unsigned long v;
635         int err;
636
637         err = kstrtoul(buf, 10, &v);
638         if (err)
639                 return err;
640
641         r = (v ? 0 : 1);
642
643         mutex_lock(&data->update_lock);
644         data->beep_enable = !r;
645         gl520_write_value(client, GL520_REG_BEEP_ENABLE,
646                           (gl520_read_value(client, GL520_REG_BEEP_ENABLE)
647                            & ~0x04) | (r << 2));
648         mutex_unlock(&data->update_lock);
649         return count;
650 }
651
652 static ssize_t beep_mask_store(struct device *dev,
653                                struct device_attribute *attr, const char *buf,
654                                size_t count)
655 {
656         struct gl520_data *data = dev_get_drvdata(dev);
657         struct i2c_client *client = data->client;
658         unsigned long r;
659         int err;
660
661         err = kstrtoul(buf, 10, &r);
662         if (err)
663                 return err;
664
665         mutex_lock(&data->update_lock);
666         r &= data->alarm_mask;
667         data->beep_mask = r;
668         gl520_write_value(client, GL520_REG_BEEP_MASK, r);
669         mutex_unlock(&data->update_lock);
670         return count;
671 }
672
673 static DEVICE_ATTR_RO(alarms);
674 static DEVICE_ATTR_RW(beep_enable);
675 static DEVICE_ATTR_RW(beep_mask);
676
677 static ssize_t get_alarm(struct device *dev, struct device_attribute *attr,
678                          char *buf)
679 {
680         int bit_nr = to_sensor_dev_attr(attr)->index;
681         struct gl520_data *data = gl520_update_device(dev);
682
683         return sprintf(buf, "%d\n", (data->alarms >> bit_nr) & 1);
684 }
685
686 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, get_alarm, NULL, 0);
687 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, get_alarm, NULL, 1);
688 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, get_alarm, NULL, 2);
689 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, get_alarm, NULL, 3);
690 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, get_alarm, NULL, 4);
691 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, get_alarm, NULL, 5);
692 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, get_alarm, NULL, 6);
693 static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, get_alarm, NULL, 7);
694 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, get_alarm, NULL, 7);
695
696 static ssize_t get_beep(struct device *dev, struct device_attribute *attr,
697                         char *buf)
698 {
699         int bitnr = to_sensor_dev_attr(attr)->index;
700         struct gl520_data *data = gl520_update_device(dev);
701
702         return sprintf(buf, "%d\n", (data->beep_mask >> bitnr) & 1);
703 }
704
705 static ssize_t set_beep(struct device *dev, struct device_attribute *attr,
706                         const char *buf, size_t count)
707 {
708         struct gl520_data *data = dev_get_drvdata(dev);
709         struct i2c_client *client = data->client;
710         int bitnr = to_sensor_dev_attr(attr)->index;
711         unsigned long bit;
712
713         int err;
714
715         err = kstrtoul(buf, 10, &bit);
716         if (err)
717                 return err;
718         if (bit & ~1)
719                 return -EINVAL;
720
721         mutex_lock(&data->update_lock);
722         data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK);
723         if (bit)
724                 data->beep_mask |= (1 << bitnr);
725         else
726                 data->beep_mask &= ~(1 << bitnr);
727         gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask);
728         mutex_unlock(&data->update_lock);
729         return count;
730 }
731
732 static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 0);
733 static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 1);
734 static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 2);
735 static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 3);
736 static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 4);
737 static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 5);
738 static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 6);
739 static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 7);
740 static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 7);
741
742 static struct attribute *gl520_attributes[] = {
743         &dev_attr_cpu0_vid.attr,
744
745         &sensor_dev_attr_in0_input.dev_attr.attr,
746         &sensor_dev_attr_in0_min.dev_attr.attr,
747         &sensor_dev_attr_in0_max.dev_attr.attr,
748         &sensor_dev_attr_in0_alarm.dev_attr.attr,
749         &sensor_dev_attr_in0_beep.dev_attr.attr,
750         &sensor_dev_attr_in1_input.dev_attr.attr,
751         &sensor_dev_attr_in1_min.dev_attr.attr,
752         &sensor_dev_attr_in1_max.dev_attr.attr,
753         &sensor_dev_attr_in1_alarm.dev_attr.attr,
754         &sensor_dev_attr_in1_beep.dev_attr.attr,
755         &sensor_dev_attr_in2_input.dev_attr.attr,
756         &sensor_dev_attr_in2_min.dev_attr.attr,
757         &sensor_dev_attr_in2_max.dev_attr.attr,
758         &sensor_dev_attr_in2_alarm.dev_attr.attr,
759         &sensor_dev_attr_in2_beep.dev_attr.attr,
760         &sensor_dev_attr_in3_input.dev_attr.attr,
761         &sensor_dev_attr_in3_min.dev_attr.attr,
762         &sensor_dev_attr_in3_max.dev_attr.attr,
763         &sensor_dev_attr_in3_alarm.dev_attr.attr,
764         &sensor_dev_attr_in3_beep.dev_attr.attr,
765
766         &sensor_dev_attr_fan1_input.dev_attr.attr,
767         &sensor_dev_attr_fan1_min.dev_attr.attr,
768         &sensor_dev_attr_fan1_div.dev_attr.attr,
769         &sensor_dev_attr_fan1_alarm.dev_attr.attr,
770         &sensor_dev_attr_fan1_beep.dev_attr.attr,
771         &dev_attr_fan1_off.attr,
772         &sensor_dev_attr_fan2_input.dev_attr.attr,
773         &sensor_dev_attr_fan2_min.dev_attr.attr,
774         &sensor_dev_attr_fan2_div.dev_attr.attr,
775         &sensor_dev_attr_fan2_alarm.dev_attr.attr,
776         &sensor_dev_attr_fan2_beep.dev_attr.attr,
777
778         &sensor_dev_attr_temp1_input.dev_attr.attr,
779         &sensor_dev_attr_temp1_max.dev_attr.attr,
780         &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
781         &sensor_dev_attr_temp1_alarm.dev_attr.attr,
782         &sensor_dev_attr_temp1_beep.dev_attr.attr,
783
784         &dev_attr_alarms.attr,
785         &dev_attr_beep_enable.attr,
786         &dev_attr_beep_mask.attr,
787         NULL
788 };
789
790 static const struct attribute_group gl520_group = {
791         .attrs = gl520_attributes,
792 };
793
794 static struct attribute *gl520_attributes_in4[] = {
795         &sensor_dev_attr_in4_input.dev_attr.attr,
796         &sensor_dev_attr_in4_min.dev_attr.attr,
797         &sensor_dev_attr_in4_max.dev_attr.attr,
798         &sensor_dev_attr_in4_alarm.dev_attr.attr,
799         &sensor_dev_attr_in4_beep.dev_attr.attr,
800         NULL
801 };
802
803 static struct attribute *gl520_attributes_temp2[] = {
804         &sensor_dev_attr_temp2_input.dev_attr.attr,
805         &sensor_dev_attr_temp2_max.dev_attr.attr,
806         &sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
807         &sensor_dev_attr_temp2_alarm.dev_attr.attr,
808         &sensor_dev_attr_temp2_beep.dev_attr.attr,
809         NULL
810 };
811
812 static const struct attribute_group gl520_group_in4 = {
813         .attrs = gl520_attributes_in4,
814 };
815
816 static const struct attribute_group gl520_group_temp2 = {
817         .attrs = gl520_attributes_temp2,
818 };
819
820
821 /*
822  * Real code
823  */
824
825 /* Return 0 if detection is successful, -ENODEV otherwise */
826 static int gl520_detect(struct i2c_client *client, struct i2c_board_info *info)
827 {
828         struct i2c_adapter *adapter = client->adapter;
829
830         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
831                                      I2C_FUNC_SMBUS_WORD_DATA))
832                 return -ENODEV;
833
834         /* Determine the chip type. */
835         if ((gl520_read_value(client, GL520_REG_CHIP_ID) != 0x20) ||
836             ((gl520_read_value(client, GL520_REG_REVISION) & 0x7f) != 0x00) ||
837             ((gl520_read_value(client, GL520_REG_CONF) & 0x80) != 0x00)) {
838                 dev_dbg(&client->dev, "Unknown chip type, skipping\n");
839                 return -ENODEV;
840         }
841
842         strlcpy(info->type, "gl520sm", I2C_NAME_SIZE);
843
844         return 0;
845 }
846
847 /* Called when we have found a new GL520SM. */
848 static void gl520_init_client(struct i2c_client *client)
849 {
850         struct gl520_data *data = i2c_get_clientdata(client);
851         u8 oldconf, conf;
852
853         conf = oldconf = gl520_read_value(client, GL520_REG_CONF);
854
855         data->alarm_mask = 0xff;
856         data->vrm = vid_which_vrm();
857
858         if (extra_sensor_type == 1)
859                 conf &= ~0x10;
860         else if (extra_sensor_type == 2)
861                 conf |= 0x10;
862         data->two_temps = !(conf & 0x10);
863
864         /* If IRQ# is disabled, we can safely force comparator mode */
865         if (!(conf & 0x20))
866                 conf &= 0xf7;
867
868         /* Enable monitoring if needed */
869         conf |= 0x40;
870
871         if (conf != oldconf)
872                 gl520_write_value(client, GL520_REG_CONF, conf);
873
874         gl520_update_device(&(client->dev));
875
876         if (data->fan_min[0] == 0)
877                 data->alarm_mask &= ~0x20;
878         if (data->fan_min[1] == 0)
879                 data->alarm_mask &= ~0x40;
880
881         data->beep_mask &= data->alarm_mask;
882         gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask);
883 }
884
885 static int gl520_probe(struct i2c_client *client,
886                        const struct i2c_device_id *id)
887 {
888         struct device *dev = &client->dev;
889         struct device *hwmon_dev;
890         struct gl520_data *data;
891
892         data = devm_kzalloc(dev, sizeof(struct gl520_data), GFP_KERNEL);
893         if (!data)
894                 return -ENOMEM;
895
896         i2c_set_clientdata(client, data);
897         mutex_init(&data->update_lock);
898         data->client = client;
899
900         /* Initialize the GL520SM chip */
901         gl520_init_client(client);
902
903         /* sysfs hooks */
904         data->groups[0] = &gl520_group;
905
906         if (data->two_temps)
907                 data->groups[1] = &gl520_group_temp2;
908         else
909                 data->groups[1] = &gl520_group_in4;
910
911         hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name,
912                                                            data, data->groups);
913         return PTR_ERR_OR_ZERO(hwmon_dev);
914 }
915
916 static const struct i2c_device_id gl520_id[] = {
917         { "gl520sm", 0 },
918         { }
919 };
920 MODULE_DEVICE_TABLE(i2c, gl520_id);
921
922 static struct i2c_driver gl520_driver = {
923         .class          = I2C_CLASS_HWMON,
924         .driver = {
925                 .name   = "gl520sm",
926         },
927         .probe          = gl520_probe,
928         .id_table       = gl520_id,
929         .detect         = gl520_detect,
930         .address_list   = normal_i2c,
931 };
932
933 module_i2c_driver(gl520_driver);
934
935 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
936         "Kyösti Mälkki <kmalkki@cc.hut.fi>, "
937         "Maarten Deprez <maartendeprez@users.sourceforge.net>");
938 MODULE_DESCRIPTION("GL520SM driver");
939 MODULE_LICENSE("GPL");