Linux Audio

Check our new training course

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