adm1031.c 31.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7
/*
  adm1031.c - Part of lm_sensors, Linux kernel modules for hardware
  monitoring
  Based on lm75.c and lm85.c
  Supports adm1030 / adm1031
  Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org>
  Reworked by Jean Delvare <khali@linux-fr.org>
J
Jean Delvare 已提交
8

L
Linus Torvalds 已提交
9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
  This program is free software; you can redistribute it and/or modify
  it under the terms of the GNU General Public License as published by
  the Free Software Foundation; either version 2 of the License, or
  (at your option) any later version.

  This program is distributed in the hope that it will be useful,
  but WITHOUT ANY WARRANTY; without even the implied warranty of
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  GNU General Public License for more details.

  You should have received a copy of the GNU General Public License
  along with this program; if not, write to the Free Software
  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/jiffies.h>
#include <linux/i2c.h>
29
#include <linux/hwmon.h>
30
#include <linux/hwmon-sysfs.h>
31
#include <linux/err.h>
32
#include <linux/mutex.h>
L
Linus Torvalds 已提交
33 34 35

/* Following macros takes channel parameter starting from 0 to 2 */
#define ADM1031_REG_FAN_SPEED(nr)	(0x08 + (nr))
J
Jean Delvare 已提交
36
#define ADM1031_REG_FAN_DIV(nr)		(0x20 + (nr))
L
Linus Torvalds 已提交
37 38 39
#define ADM1031_REG_PWM			(0x22)
#define ADM1031_REG_FAN_MIN(nr)		(0x10 + (nr))

40
#define ADM1031_REG_TEMP_OFFSET(nr)	(0x0d + (nr))
J
Jean Delvare 已提交
41 42 43
#define ADM1031_REG_TEMP_MAX(nr)	(0x14 + 4 * (nr))
#define ADM1031_REG_TEMP_MIN(nr)	(0x15 + 4 * (nr))
#define ADM1031_REG_TEMP_CRIT(nr)	(0x16 + 4 * (nr))
L
Linus Torvalds 已提交
44

J
Jean Delvare 已提交
45
#define ADM1031_REG_TEMP(nr)		(0x0a + (nr))
L
Linus Torvalds 已提交
46 47 48 49
#define ADM1031_REG_AUTO_TEMP(nr)	(0x24 + (nr))

#define ADM1031_REG_STATUS(nr)		(0x2 + (nr))

J
Jean Delvare 已提交
50 51 52
#define ADM1031_REG_CONF1		0x00
#define ADM1031_REG_CONF2		0x01
#define ADM1031_REG_EXT_TEMP		0x06
L
Linus Torvalds 已提交
53 54 55 56 57 58 59 60 61 62 63 64

#define ADM1031_CONF1_MONITOR_ENABLE	0x01	/* Monitoring enable */
#define ADM1031_CONF1_PWM_INVERT	0x08	/* PWM Invert */
#define ADM1031_CONF1_AUTO_MODE		0x80	/* Auto FAN */

#define ADM1031_CONF2_PWM1_ENABLE	0x01
#define ADM1031_CONF2_PWM2_ENABLE	0x02
#define ADM1031_CONF2_TACH1_ENABLE	0x04
#define ADM1031_CONF2_TACH2_ENABLE	0x08
#define ADM1031_CONF2_TEMP_ENABLE(chan)	(0x10 << (chan))

/* Addresses to scan */
65
static const unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
L
Linus Torvalds 已提交
66 67

/* Insmod parameters */
68
I2C_CLIENT_INSMOD_2(adm1030, adm1031);
L
Linus Torvalds 已提交
69 70 71 72 73

typedef u8 auto_chan_table_t[8][2];

/* Each client has this additional data */
struct adm1031_data {
74
	struct device *hwmon_dev;
75
	struct mutex update_lock;
L
Linus Torvalds 已提交
76 77 78 79 80 81
	int chip_type;
	char valid;		/* !=0 if following fields are valid */
	unsigned long last_updated;	/* In jiffies */
	/* The chan_select_table contains the possible configurations for
	 * auto fan control.
	 */
J
Jean Delvare 已提交
82
	const auto_chan_table_t *chan_select_table;
L
Linus Torvalds 已提交
83 84 85 86 87 88 89 90 91 92 93 94 95 96
	u16 alarm;
	u8 conf1;
	u8 conf2;
	u8 fan[2];
	u8 fan_div[2];
	u8 fan_min[2];
	u8 pwm[2];
	u8 old_pwm[2];
	s8 temp[3];
	u8 ext_temp[3];
	u8 auto_temp[3];
	u8 auto_temp_min[3];
	u8 auto_temp_off[3];
	u8 auto_temp_max[3];
97
	s8 temp_offset[3];
L
Linus Torvalds 已提交
98 99 100 101 102
	s8 temp_min[3];
	s8 temp_max[3];
	s8 temp_crit[3];
};

103 104
static int adm1031_probe(struct i2c_client *client,
			 const struct i2c_device_id *id);
105
static int adm1031_detect(struct i2c_client *client,
106
			  struct i2c_board_info *info);
