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