ipc: optimize semget/shmget/msgget for lots of keys
[linux/fpc-iii.git] / drivers / hwmon / gl520sm.c
blob4ff32ee67fb618e34b786c365a5d26f73f649caa
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>
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.
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.
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.
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>
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)");
41 /* Addresses to scan */
42 static const unsigned short normal_i2c[] = { 0x2c, 0x2d, I2C_CLIENT_END };
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
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
56 #define GL520_REG_VID_INPUT 0x02
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 };
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 };
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
72 #define GL520_REG_ALARMS 0x12
73 #define GL520_REG_BEEP_MASK 0x10
74 #define GL520_REG_BEEP_ENABLE GL520_REG_CONF
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 */
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;
104 * Registers 0x07 to 0x0c are word-sized, others are byte-sized
105 * GL520 uses a high-byte first convention
107 static int gl520_read_value(struct i2c_client *client, u8 reg)
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);
115 static int gl520_write_value(struct i2c_client *client, u8 reg, u16 value)
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);
123 static struct gl520_data *gl520_update_device(struct device *dev)
125 struct gl520_data *data = dev_get_drvdata(dev);
126 struct i2c_client *client = data->client;
127 int val, i;
129 mutex_lock(&data->update_lock);
131 if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) {
133 dev_dbg(&client->dev, "Starting gl520sm update\n");
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;
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;
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;
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;
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]);
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;
168 data->alarms &= data->alarm_mask;
170 val = gl520_read_value(client, GL520_REG_CONF);
171 data->beep_enable = !((val >> 2) & 1);
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]);
190 data->last_updated = jiffies;
191 data->valid = 1;
194 mutex_unlock(&data->update_lock);
196 return data;
200 * Sysfs stuff
203 static ssize_t cpu0_vid_show(struct device *dev,
204 struct device_attribute *attr, char *buf)
206 struct gl520_data *data = gl520_update_device(dev);
207 return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm));
209 static DEVICE_ATTR_RO(cpu0_vid);
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)
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)
219 static ssize_t get_in_input(struct device *dev, struct device_attribute *attr,
220 char *buf)
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];
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));
232 static ssize_t get_in_min(struct device *dev, struct device_attribute *attr,
233 char *buf)
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];
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));
245 static ssize_t get_in_max(struct device *dev, struct device_attribute *attr,
246 char *buf)
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];
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));
258 static ssize_t set_in_min(struct device *dev, struct device_attribute *attr,
259 const char *buf, size_t count)
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;
268 err = kstrtol(buf, 10, &v);
269 if (err)
270 return err;
272 mutex_lock(&data->update_lock);
274 if (n == 0)
275 r = VDD_TO_REG(v);
276 else
277 r = IN_TO_REG(v);
279 data->in_min[n] = r;
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);
288 mutex_unlock(&data->update_lock);
289 return count;
292 static ssize_t set_in_max(struct device *dev, struct device_attribute *attr,
293 const char *buf, size_t count)
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;
302 err = kstrtol(buf, 10, &v);
303 if (err)
304 return err;
306 if (n == 0)
307 r = VDD_TO_REG(v);
308 else
309 r = IN_TO_REG(v);
311 mutex_lock(&data->update_lock);
313 data->in_max[n] = r;
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);
322 mutex_unlock(&data->update_lock);
323 return count;
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);
352 #define DIV_FROM_REG(val) (1 << (val))
353 #define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : (480000 / ((val) << (div))))
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)))
362 static ssize_t get_fan_input(struct device *dev, struct device_attribute *attr,
363 char *buf)
365 int n = to_sensor_dev_attr(attr)->index;
366 struct gl520_data *data = gl520_update_device(dev);
368 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_input[n],
369 data->fan_div[n]));
372 static ssize_t get_fan_min(struct device *dev, struct device_attribute *attr,
373 char *buf)
375 int n = to_sensor_dev_attr(attr)->index;
376 struct gl520_data *data = gl520_update_device(dev);
378 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[n],
379 data->fan_div[n]));
382 static ssize_t get_fan_div(struct device *dev, struct device_attribute *attr,
383 char *buf)
385 int n = to_sensor_dev_attr(attr)->index;
386 struct gl520_data *data = gl520_update_device(dev);
388 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[n]));
391 static ssize_t fan1_off_show(struct device *dev,
392 struct device_attribute *attr, char *buf)
394 struct gl520_data *data = gl520_update_device(dev);
395 return sprintf(buf, "%d\n", data->fan_off);
398 static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
399 const char *buf, size_t count)
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;
408 err = kstrtoul(buf, 10, &v);
409 if (err)
410 return err;
412 mutex_lock(&data->update_lock);
413 r = FAN_TO_REG(v, data->fan_div[n]);
414 data->fan_min[n] = r;
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);
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);
433 mutex_unlock(&data->update_lock);
434 return count;
437 static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr,
438 const char *buf, size_t count)
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;
447 err = kstrtoul(buf, 10, &v);
448 if (err)
449 return err;
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;
470 mutex_lock(&data->update_lock);
471 data->fan_div[n] = r;
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));
482 mutex_unlock(&data->update_lock);
483 return count;
486 static ssize_t fan1_off_store(struct device *dev,
487 struct device_attribute *attr, const char *buf,
488 size_t count)
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;
496 err = kstrtoul(buf, 10, &v);
497 if (err)
498 return err;
500 r = (v ? 1 : 0);
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;
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);
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)
527 static ssize_t get_temp_input(struct device *dev, struct device_attribute *attr,
528 char *buf)
530 int n = to_sensor_dev_attr(attr)->index;
531 struct gl520_data *data = gl520_update_device(dev);
533 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_input[n]));
536 static ssize_t get_temp_max(struct device *dev, struct device_attribute *attr,
537 char *buf)
539 int n = to_sensor_dev_attr(attr)->index;
540 struct gl520_data *data = gl520_update_device(dev);
542 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[n]));
545 static ssize_t get_temp_max_hyst(struct device *dev,
546 struct device_attribute *attr, char *buf)
548 int n = to_sensor_dev_attr(attr)->index;
549 struct gl520_data *data = gl520_update_device(dev);
551 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max_hyst[n]));
554 static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
555 const char *buf, size_t count)
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;
563 err = kstrtol(buf, 10, &v);
564 if (err)
565 return err;
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;
574 static ssize_t set_temp_max_hyst(struct device *dev, struct device_attribute
575 *attr, const char *buf, size_t count)
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;
583 err = kstrtol(buf, 10, &v);
584 if (err)
585 return err;
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;
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);
606 static ssize_t alarms_show(struct device *dev, struct device_attribute *attr,
607 char *buf)
609 struct gl520_data *data = gl520_update_device(dev);
610 return sprintf(buf, "%d\n", data->alarms);
613 static ssize_t beep_enable_show(struct device *dev,
614 struct device_attribute *attr, char *buf)
616 struct gl520_data *data = gl520_update_device(dev);
617 return sprintf(buf, "%d\n", data->beep_enable);
620 static ssize_t beep_mask_show(struct device *dev,
621 struct device_attribute *attr, char *buf)
623 struct gl520_data *data = gl520_update_device(dev);
624 return sprintf(buf, "%d\n", data->beep_mask);
627 static ssize_t beep_enable_store(struct device *dev,
628 struct device_attribute *attr,
629 const char *buf, size_t count)
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;
637 err = kstrtoul(buf, 10, &v);
638 if (err)
639 return err;
641 r = (v ? 0 : 1);
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;
652 static ssize_t beep_mask_store(struct device *dev,
653 struct device_attribute *attr, const char *buf,
654 size_t count)
656 struct gl520_data *data = dev_get_drvdata(dev);
657 struct i2c_client *client = data->client;
658 unsigned long r;
659 int err;
661 err = kstrtoul(buf, 10, &r);
662 if (err)
663 return err;
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;
673 static DEVICE_ATTR_RO(alarms);
674 static DEVICE_ATTR_RW(beep_enable);
675 static DEVICE_ATTR_RW(beep_mask);
677 static ssize_t get_alarm(struct device *dev, struct device_attribute *attr,
678 char *buf)
680 int bit_nr = to_sensor_dev_attr(attr)->index;
681 struct gl520_data *data = gl520_update_device(dev);
683 return sprintf(buf, "%d\n", (data->alarms >> bit_nr) & 1);
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);
696 static ssize_t get_beep(struct device *dev, struct device_attribute *attr,
697 char *buf)
699 int bitnr = to_sensor_dev_attr(attr)->index;
700 struct gl520_data *data = gl520_update_device(dev);
702 return sprintf(buf, "%d\n", (data->beep_mask >> bitnr) & 1);
705 static ssize_t set_beep(struct device *dev, struct device_attribute *attr,
706 const char *buf, size_t count)
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;
713 int err;
715 err = kstrtoul(buf, 10, &bit);
716 if (err)
717 return err;
718 if (bit & ~1)
719 return -EINVAL;
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;
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);
742 static struct attribute *gl520_attributes[] = {
743 &dev_attr_cpu0_vid.attr,
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,
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,
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,
784 &dev_attr_alarms.attr,
785 &dev_attr_beep_enable.attr,
786 &dev_attr_beep_mask.attr,
787 NULL
790 static const struct attribute_group gl520_group = {
791 .attrs = gl520_attributes,
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
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
812 static const struct attribute_group gl520_group_in4 = {
813 .attrs = gl520_attributes_in4,
816 static const struct attribute_group gl520_group_temp2 = {
817 .attrs = gl520_attributes_temp2,
822 * Real code
825 /* Return 0 if detection is successful, -ENODEV otherwise */
826 static int gl520_detect(struct i2c_client *client, struct i2c_board_info *info)
828 struct i2c_adapter *adapter = client->adapter;
830 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
831 I2C_FUNC_SMBUS_WORD_DATA))
832 return -ENODEV;
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;
842 strlcpy(info->type, "gl520sm", I2C_NAME_SIZE);
844 return 0;
847 /* Called when we have found a new GL520SM. */
848 static void gl520_init_client(struct i2c_client *client)
850 struct gl520_data *data = i2c_get_clientdata(client);
851 u8 oldconf, conf;
853 conf = oldconf = gl520_read_value(client, GL520_REG_CONF);
855 data->alarm_mask = 0xff;
856 data->vrm = vid_which_vrm();
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);
864 /* If IRQ# is disabled, we can safely force comparator mode */
865 if (!(conf & 0x20))
866 conf &= 0xf7;
868 /* Enable monitoring if needed */
869 conf |= 0x40;
871 if (conf != oldconf)
872 gl520_write_value(client, GL520_REG_CONF, conf);
874 gl520_update_device(&(client->dev));
876 if (data->fan_min[0] == 0)
877 data->alarm_mask &= ~0x20;
878 if (data->fan_min[1] == 0)
879 data->alarm_mask &= ~0x40;
881 data->beep_mask &= data->alarm_mask;
882 gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask);
885 static int gl520_probe(struct i2c_client *client,
886 const struct i2c_device_id *id)
888 struct device *dev = &client->dev;
889 struct device *hwmon_dev;
890 struct gl520_data *data;
892 data = devm_kzalloc(dev, sizeof(struct gl520_data), GFP_KERNEL);
893 if (!data)
894 return -ENOMEM;
896 i2c_set_clientdata(client, data);
897 mutex_init(&data->update_lock);
898 data->client = client;
900 /* Initialize the GL520SM chip */
901 gl520_init_client(client);
903 /* sysfs hooks */
904 data->groups[0] = &gl520_group;
906 if (data->two_temps)
907 data->groups[1] = &gl520_group_temp2;
908 else
909 data->groups[1] = &gl520_group_in4;
911 hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name,
912 data, data->groups);
913 return PTR_ERR_OR_ZERO(hwmon_dev);
916 static const struct i2c_device_id gl520_id[] = {
917 { "gl520sm", 0 },
920 MODULE_DEVICE_TABLE(i2c, gl520_id);
922 static struct i2c_driver gl520_driver = {
923 .class = I2C_CLASS_HWMON,
924 .driver = {
925 .name = "gl520sm",
927 .probe = gl520_probe,
928 .id_table = gl520_id,
929 .detect = gl520_detect,
930 .address_list = normal_i2c,
933 module_i2c_driver(gl520_driver);
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");