L
Linus Torvalds 已提交
107
static void adm1031_init_client(struct i2c_client *client);
108
static int adm1031_remove(struct i2c_client *client);
L
Linus Torvalds 已提交
109 110
static struct adm1031_data *adm1031_update_device(struct device *dev);

111 112 113 114 115 116 117
static const struct i2c_device_id adm1031_id[] = {
	{ "adm1030", adm1030 },
	{ "adm1031", adm1031 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, adm1031_id);

L
Linus Torvalds 已提交
118 119
/* This is the driver that will be inserted */
static struct i2c_driver adm1031_driver = {
120
	.class		= I2C_CLASS_HWMON,
121 122 123
	.driver = {
		.name = "adm1031",
	},
124 125 126 127 128
	.probe		= adm1031_probe,
	.remove		= adm1031_remove,
	.id_table	= adm1031_id,
	.detect		= adm1031_detect,
	.address_data	= &addr_data,
L
Linus Torvalds 已提交
129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149
};

static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg)
{
	return i2c_smbus_read_byte_data(client, reg);
}

static inline int
adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value)
{
	return i2c_smbus_write_byte_data(client, reg, value);
}


#define TEMP_TO_REG(val)		(((val) < 0 ? ((val - 500) / 1000) : \
					((val + 500) / 1000)))

#define TEMP_FROM_REG(val)		((val) * 1000)

#define TEMP_FROM_REG_EXT(val, ext)	(TEMP_FROM_REG(val) + (ext) * 125)

150 151 152 153
#define TEMP_OFFSET_TO_REG(val)		(TEMP_TO_REG(val) & 0x8f)
#define TEMP_OFFSET_FROM_REG(val)	TEMP_FROM_REG((val) < 0 ? \
						      (val) | 0x70 : (val))

L
Linus Torvalds 已提交
154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
#define FAN_FROM_REG(reg, div)		((reg) ? (11250 * 60) / ((reg) * (div)) : 0)

static int FAN_TO_REG(int reg, int div)
{
	int tmp;
	tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div);
	return tmp > 255 ? 255 : tmp;
}

#define FAN_DIV_FROM_REG(reg)		(1<<(((reg)&0xc0)>>6))

#define PWM_TO_REG(val)			(SENSORS_LIMIT((val), 0, 255) >> 4)
#define PWM_FROM_REG(val)		((val) << 4)

#define FAN_CHAN_FROM_REG(reg)		(((reg) >> 5) & 7)
#define FAN_CHAN_TO_REG(val, reg)	\
	(((reg) & 0x1F) | (((val) << 5) & 0xe0))

#define AUTO_TEMP_MIN_TO_REG(val, reg)	\
	((((val)/500) & 0xf8)|((reg) & 0x7))
#define AUTO_TEMP_RANGE_FROM_REG(reg)	(5000 * (1<< ((reg)&0x7)))
#define AUTO_TEMP_MIN_FROM_REG(reg)	(1000 * ((((reg) >> 3) & 0x1f) << 2))

#define AUTO_TEMP_MIN_FROM_REG_DEG(reg)	((((reg) >> 3) & 0x1f) << 2)

#define AUTO_TEMP_OFF_FROM_REG(reg)		\
	(AUTO_TEMP_MIN_FROM_REG(reg) - 5000)

#define AUTO_TEMP_MAX_FROM_REG(reg)		\
	(AUTO_TEMP_RANGE_FROM_REG(reg) +	\
	AUTO_TEMP_MIN_FROM_REG(reg))

static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm)
{
	int ret;
	int range = val - AUTO_TEMP_MIN_FROM_REG(reg);

	range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm);
	ret = ((reg & 0xf8) |
	       (range < 10000 ? 0 :
		range < 20000 ? 1 :
		range < 40000 ? 2 : range < 80000 ? 3 : 4));
	return ret;
}

/* FAN auto control */
#define GET_FAN_AUTO_BITFIELD(data, idx)	\
	(*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2]

J
Jean Delvare 已提交
203
/* The tables below contains the possible values for the auto fan
L
Linus Torvalds 已提交
204 205 206 207
 * control bitfields. the index in the table is the register value.
 * MSb is the auto fan control enable bit, so the four first entries
 * in the table disables auto fan control when both bitfields are zero.
 */
J
Jean Delvare 已提交
208 209 210 211 212 213
static const auto_chan_table_t auto_channel_select_table_adm1031 = {
	{ 0, 0 }, { 0, 0 }, { 0, 0 }, { 0, 0 },
	{ 2 /* 0b010 */ , 4 /* 0b100 */ },
	{ 2 /* 0b010 */ , 2 /* 0b010 */ },
	{ 4 /* 0b100 */ , 4 /* 0b100 */ },
	{ 7 /* 0b111 */ , 7 /* 0b111 */ },
L
Linus Torvalds 已提交
214 215
};

J
Jean Delvare 已提交
216 217 218 219 220 221
static const auto_chan_table_t auto_channel_select_table_adm1030 = {
	{ 0, 0 }, { 0, 0 }, { 0, 0 }, { 0, 0 },
	{ 2 /* 0b10 */		, 0 },
	{ 0xff /* invalid */	, 0 },
	{ 0xff /* invalid */	, 0 },
	{ 3 /* 0b11 */		, 0 },
L
Linus Torvalds 已提交
222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
};

/* That function checks if a bitfield is valid and returns the other bitfield
 * nearest match if no exact match where found.
 */
static int
get_fan_auto_nearest(struct adm1031_data *data,
		     int chan, u8 val, u8 reg, u8 * new_reg)
{
	int i;
	int first_match = -1, exact_match = -1;
	u8 other_reg_val =
	    (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1];

	if (val == 0) {
		*new_reg = 0;
		return 0;
	}

	for (i = 0; i < 8; i++) {
		if ((val == (*data->chan_select_table)[i][chan]) &&
		    ((*data->chan_select_table)[i][chan ? 0 : 1] ==
		     other_reg_val)) {
			/* We found an exact match */
			exact_match = i;
			break;
		} else if (val == (*data->chan_select_table)[i][chan] &&
			   first_match == -1) {
J
Jean Delvare 已提交
250 251
			/* Save the first match in case of an exact match has
			 * not been found
L
Linus Torvalds 已提交
252 253 254 255 256 257 258 259 260 261 262 263 264 265 266
			 */
			first_match = i;
		}
	}

	if (exact_match >= 0) {
		*new_reg = exact_match;
	} else if (first_match >= 0) {
		*new_reg = first_match;
	} else {
		return -EINVAL;
	}
	return 0;
}

267 268
static ssize_t show_fan_auto_channel(struct device *dev,
				     struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
269
{
270
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
271 272 273 274 275
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr));
}

static ssize_t
276 277
set_fan_auto_channel(struct device *dev, struct device_attribute *attr,
		     const char *buf, size_t count)
L
Linus Torvalds 已提交
278 279 280
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
281
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
282 283 284 285 286 287 288
	int val = simple_strtol(buf, NULL, 10);
	u8 reg;
	int ret;
	u8 old_fan_mode;

	old_fan_mode = data->conf1;

289
	mutex_lock(&data->update_lock);
J
Jean Delvare 已提交
290

L
Linus Torvalds 已提交
291
	if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, &reg))) {
292
		mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
293 294
		return ret;
	}
J
Jean Delvare 已提交
295 296
	data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
	if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) ^
L
Linus Torvalds 已提交
297 298
	    (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) {
		if (data->conf1 & ADM1031_CONF1_AUTO_MODE){
J
Jean Delvare 已提交
299 300
			/* Switch to Auto Fan Mode
			 * Save PWM registers
L
Linus Torvalds 已提交
301 302 303 304 305 306 307 308 309
			 * Set PWM registers to 33% Both */
			data->old_pwm[0] = data->pwm[0];
			data->old_pwm[1] = data->pwm[1];
			adm1031_write_value(client, ADM1031_REG_PWM, 0x55);
		} else {
			/* Switch to Manual Mode */
			data->pwm[0] = data->old_pwm[0];
			data->pwm[1] = data->old_pwm[1];
			/* Restore PWM registers */
J
Jean Delvare 已提交
310
			adm1031_write_value(client, ADM1031_REG_PWM,
L
Linus Torvalds 已提交
311 312 313 314 315
					    data->pwm[0] | (data->pwm[1] << 4));
		}
	}
	data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
	adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1);
316
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
317 318 319
	return count;
}

320 321 322 323
static SENSOR_DEVICE_ATTR(auto_fan1_channel, S_IRUGO | S_IWUSR,
		show_fan_auto_channel, set_fan_auto_channel, 0);
static SENSOR_DEVICE_ATTR(auto_fan2_channel, S_IRUGO | S_IWUSR,
		show_fan_auto_channel, set_fan_auto_channel, 1);
L
Linus Torvalds 已提交
324 325

/* Auto Temps */
326 327
static ssize_t show_auto_temp_off(struct device *dev,
				  struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
328
{
329
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
330
	struct adm1031_data *data = adm1031_update_device(dev);
J
Jean Delvare 已提交
331
	return sprintf(buf, "%d\n",
L
Linus Torvalds 已提交
332 333
		       AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr]));
}
334 335
static ssize_t show_auto_temp_min(struct device *dev,
				  struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
336
{
337
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
338 339 340 341 342
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n",
		       AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr]));
}
static ssize_t
343 344
set_auto_temp_min(struct device *dev, struct device_attribute *attr,
		  const char *buf, size_t count)
L
Linus Torvalds 已提交
345 346 347
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
348
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
349 350
	int val = simple_strtol(buf, NULL, 10);

351
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
352 353 354
	data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]);
	adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
			    data->auto_temp[nr]);
355
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
356 357
	return count;
}
358 359
static ssize_t show_auto_temp_max(struct device *dev,
				  struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
360
{
361
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
362 363 364 365 366
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n",
		       AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr]));
}
static ssize_t
367 368
set_auto_temp_max(struct device *dev, struct device_attribute *attr,
		  const char *buf, size_t count)
L
Linus Torvalds 已提交
369 370 371
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
372
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
373 374
	int val = simple_strtol(buf, NULL, 10);

375
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
376 377 378
	data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]);
	adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
			    data->temp_max[nr]);
379
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
380 381 382
	return count;
}

383 384 385 386 387 388 389
#define auto_temp_reg(offset)						\
static SENSOR_DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO,		\
		show_auto_temp_off, NULL, offset - 1);			\
static SENSOR_DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR,	\
		show_auto_temp_min, set_auto_temp_min, offset - 1);	\
static SENSOR_DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR,	\
		show_auto_temp_max, set_auto_temp_max, offset - 1)
L
Linus Torvalds 已提交
390 391 392 393 394 395

auto_temp_reg(1);
auto_temp_reg(2);
auto_temp_reg(3);

/* pwm */
396 397
static ssize_t show_pwm(struct device *dev,
			struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
398
{
399
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
400 401 402
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr]));
}
403 404
static ssize_t set_pwm(struct device *dev, struct device_attribute *attr,
		       const char *buf, size_t count)
L
Linus Torvalds 已提交
405 406 407
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
408
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
409 410 411
	int val = simple_strtol(buf, NULL, 10);
	int reg;

412
	mutex_lock(&data->update_lock);
J
Jean Delvare 已提交
413
	if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) &&
L
Linus Torvalds 已提交
414 415
	    (((val>>4) & 0xf) != 5)) {
		/* In automatic mode, the only PWM accepted is 33% */
416
		mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
417 418 419 420 421 422 423
		return -EINVAL;
	}
	data->pwm[nr] = PWM_TO_REG(val);
	reg = adm1031_read_value(client, ADM1031_REG_PWM);
	adm1031_write_value(client, ADM1031_REG_PWM,
			    nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf)
			    : (data->pwm[nr] & 0xf) | (reg & 0xf0));
424
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
425 426 427
	return count;
}

428 429 430 431 432 433
static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm, set_pwm, 0);
static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm, set_pwm, 1);
static SENSOR_DEVICE_ATTR(auto_fan1_min_pwm, S_IRUGO | S_IWUSR,
		show_pwm, set_pwm, 0);
static SENSOR_DEVICE_ATTR(auto_fan2_min_pwm, S_IRUGO | S_IWUSR,
		show_pwm, set_pwm, 1);
L
Linus Torvalds 已提交
434 435 436 437 438

/* Fans */

/*
 * That function checks the cases where the fan reading is not
439
 * relevant.  It is used to provide 0 as fan reading when the fan is
L
Linus Torvalds 已提交
440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467
 * not supposed to run
 */
static int trust_fan_readings(struct adm1031_data *data, int chan)
{
	int res = 0;

	if (data->conf1 & ADM1031_CONF1_AUTO_MODE) {
		switch (data->conf1 & 0x60) {
		case 0x00:	/* remote temp1 controls fan1 remote temp2 controls fan2 */
			res = data->temp[chan+1] >=
			      AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]);
			break;
		case 0x20:	/* remote temp1 controls both fans */
			res =
			    data->temp[1] >=
			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]);
			break;
		case 0x40:	/* remote temp2 controls both fans */
			res =
			    data->temp[2] >=
			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]);
			break;
		case 0x60:	/* max controls both fans */
			res =
			    data->temp[0] >=
			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0])
			    || data->temp[1] >=
			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1])
J
Jean Delvare 已提交
468
			    || (data->chip_type == adm1031
L
Linus Torvalds 已提交
469 470 471 472 473 474 475 476 477 478 479
				&& data->temp[2] >=
				AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]));
			break;
		}
	} else {
		res = data->pwm[chan] > 0;
	}
	return res;
}


480 481
static ssize_t show_fan(struct device *dev,
			struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
482
{
483
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
484 485 486 487 488 489 490 491
	struct adm1031_data *data = adm1031_update_device(dev);
	int value;

	value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr],
				 FAN_DIV_FROM_REG(data->fan_div[nr])) : 0;
	return sprintf(buf, "%d\n", value);
}

492 493
static ssize_t show_fan_div(struct device *dev,
			    struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
494
{
495
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
496 497 498
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr]));
}
499 500
static ssize_t show_fan_min(struct device *dev,
			    struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
501
{
502
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
503 504 505 506 507
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n",
		       FAN_FROM_REG(data->fan_min[nr],
				    FAN_DIV_FROM_REG(data->fan_div[nr])));
}
508 509
static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
			   const char *buf, size_t count)
L
Linus Torvalds 已提交
510 511 512
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
513
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
514 515
	int val = simple_strtol(buf, NULL, 10);

516
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
517
	if (val) {
J
Jean Delvare 已提交
518
		data->fan_min[nr] =
L
Linus Torvalds 已提交
519 520 521 522 523
			FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr]));
	} else {
		data->fan_min[nr] = 0xff;
	}
	adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), data->fan_min[nr]);
524
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
525 526
	return count;
}
527 528
static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr,
			   const char *buf, size_t count)
L
Linus Torvalds 已提交
529 530 531
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
532
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
533 534 535 536 537 538 539
	int val = simple_strtol(buf, NULL, 10);
	u8 tmp;
	int old_div;
	int new_min;

	tmp = val == 8 ? 0xc0 :
	      val == 4 ? 0x80 :
J
Jean Delvare 已提交
540 541
	      val == 2 ? 0x40 :
	      val == 1 ? 0x00 :
L
Linus Torvalds 已提交
542 543 544
	      0xff;
	if (tmp == 0xff)
		return -EINVAL;
J
Jean Delvare 已提交
545

546
	mutex_lock(&data->update_lock);
547 548 549 550 551 552 553
	/* Get fresh readings */
	data->fan_div[nr] = adm1031_read_value(client,
					       ADM1031_REG_FAN_DIV(nr));
	data->fan_min[nr] = adm1031_read_value(client,
					       ADM1031_REG_FAN_MIN(nr));

	/* Write the new clock divider and fan min */
L
Linus Torvalds 已提交
554
	old_div = FAN_DIV_FROM_REG(data->fan_div[nr]);
J
Jean Delvare 已提交
555 556
	data->fan_div[nr] = tmp | (0x3f & data->fan_div[nr]);
	new_min = data->fan_min[nr] * old_div / val;
L
Linus Torvalds 已提交
557 558
	data->fan_min[nr] = new_min > 0xff ? 0xff : new_min;

J
Jean Delvare 已提交
559
	adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr),
L
Linus Torvalds 已提交
560
			    data->fan_div[nr]);
J
Jean Delvare 已提交
561
	adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr),
L
Linus Torvalds 已提交
562
			    data->fan_min[nr]);
563 564 565

	/* Invalidate the cache: fan speed is no longer valid */
	data->valid = 0;
566
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
567 568 569 570
	return count;
}

#define fan_offset(offset)						\
571 572 573 574 575 576
static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO,			\
		show_fan, NULL, offset - 1);				\
static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,		\
		show_fan_min, set_fan_min, offset - 1);			\
static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,		\
		show_fan_div, set_fan_div, offset - 1)
L
Linus Torvalds 已提交
577 578 579 580 581 582

fan_offset(1);
fan_offset(2);


/* Temps */
583 584
static ssize_t show_temp(struct device *dev,
			 struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
585
{
586
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
587 588 589 590 591 592 593
	struct adm1031_data *data = adm1031_update_device(dev);
	int ext;
	ext = nr == 0 ?
	    ((data->ext_temp[nr] >> 6) & 0x3) * 2 :
	    (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7));
	return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext));
}
594 595 596 597 598 599 600 601
static ssize_t show_temp_offset(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	int nr = to_sensor_dev_attr(attr)->index;
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n",
		       TEMP_OFFSET_FROM_REG(data->temp_offset[nr]));
}
602 603
static ssize_t show_temp_min(struct device *dev,
			     struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
604
{
605
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
606 607 608
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr]));
}
609 610
static ssize_t show_temp_max(struct device *dev,
			     struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
611
{
612
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
613 614 615
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr]));
}
616 617
static ssize_t show_temp_crit(struct device *dev,
			      struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
618
{
619
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
620 621 622
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr]));
}
623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
static ssize_t set_temp_offset(struct device *dev,
			       struct device_attribute *attr, const char *buf,
			       size_t count)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
	int nr = to_sensor_dev_attr(attr)->index;
	int val;

	val = simple_strtol(buf, NULL, 10);
	val = SENSORS_LIMIT(val, -15000, 15000);
	mutex_lock(&data->update_lock);
	data->temp_offset[nr] = TEMP_OFFSET_TO_REG(val);
	adm1031_write_value(client, ADM1031_REG_TEMP_OFFSET(nr),
			    data->temp_offset[nr]);
	mutex_unlock(&data->update_lock);
	return count;
}
641 642
static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
			    const char *buf, size_t count)
L
Linus Torvalds 已提交
643 644 645
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
646
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
647 648 649 650
	int val;

	val = simple_strtol(buf, NULL, 10);
	val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
651
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
652 653 654
	data->temp_min[nr] = TEMP_TO_REG(val);
	adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr),
			    data->temp_min[nr]);
655
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
656 657
	return count;
}
658 659
static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
			    const char *buf, size_t count)
L
Linus Torvalds 已提交
660 661 662
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
663
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
664 665 666 667
	int val;

	val = simple_strtol(buf, NULL, 10);
	val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
668
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
669 670 671
	data->temp_max[nr] = TEMP_TO_REG(val);
	adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr),
			    data->temp_max[nr]);
672
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
673 674
	return count;
}
675 676
static ssize_t set_temp_crit(struct device *dev, struct device_attribute *attr,
			     const char *buf, size_t count)
L
Linus Torvalds 已提交
677 678 679
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
680
	int nr = to_sensor_dev_attr(attr)->index;
L
Linus Torvalds 已提交
681 682 683 684
	int val;

	val = simple_strtol(buf, NULL, 10);
	val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
685
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
686 687 688
	data->temp_crit[nr] = TEMP_TO_REG(val);
	adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr),
			    data->temp_crit[nr]);
689
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
690 691 692
	return count;
}

693 694 695
#define temp_reg(offset)						\
static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO,		\
		show_temp, NULL, offset - 1);				\
696 697
static SENSOR_DEVICE_ATTR(temp##offset##_offset, S_IRUGO | S_IWUSR,	\
		show_temp_offset, set_temp_offset, offset - 1);		\
698 699 700 701 702 703
static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR,	\
		show_temp_min, set_temp_min, offset - 1);		\
static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,	\
		show_temp_max, set_temp_max, offset - 1);		\
static SENSOR_DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR,	\
		show_temp_crit, set_temp_crit, offset - 1)
L
Linus Torvalds 已提交
704 705 706 707 708 709

temp_reg(1);
temp_reg(2);
temp_reg(3);

/* Alarms */
710
static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
711 712 713 714 715 716 717
{
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", data->alarm);
}

static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);

718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740
static ssize_t show_alarm(struct device *dev,
			  struct device_attribute *attr, char *buf)
{
	int bitnr = to_sensor_dev_attr(attr)->index;
	struct adm1031_data *data = adm1031_update_device(dev);
	return sprintf(buf, "%d\n", (data->alarm >> bitnr) & 1);
}

static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 0);
static SENSOR_DEVICE_ATTR(fan1_fault, S_IRUGO, show_alarm, NULL, 1);
static SENSOR_DEVICE_ATTR(temp2_max_alarm, S_IRUGO, show_alarm, NULL, 2);
static SENSOR_DEVICE_ATTR(temp2_min_alarm, S_IRUGO, show_alarm, NULL, 3);
static SENSOR_DEVICE_ATTR(temp2_crit_alarm, S_IRUGO, show_alarm, NULL, 4);
static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 5);
static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 6);
static SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_alarm, NULL, 7);
static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 8);
static SENSOR_DEVICE_ATTR(fan2_fault, S_IRUGO, show_alarm, NULL, 9);
static SENSOR_DEVICE_ATTR(temp3_max_alarm, S_IRUGO, show_alarm, NULL, 10);
static SENSOR_DEVICE_ATTR(temp3_min_alarm, S_IRUGO, show_alarm, NULL, 11);
static SENSOR_DEVICE_ATTR(temp3_crit_alarm, S_IRUGO, show_alarm, NULL, 12);
static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 13);
static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 14);
L
Linus Torvalds 已提交
741

742
static struct attribute *adm1031_attributes[] = {
743 744 745
	&sensor_dev_attr_fan1_input.dev_attr.attr,
	&sensor_dev_attr_fan1_div.dev_attr.attr,
	&sensor_dev_attr_fan1_min.dev_attr.attr,
746 747
	&sensor_dev_attr_fan1_alarm.dev_attr.attr,
	&sensor_dev_attr_fan1_fault.dev_attr.attr,
748 749 750
	&sensor_dev_attr_pwm1.dev_attr.attr,
	&sensor_dev_attr_auto_fan1_channel.dev_attr.attr,
	&sensor_dev_attr_temp1_input.dev_attr.attr,
751
	&sensor_dev_attr_temp1_offset.dev_attr.attr,
752
	&sensor_dev_attr_temp1_min.dev_attr.attr,
753
	&sensor_dev_attr_temp1_min_alarm.dev_attr.attr,
754
	&sensor_dev_attr_temp1_max.dev_attr.attr,
755
	&sensor_dev_attr_temp1_max_alarm.dev_attr.attr,
756
	&sensor_dev_attr_temp1_crit.dev_attr.attr,
757
	&sensor_dev_attr_temp1_crit_alarm.dev_attr.attr,
758
	&sensor_dev_attr_temp2_input.dev_attr.attr,
759
	&sensor_dev_attr_temp2_offset.dev_attr.attr,
760
	&sensor_dev_attr_temp2_min.dev_attr.attr,
761
	&sensor_dev_attr_temp2_min_alarm.dev_attr.attr,
762
	&sensor_dev_attr_temp2_max.dev_attr.attr,
763
	&sensor_dev_attr_temp2_max_alarm.dev_attr.attr,
764
	&sensor_dev_attr_temp2_crit.dev_attr.attr,
765 766
	&sensor_dev_attr_temp2_crit_alarm.dev_attr.attr,
	&sensor_dev_attr_temp2_fault.dev_attr.attr,
767 768 769 770 771 772 773 774 775 776

	&sensor_dev_attr_auto_temp1_off.dev_attr.attr,
	&sensor_dev_attr_auto_temp1_min.dev_attr.attr,
	&sensor_dev_attr_auto_temp1_max.dev_attr.attr,

	&sensor_dev_attr_auto_temp2_off.dev_attr.attr,
	&sensor_dev_attr_auto_temp2_min.dev_attr.attr,
	&sensor_dev_attr_auto_temp2_max.dev_attr.attr,

	&sensor_dev_attr_auto_fan1_min_pwm.dev_attr.attr,
777 778 779 780 781 782 783 784 785 786 787

	&dev_attr_alarms.attr,

	NULL
};

static const struct attribute_group adm1031_group = {
	.attrs = adm1031_attributes,
};

static struct attribute *adm1031_attributes_opt[] = {
788 789 790
	&sensor_dev_attr_fan2_input.dev_attr.attr,
	&sensor_dev_attr_fan2_div.dev_attr.attr,
	&sensor_dev_attr_fan2_min.dev_attr.attr,
791 792
	&sensor_dev_attr_fan2_alarm.dev_attr.attr,
	&sensor_dev_attr_fan2_fault.dev_attr.attr,
793 794 795
	&sensor_dev_attr_pwm2.dev_attr.attr,
	&sensor_dev_attr_auto_fan2_channel.dev_attr.attr,
	&sensor_dev_attr_temp3_input.dev_attr.attr,
796
	&sensor_dev_attr_temp3_offset.dev_attr.attr,
797
	&sensor_dev_attr_temp3_min.dev_attr.attr,
798
	&sensor_dev_attr_temp3_min_alarm.dev_attr.attr,
799
	&sensor_dev_attr_temp3_max.dev_attr.attr,
800
	&sensor_dev_attr_temp3_max_alarm.dev_attr.attr,
801
	&sensor_dev_attr_temp3_crit.dev_attr.attr,
802 803
	&sensor_dev_attr_temp3_crit_alarm.dev_attr.attr,
	&sensor_dev_attr_temp3_fault.dev_attr.attr,
804 805 806 807
	&sensor_dev_attr_auto_temp3_off.dev_attr.attr,
	&sensor_dev_attr_auto_temp3_min.dev_attr.attr,
	&sensor_dev_attr_auto_temp3_max.dev_attr.attr,
	&sensor_dev_attr_auto_fan2_min_pwm.dev_attr.attr,
808 809 810 811 812 813 814
	NULL
};

static const struct attribute_group adm1031_group_opt = {
	.attrs = adm1031_attributes_opt,
};

815
/* Return 0 if detection is successful, -ENODEV otherwise */
816
static int adm1031_detect(struct i2c_client *client,
817
			  struct i2c_board_info *info)
L
Linus Torvalds 已提交
818
{
819
	struct i2c_adapter *adapter = client->adapter;
J
Jean Delvare 已提交
820 821
	const char *name;
	int id, co;
L
Linus Torvalds 已提交
822 823

	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
824
		return -ENODEV;
L
Linus Torvalds 已提交
825

J
Jean Delvare 已提交
826 827
	id = i2c_smbus_read_byte_data(client, 0x3d);
	co = i2c_smbus_read_byte_data(client, 0x3e);
L
Linus Torvalds 已提交
828

J
Jean Delvare 已提交
829 830 831
	if (!((id == 0x31 || id == 0x30) && co == 0x41))
		return -ENODEV;
	name = (id == 0x30) ? "adm1030" : "adm1031";
L
Linus Torvalds 已提交
832

833
	strlcpy(info->type, name, I2C_NAME_SIZE);
L
Linus Torvalds 已提交
834

835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851
	return 0;
}

static int adm1031_probe(struct i2c_client *client,
			 const struct i2c_device_id *id)
{
	struct adm1031_data *data;
	int err;

	data = kzalloc(sizeof(struct adm1031_data), GFP_KERNEL);
	if (!data) {
		err = -ENOMEM;
		goto exit;
	}

	i2c_set_clientdata(client, data);
	data->chip_type = id->driver_data;
852
	mutex_init(&data->update_lock);
L
Linus Torvalds 已提交
853

854 855 856 857
	if (data->chip_type == adm1030)
		data->chan_select_table = &auto_channel_select_table_adm1030;
	else
		data->chan_select_table = &auto_channel_select_table_adm1031;
L
Linus Torvalds 已提交
858 859

	/* Initialize the ADM1031 chip */
J
Jean Delvare 已提交
860
	adm1031_init_client(client);
L
Linus Torvalds 已提交
861 862

	/* Register sysfs hooks */
J
Jean Delvare 已提交
863
	if ((err = sysfs_create_group(&client->dev.kobj, &adm1031_group)))
864
		goto exit_free;
L
Linus Torvalds 已提交
865

866
	if (data->chip_type == adm1031) {
J
Jean Delvare 已提交
867
		if ((err = sysfs_create_group(&client->dev.kobj,
868 869 870 871
						&adm1031_group_opt)))
			goto exit_remove;
	}

J
Jean Delvare 已提交
872
	data->hwmon_dev = hwmon_device_register(&client->dev);
873 874
	if (IS_ERR(data->hwmon_dev)) {
		err = PTR_ERR(data->hwmon_dev);
875
		goto exit_remove;
L
Linus Torvalds 已提交
876 877 878 879
	}

	return 0;

880
exit_remove:
J
Jean Delvare 已提交
881 882
	sysfs_remove_group(&client->dev.kobj, &adm1031_group);
	sysfs_remove_group(&client->dev.kobj, &adm1031_group_opt);
L
Linus Torvalds 已提交
883
exit_free:
884
	kfree(data);
L
Linus Torvalds 已提交
885 886 887 888
exit:
	return err;
}

889
static int adm1031_remove(struct i2c_client *client)
L
Linus Torvalds 已提交
890
{
891 892
	struct adm1031_data *data = i2c_get_clientdata(client);

893
	hwmon_device_unregister(data->hwmon_dev);
894 895
	sysfs_remove_group(&client->dev.kobj, &adm1031_group);
	sysfs_remove_group(&client->dev.kobj, &adm1031_group_opt);
896
	kfree(data);
L
Linus Torvalds 已提交
897 898 899 900 901 902 903 904 905 906 907 908 909
	return 0;
}

static void adm1031_init_client(struct i2c_client *client)
{
	unsigned int read_val;
	unsigned int mask;
	struct adm1031_data *data = i2c_get_clientdata(client);

	mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE);
	if (data->chip_type == adm1031) {
		mask |= (ADM1031_CONF2_PWM2_ENABLE |
			ADM1031_CONF2_TACH2_ENABLE);
J
Jean Delvare 已提交
910
	}
L
Linus Torvalds 已提交
911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930
	/* Initialize the ADM1031 chip (enables fan speed reading ) */
	read_val = adm1031_read_value(client, ADM1031_REG_CONF2);
	if ((read_val | mask) != read_val) {
	    adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask);
	}

	read_val = adm1031_read_value(client, ADM1031_REG_CONF1);
	if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) {
	    adm1031_write_value(client, ADM1031_REG_CONF1, read_val |
				ADM1031_CONF1_MONITOR_ENABLE);
	}

}

static struct adm1031_data *adm1031_update_device(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adm1031_data *data = i2c_get_clientdata(client);
	int chan;

931
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964

	if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
	    || !data->valid) {

		dev_dbg(&client->dev, "Starting adm1031 update\n");
		for (chan = 0;
		     chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) {
			u8 oldh, newh;

			oldh =
			    adm1031_read_value(client, ADM1031_REG_TEMP(chan));
			data->ext_temp[chan] =
			    adm1031_read_value(client, ADM1031_REG_EXT_TEMP);
			newh =
			    adm1031_read_value(client, ADM1031_REG_TEMP(chan));
			if (newh != oldh) {
				data->ext_temp[chan] =
				    adm1031_read_value(client,
						       ADM1031_REG_EXT_TEMP);
#ifdef DEBUG
				oldh =
				    adm1031_read_value(client,
						       ADM1031_REG_TEMP(chan));

				/* oldh is actually newer */
				if (newh != oldh)
					dev_warn(&client->dev,
						 "Remote temperature may be "
						 "wrong.\n");
#endif
			}
			data->temp[chan] = newh;

965 966 967
			data->temp_offset[chan] =
			    adm1031_read_value(client,
					       ADM1031_REG_TEMP_OFFSET(chan));
L
Linus Torvalds 已提交
968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991
			data->temp_min[chan] =
			    adm1031_read_value(client,
					       ADM1031_REG_TEMP_MIN(chan));
			data->temp_max[chan] =
			    adm1031_read_value(client,
					       ADM1031_REG_TEMP_MAX(chan));
			data->temp_crit[chan] =
			    adm1031_read_value(client,
					       ADM1031_REG_TEMP_CRIT(chan));
			data->auto_temp[chan] =
			    adm1031_read_value(client,
					       ADM1031_REG_AUTO_TEMP(chan));

		}

		data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1);
		data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2);

		data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0))
			     | (adm1031_read_value(client, ADM1031_REG_STATUS(1))
				<< 8);
		if (data->chip_type == adm1030) {
			data->alarm &= 0xc0ff;
		}
J
Jean Delvare 已提交
992

L
Linus Torvalds 已提交
993 994 995 996 997 998 999 1000
		for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) {
			data->fan_div[chan] =
			    adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan));
			data->fan_min[chan] =
			    adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan));
			data->fan[chan] =
			    adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan));
			data->pwm[chan] =
J
Jean Delvare 已提交
1001
			    0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >>
L
Linus Torvalds 已提交
1002 1003 1004 1005 1006 1007
				   (4*chan));
		}
		data->last_updated = jiffies;
		data->valid = 1;
	}

1008
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028

	return data;
}

static int __init sensors_adm1031_init(void)
{
	return i2c_add_driver(&adm1031_driver);
}

static void __exit sensors_adm1031_exit(void)
{
	i2c_del_driver(&adm1031_driver);
}

MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>");
MODULE_DESCRIPTION("ADM1031/ADM1030 driver");
MODULE_LICENSE("GPL");

module_init(sensors_adm1031_init);
module_exit(sensors_adm1031_exit);