w83781d.c 57.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4
/*
    w83781d.c - Part of lm_sensors, Linux kernel modules for hardware
                monitoring
    Copyright (c) 1998 - 2001  Frodo Looijaard <frodol@dds.nl>,
5 6 7
                               Philip Edelbrock <phil@netroedge.com>,
                               and Mark Studebaker <mdsxyz123@yahoo.com>
    Copyright (c) 2007         Jean Delvare <khali@linux-fr.org>
L
Linus Torvalds 已提交
8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40

    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.
*/

/*
    Supports following chips:

    Chip	#vin	#fanin	#pwm	#temp	wchipid	vendid	i2c	ISA
    as99127f	7	3	0	3	0x31	0x12c3	yes	no
    as99127f rev.2 (type_name = as99127f)	0x31	0x5ca3	yes	no
    w83781d	7	3	0	3	0x10-1	0x5ca3	yes	yes
    w83782d	9	3	2-4	3	0x30	0x5ca3	yes	yes
    w83783s	5-6	3	2	1-2	0x40	0x5ca3	yes	no

*/

#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/jiffies.h>
#include <linux/i2c.h>
41 42
#include <linux/platform_device.h>
#include <linux/ioport.h>
43
#include <linux/hwmon.h>
44
#include <linux/hwmon-vid.h>
45
#include <linux/hwmon-sysfs.h>
46
#include <linux/sysfs.h>
47
#include <linux/err.h>
48
#include <linux/mutex.h>
L
Linus Torvalds 已提交
49 50 51
#include <asm/io.h>
#include "lm75.h"

52 53 54
/* ISA device, if found */
static struct platform_device *pdev;

L
Linus Torvalds 已提交
55
/* Addresses to scan */
56 57
static const unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d,
						0x2e, 0x2f, I2C_CLIENT_END };
58
static unsigned short isa_address = 0x290;
L
Linus Torvalds 已提交
59 60

/* Insmod parameters */
61
I2C_CLIENT_INSMOD_4(w83781d, w83782d, w83783s, as99127f);
L
Linus Torvalds 已提交
62 63 64
I2C_CLIENT_MODULE_PARM(force_subclients, "List of subclient addresses: "
		    "{bus, clientaddr, subclientaddr1, subclientaddr2}");

65 66 67 68
static int reset;
module_param(reset, bool, 0);
MODULE_PARM_DESC(reset, "Set to one to reset chip on load");

L
Linus Torvalds 已提交
69 70 71 72 73 74 75 76 77 78 79 80 81
static int init = 1;
module_param(init, bool, 0);
MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization");

/* Constants specified below */

/* Length of ISA address segment */
#define W83781D_EXTENT			8

/* Where are the ISA address/data registers relative to the base address */
#define W83781D_ADDR_REG_OFFSET		5
#define W83781D_DATA_REG_OFFSET		6

82 83
/* The device registers */
/* in nr from 0 to 8 */
L
Linus Torvalds 已提交
84 85 86 87 88 89 90
#define W83781D_REG_IN_MAX(nr)		((nr < 7) ? (0x2b + (nr) * 2) : \
						    (0x554 + (((nr) - 7) * 2)))
#define W83781D_REG_IN_MIN(nr)		((nr < 7) ? (0x2c + (nr) * 2) : \
						    (0x555 + (((nr) - 7) * 2)))
#define W83781D_REG_IN(nr)		((nr < 7) ? (0x20 + (nr)) : \
						    (0x550 + (nr) - 7))

91 92 93
/* fan nr from 0 to 2 */
#define W83781D_REG_FAN_MIN(nr)		(0x3b + (nr))
#define W83781D_REG_FAN(nr)		(0x28 + (nr))
L
Linus Torvalds 已提交
94 95 96 97

#define W83781D_REG_BANK		0x4E
#define W83781D_REG_TEMP2_CONFIG	0x152
#define W83781D_REG_TEMP3_CONFIG	0x252
98
/* temp nr from 1 to 3 */
L
Linus Torvalds 已提交
99 100 101 102 103 104 105 106 107 108 109
#define W83781D_REG_TEMP(nr)		((nr == 3) ? (0x0250) : \
					((nr == 2) ? (0x0150) : \
						     (0x27)))
#define W83781D_REG_TEMP_HYST(nr)	((nr == 3) ? (0x253) : \
					((nr == 2) ? (0x153) : \
						     (0x3A)))
#define W83781D_REG_TEMP_OVER(nr)	((nr == 3) ? (0x255) : \
					((nr == 2) ? (0x155) : \
						     (0x39)))

#define W83781D_REG_CONFIG		0x40
110 111

/* Interrupt status (W83781D, AS99127F) */
L
Linus Torvalds 已提交
112 113 114
#define W83781D_REG_ALARM1		0x41
#define W83781D_REG_ALARM2		0x42

115
/* Real-time status (W83782D, W83783S) */
116 117 118 119
#define W83782D_REG_ALARM1		0x459
#define W83782D_REG_ALARM2		0x45A
#define W83782D_REG_ALARM3		0x45B

L
Linus Torvalds 已提交
120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135
#define W83781D_REG_BEEP_CONFIG		0x4D
#define W83781D_REG_BEEP_INTS1		0x56
#define W83781D_REG_BEEP_INTS2		0x57
#define W83781D_REG_BEEP_INTS3		0x453	/* not on W83781D */

#define W83781D_REG_VID_FANDIV		0x47

#define W83781D_REG_CHIPID		0x49
#define W83781D_REG_WCHIPID		0x58
#define W83781D_REG_CHIPMAN		0x4F
#define W83781D_REG_PIN			0x4B

/* 782D/783S only */
#define W83781D_REG_VBAT		0x5D

/* PWM 782D (1-4) and 783S (1-2) only */
136
static const u8 W83781D_REG_PWM[] = { 0x5B, 0x5A, 0x5E, 0x5F };
L
Linus Torvalds 已提交
137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153
#define W83781D_REG_PWMCLK12		0x5C
#define W83781D_REG_PWMCLK34		0x45C

#define W83781D_REG_I2C_ADDR		0x48
#define W83781D_REG_I2C_SUBADDR		0x4A

/* The following are undocumented in the data sheets however we
   received the information in an email from Winbond tech support */
/* Sensor selection - not on 781d */
#define W83781D_REG_SCFG1		0x5D
static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 };

#define W83781D_REG_SCFG2		0x59
static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 };

#define W83781D_DEFAULT_BETA		3435

154 155 156
/* Conversions */
#define IN_TO_REG(val)			SENSORS_LIMIT(((val) + 8) / 16, 0, 255)
#define IN_FROM_REG(val)		((val) * 16)
L
Linus Torvalds 已提交
157 158 159 160 161 162 163 164 165 166

static inline u8
FAN_TO_REG(long rpm, int div)
{
	if (rpm == 0)
		return 255;
	rpm = SENSORS_LIMIT(rpm, 1, 1000000);
	return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
}

167 168 169 170 171 172 173 174 175
static inline long
FAN_FROM_REG(u8 val, int div)
{
	if (val == 0)
		return -1;
	if (val == 255)
		return 0;
	return 1350000 / (val * div);
}
L
Linus Torvalds 已提交
176

177 178
#define TEMP_TO_REG(val)		SENSORS_LIMIT((val) / 1000, -127, 128)
#define TEMP_FROM_REG(val)		((val) * 1000)
L
Linus Torvalds 已提交
179 180

#define BEEP_MASK_FROM_REG(val,type)	((type) == as99127f ? \
181
					 (~(val)) & 0x7fff : (val) & 0xff7fff)
L
Linus Torvalds 已提交
182
#define BEEP_MASK_TO_REG(val,type)	((type) == as99127f ? \
183
					 (~(val)) & 0x7fff : (val) & 0xff7fff)
L
Linus Torvalds 已提交
184 185 186 187 188 189 190 191 192 193

#define DIV_FROM_REG(val)		(1 << (val))

static inline u8
DIV_TO_REG(long val, enum chips type)
{
	int i;
	val = SENSORS_LIMIT(val, 1,
			    ((type == w83781d
			      || type == as99127f) ? 8 : 128)) >> 1;
194
	for (i = 0; i < 7; i++) {
L
Linus Torvalds 已提交
195 196 197 198
		if (val == 0)
			break;
		val >>= 1;
	}
199
	return i;
L
Linus Torvalds 已提交
200 201 202 203 204 205 206 207 208 209 210 211 212
}

/* There are some complications in a module like this. First off, W83781D chips
   may be both present on the SMBus and the ISA bus, and we have to handle
   those cases separately at some places. Second, there might be several
   W83781D chips available (well, actually, that is probably never done; but
   it is a clean illustration of how to handle a case like that). Finally,
   a specific chip may be attached to *both* ISA and SMBus, and we would
   not like to detect it double. Fortunately, in the case of the W83781D at
   least, a register tells us what SMBus address we are on, so that helps
   a bit - except if there could be more than one SMBus. Groan. No solution
   for this yet. */

213 214
/* For ISA chips, we abuse the i2c_client addr and name fields. We also use
   the driver field to differentiate between I2C and ISA chips. */
L
Linus Torvalds 已提交
215 216
struct w83781d_data {
	struct i2c_client client;
217
	struct device *hwmon_dev;
218
	struct mutex lock;
L
Linus Torvalds 已提交
219 220
	enum chips type;

221
	struct mutex update_lock;
L
Linus Torvalds 已提交
222 223 224 225 226 227 228 229 230 231 232
	char valid;		/* !=0 if following fields are valid */
	unsigned long last_updated;	/* In jiffies */

	struct i2c_client *lm75[2];	/* for secondary I2C addresses */
	/* array of 2 pointers to subclients */

	u8 in[9];		/* Register value - 8 & 9 for 782D only */
	u8 in_max[9];		/* Register value - 8 & 9 for 782D only */
	u8 in_min[9];		/* Register value - 8 & 9 for 782D only */
	u8 fan[3];		/* Register value */
	u8 fan_min[3];		/* Register value */
233 234 235
	s8 temp;		/* Register value */
	s8 temp_max;		/* Register value */
	s8 temp_max_hyst;	/* Register value */
L
Linus Torvalds 已提交
236 237 238 239 240 241 242 243
	u16 temp_add[2];	/* Register value */
	u16 temp_max_add[2];	/* Register value */
	u16 temp_max_hyst_add[2];	/* Register value */
	u8 fan_div[3];		/* Register encoding, shifted right */
	u8 vid;			/* Register encoding, combined */
	u32 alarms;		/* Register encoding, combined */
	u32 beep_mask;		/* Register encoding, combined */
	u8 pwm[4];		/* Register value */
244
	u8 pwm2_enable;		/* Boolean */
L
Linus Torvalds 已提交
245 246
	u16 sens[3];		/* 782D/783S only.
				   1 = pentium diode; 2 = 3904 diode;
J
Jean Delvare 已提交
247
				   4 = thermistor */
L
Linus Torvalds 已提交
248 249 250 251 252 253 254
	u8 vrm;
};

static int w83781d_attach_adapter(struct i2c_adapter *adapter);
static int w83781d_detect(struct i2c_adapter *adapter, int address, int kind);
static int w83781d_detach_client(struct i2c_client *client);

255 256 257
static int __devinit w83781d_isa_probe(struct platform_device *pdev);
static int __devexit w83781d_isa_remove(struct platform_device *pdev);

258 259
static int w83781d_read_value(struct w83781d_data *data, u16 reg);
static int w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value);
L
Linus Torvalds 已提交
260
static struct w83781d_data *w83781d_update_device(struct device *dev);
261
static void w83781d_init_device(struct device *dev);
L
Linus Torvalds 已提交
262 263

static struct i2c_driver w83781d_driver = {
264 265 266
	.driver = {
		.name = "w83781d",
	},
L
Linus Torvalds 已提交
267 268 269 270
	.attach_adapter = w83781d_attach_adapter,
	.detach_client = w83781d_detach_client,
};

271
static struct platform_driver w83781d_isa_driver = {
272
	.driver = {
J
Jean Delvare 已提交
273
		.owner = THIS_MODULE,
274
		.name = "w83781d",
275
	},
276 277
	.probe = w83781d_isa_probe,
	.remove = w83781d_isa_remove,
278 279 280
};


L
Linus Torvalds 已提交
281 282
/* following are the sysfs callback functions */
#define show_in_reg(reg) \
283 284
static ssize_t show_##reg (struct device *dev, struct device_attribute *da, \
		char *buf) \
L
Linus Torvalds 已提交
285
{ \
286
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
L
Linus Torvalds 已提交
287
	struct w83781d_data *data = w83781d_update_device(dev); \
288 289
	return sprintf(buf, "%ld\n", \
		       (long)IN_FROM_REG(data->reg[attr->index])); \
L
Linus Torvalds 已提交
290 291 292 293 294 295
}
show_in_reg(in);
show_in_reg(in_min);
show_in_reg(in_max);

#define store_in_reg(REG, reg) \
296 297
static ssize_t store_in_##reg (struct device *dev, struct device_attribute \
		*da, const char *buf, size_t count) \
L
Linus Torvalds 已提交
298
{ \
299
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
300
	struct w83781d_data *data = dev_get_drvdata(dev); \
301
	int nr = attr->index; \
L
Linus Torvalds 已提交
302 303
	u32 val; \
	 \
304
	val = simple_strtoul(buf, NULL, 10); \
L
Linus Torvalds 已提交
305
	 \
306
	mutex_lock(&data->update_lock); \
L
Linus Torvalds 已提交
307
	data->in_##reg[nr] = IN_TO_REG(val); \
308
	w83781d_write_value(data, W83781D_REG_IN_##REG(nr), data->in_##reg[nr]); \
L
Linus Torvalds 已提交
309
	 \
310
	mutex_unlock(&data->update_lock); \
L
Linus Torvalds 已提交
311 312 313 314 315 316
	return count; \
}
store_in_reg(MIN, min);
store_in_reg(MAX, max);

#define sysfs_in_offsets(offset) \
317 318 319 320 321 322
static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
		show_in, NULL, offset); \
static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
		show_in_min, store_in_min, offset); \
static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
		show_in_max, store_in_max, offset)
L
Linus Torvalds 已提交
323 324 325 326 327 328 329 330 331 332 333 334

sysfs_in_offsets(0);
sysfs_in_offsets(1);
sysfs_in_offsets(2);
sysfs_in_offsets(3);
sysfs_in_offsets(4);
sysfs_in_offsets(5);
sysfs_in_offsets(6);
sysfs_in_offsets(7);
sysfs_in_offsets(8);

#define show_fan_reg(reg) \
335 336
static ssize_t show_##reg (struct device *dev, struct device_attribute *da, \
		char *buf) \
L
Linus Torvalds 已提交
337
{ \
338
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
L
Linus Torvalds 已提交
339 340
	struct w83781d_data *data = w83781d_update_device(dev); \
	return sprintf(buf,"%ld\n", \
341 342
		FAN_FROM_REG(data->reg[attr->index], \
			DIV_FROM_REG(data->fan_div[attr->index]))); \
L
Linus Torvalds 已提交
343 344 345 346 347
}
show_fan_reg(fan);
show_fan_reg(fan_min);

static ssize_t
348 349
store_fan_min(struct device *dev, struct device_attribute *da,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
350
{
351
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
352
	struct w83781d_data *data = dev_get_drvdata(dev);
353
	int nr = attr->index;
L
Linus Torvalds 已提交
354 355 356 357
	u32 val;

	val = simple_strtoul(buf, NULL, 10);

358
	mutex_lock(&data->update_lock);
359 360
	data->fan_min[nr] =
	    FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
361
	w83781d_write_value(data, W83781D_REG_FAN_MIN(nr),
362
			    data->fan_min[nr]);
L
Linus Torvalds 已提交
363

364
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
365 366 367
	return count;
}

368 369 370 371 372 373 374 375 376
static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO | S_IWUSR,
		show_fan_min, store_fan_min, 0);
static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO | S_IWUSR,
		show_fan_min, store_fan_min, 1);
static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
static SENSOR_DEVICE_ATTR(fan3_min, S_IRUGO | S_IWUSR,
		show_fan_min, store_fan_min, 2);
L
Linus Torvalds 已提交
377 378

#define show_temp_reg(reg) \
379 380
static ssize_t show_##reg (struct device *dev, struct device_attribute *da, \
		char *buf) \
L
Linus Torvalds 已提交
381
{ \
382
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
L
Linus Torvalds 已提交
383
	struct w83781d_data *data = w83781d_update_device(dev); \
384
	int nr = attr->index; \
L
Linus Torvalds 已提交
385 386 387 388 389 390 391 392 393 394 395 396
	if (nr >= 2) {	/* TEMP2 and TEMP3 */ \
		return sprintf(buf,"%d\n", \
			LM75_TEMP_FROM_REG(data->reg##_add[nr-2])); \
	} else {	/* TEMP1 */ \
		return sprintf(buf,"%ld\n", (long)TEMP_FROM_REG(data->reg)); \
	} \
}
show_temp_reg(temp);
show_temp_reg(temp_max);
show_temp_reg(temp_max_hyst);

#define store_temp_reg(REG, reg) \
397 398
static ssize_t store_temp_##reg (struct device *dev, \
		struct device_attribute *da, const char *buf, size_t count) \
L
Linus Torvalds 已提交
399
{ \
400
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
401
	struct w83781d_data *data = dev_get_drvdata(dev); \
402
	int nr = attr->index; \
403
	long val; \
L
Linus Torvalds 已提交
404 405 406
	 \
	val = simple_strtol(buf, NULL, 10); \
	 \
407
	mutex_lock(&data->update_lock); \
L
Linus Torvalds 已提交
408 409 410
	 \
	if (nr >= 2) {	/* TEMP2 and TEMP3 */ \
		data->temp_##reg##_add[nr-2] = LM75_TEMP_TO_REG(val); \
411
		w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
L
Linus Torvalds 已提交
412 413 414
				data->temp_##reg##_add[nr-2]); \
	} else {	/* TEMP1 */ \
		data->temp_##reg = TEMP_TO_REG(val); \
415
		w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
L
Linus Torvalds 已提交
416 417 418
			data->temp_##reg); \
	} \
	 \
419
	mutex_unlock(&data->update_lock); \
L
Linus Torvalds 已提交
420 421 422 423 424 425
	return count; \
}
store_temp_reg(OVER, max);
store_temp_reg(HYST, max_hyst);

#define sysfs_temp_offsets(offset) \
426 427 428 429 430 431
static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \
		show_temp, NULL, offset); \
static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
		show_temp_max, store_temp_max, offset); \
static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO | S_IWUSR, \
		show_temp_max_hyst, store_temp_max_hyst, offset);
L
Linus Torvalds 已提交
432 433 434 435 436 437

sysfs_temp_offsets(1);
sysfs_temp_offsets(2);
sysfs_temp_offsets(3);

static ssize_t
438
show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
439 440 441 442 443
{
	struct w83781d_data *data = w83781d_update_device(dev);
	return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm));
}

444 445
static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL);

L
Linus Torvalds 已提交
446
static ssize_t
447
show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
448
{
449
	struct w83781d_data *data = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
450 451 452 453
	return sprintf(buf, "%ld\n", (long) data->vrm);
}

static ssize_t
454
store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
L
Linus Torvalds 已提交
455
{
456
	struct w83781d_data *data = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
457 458 459 460 461 462 463 464
	u32 val;

	val = simple_strtoul(buf, NULL, 10);
	data->vrm = val;

	return count;
}

465 466
static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg);

L
Linus Torvalds 已提交
467
static ssize_t
468
show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
469 470
{
	struct w83781d_data *data = w83781d_update_device(dev);
471
	return sprintf(buf, "%u\n", data->alarms);
L
Linus Torvalds 已提交
472 473
}

474 475
static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL);

476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508
static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
		char *buf)
{
	struct w83781d_data *data = w83781d_update_device(dev);
	int bitnr = to_sensor_dev_attr(attr)->index;
	return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
}

/* The W83781D has a single alarm bit for temp2 and temp3 */
static ssize_t show_temp3_alarm(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	struct w83781d_data *data = w83781d_update_device(dev);
	int bitnr = (data->type == w83781d) ? 5 : 13;
	return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
}

static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16);
static SENSOR_DEVICE_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17);
static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_temp3_alarm, NULL, 0);

509
static ssize_t show_beep_mask (struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
510 511 512 513 514 515 516
{
	struct w83781d_data *data = w83781d_update_device(dev);
	return sprintf(buf, "%ld\n",
		       (long)BEEP_MASK_FROM_REG(data->beep_mask, data->type));
}

static ssize_t
517 518
store_beep_mask(struct device *dev, struct device_attribute *attr,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
519
{
520
	struct w83781d_data *data = dev_get_drvdata(dev);
521
	u32 val;
L
Linus Torvalds 已提交
522 523 524

	val = simple_strtoul(buf, NULL, 10);

525
	mutex_lock(&data->update_lock);
526 527
	data->beep_mask &= 0x8000; /* preserve beep enable */
	data->beep_mask |= BEEP_MASK_TO_REG(val, data->type);
528 529 530
	w83781d_write_value(data, W83781D_REG_BEEP_INTS1,
			    data->beep_mask & 0xff);
	w83781d_write_value(data, W83781D_REG_BEEP_INTS2,
531
			    (data->beep_mask >> 8) & 0xff);
532 533 534 535 536
	if (data->type != w83781d && data->type != as99127f) {
		w83781d_write_value(data, W83781D_REG_BEEP_INTS3,
				    ((data->beep_mask) >> 16) & 0xff);
	}
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
537

538 539
	return count;
}
L
Linus Torvalds 已提交
540

541 542
static DEVICE_ATTR(beep_mask, S_IRUGO | S_IWUSR,
		show_beep_mask, store_beep_mask);
L
Linus Torvalds 已提交
543

544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636
static ssize_t show_beep(struct device *dev, struct device_attribute *attr,
		char *buf)
{
	struct w83781d_data *data = w83781d_update_device(dev);
	int bitnr = to_sensor_dev_attr(attr)->index;
	return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
}

static ssize_t
store_beep(struct device *dev, struct device_attribute *attr,
		const char *buf, size_t count)
{
	struct w83781d_data *data = dev_get_drvdata(dev);
	int bitnr = to_sensor_dev_attr(attr)->index;
	unsigned long bit;
	u8 reg;

	bit = simple_strtoul(buf, NULL, 10);
	if (bit & ~1)
		return -EINVAL;

	mutex_lock(&data->update_lock);
	if (bit)
		data->beep_mask |= (1 << bitnr);
	else
		data->beep_mask &= ~(1 << bitnr);

	if (bitnr < 8) {
		reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
		if (bit)
			reg |= (1 << bitnr);
		else
			reg &= ~(1 << bitnr);
		w83781d_write_value(data, W83781D_REG_BEEP_INTS1, reg);
	} else if (bitnr < 16) {
		reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
		if (bit)
			reg |= (1 << (bitnr - 8));
		else
			reg &= ~(1 << (bitnr - 8));
		w83781d_write_value(data, W83781D_REG_BEEP_INTS2, reg);
	} else {
		reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS3);
		if (bit)
			reg |= (1 << (bitnr - 16));
		else
			reg &= ~(1 << (bitnr - 16));
		w83781d_write_value(data, W83781D_REG_BEEP_INTS3, reg);
	}
	mutex_unlock(&data->update_lock);

	return count;
}

/* The W83781D has a single beep bit for temp2 and temp3 */
static ssize_t show_temp3_beep(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	struct w83781d_data *data = w83781d_update_device(dev);
	int bitnr = (data->type == w83781d) ? 5 : 13;
	return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
}

static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 0);
static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 1);
static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 2);
static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 3);
static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 8);
static SENSOR_DEVICE_ATTR(in5_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 9);
static SENSOR_DEVICE_ATTR(in6_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 10);
static SENSOR_DEVICE_ATTR(in7_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 16);
static SENSOR_DEVICE_ATTR(in8_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 17);
static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 6);
static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 7);
static SENSOR_DEVICE_ATTR(fan3_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 11);
static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 4);
static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 5);
static SENSOR_DEVICE_ATTR(temp3_beep, S_IRUGO,
			show_temp3_beep, store_beep, 13);
637 638
static SENSOR_DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR,
			show_beep, store_beep, 15);
639

L
Linus Torvalds 已提交
640
static ssize_t
641
show_fan_div(struct device *dev, struct device_attribute *da, char *buf)
L
Linus Torvalds 已提交
642
{
643
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
L
Linus Torvalds 已提交
644 645
	struct w83781d_data *data = w83781d_update_device(dev);
	return sprintf(buf, "%ld\n",
646
		       (long) DIV_FROM_REG(data->fan_div[attr->index]));
L
Linus Torvalds 已提交
647 648 649 650
}

/* Note: we save and restore the fan minimum here, because its value is
   determined in part by the fan divisor.  This follows the principle of
A
Andreas Mohr 已提交
651
   least surprise; the user doesn't expect the fan minimum to change just
L
Linus Torvalds 已提交
652 653
   because the divisor changed. */
static ssize_t
654 655
store_fan_div(struct device *dev, struct device_attribute *da,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
656
{
657
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
658
	struct w83781d_data *data = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
659
	unsigned long min;
660
	int nr = attr->index;
L
Linus Torvalds 已提交
661 662 663
	u8 reg;
	unsigned long val = simple_strtoul(buf, NULL, 10);

664
	mutex_lock(&data->update_lock);
J
Jean Delvare 已提交
665

L
Linus Torvalds 已提交
666 667 668 669 670 671
	/* Save fan_min */
	min = FAN_FROM_REG(data->fan_min[nr],
			   DIV_FROM_REG(data->fan_div[nr]));

	data->fan_div[nr] = DIV_TO_REG(val, data->type);

672
	reg = (w83781d_read_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV)
L
Linus Torvalds 已提交
673 674
	       & (nr==0 ? 0xcf : 0x3f))
	    | ((data->fan_div[nr] & 0x03) << (nr==0 ? 4 : 6));
675
	w83781d_write_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg);
L
Linus Torvalds 已提交
676 677 678

	/* w83781d and as99127f don't have extended divisor bits */
	if (data->type != w83781d && data->type != as99127f) {
679
		reg = (w83781d_read_value(data, W83781D_REG_VBAT)
L
Linus Torvalds 已提交
680 681
		       & ~(1 << (5 + nr)))
		    | ((data->fan_div[nr] & 0x04) << (3 + nr));
682
		w83781d_write_value(data, W83781D_REG_VBAT, reg);
L
Linus Torvalds 已提交
683 684 685 686
	}

	/* Restore fan_min */
	data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
687
	w83781d_write_value(data, W83781D_REG_FAN_MIN(nr), data->fan_min[nr]);
L
Linus Torvalds 已提交
688

689
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
690 691 692
	return count;
}

693 694 695 696 697 698
static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
		show_fan_div, store_fan_div, 0);
static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
		show_fan_div, store_fan_div, 1);
static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO | S_IWUSR,
		show_fan_div, store_fan_div, 2);
L
Linus Torvalds 已提交
699 700

static ssize_t
701
show_pwm(struct device *dev, struct device_attribute *da, char *buf)
L
Linus Torvalds 已提交
702
{
703
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
L
Linus Torvalds 已提交
704
	struct w83781d_data *data = w83781d_update_device(dev);
705
	return sprintf(buf, "%d\n", (int)data->pwm[attr->index]);
L
Linus Torvalds 已提交
706 707 708
}

static ssize_t
709
show_pwm2_enable(struct device *dev, struct device_attribute *da, char *buf)
L
Linus Torvalds 已提交
710 711
{
	struct w83781d_data *data = w83781d_update_device(dev);
712
	return sprintf(buf, "%d\n", (int)data->pwm2_enable);
L
Linus Torvalds 已提交
713 714 715
}

static ssize_t
716 717
store_pwm(struct device *dev, struct device_attribute *da, const char *buf,
		size_t count)
L
Linus Torvalds 已提交
718
{
719
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
720
	struct w83781d_data *data = dev_get_drvdata(dev);
721
	int nr = attr->index;
L
Linus Torvalds 已提交
722 723 724 725
	u32 val;

	val = simple_strtoul(buf, NULL, 10);

726
	mutex_lock(&data->update_lock);
727 728
	data->pwm[nr] = SENSORS_LIMIT(val, 0, 255);
	w83781d_write_value(data, W83781D_REG_PWM[nr], data->pwm[nr]);
729
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
730 731 732 733
	return count;
}

static ssize_t
734 735
store_pwm2_enable(struct device *dev, struct device_attribute *da,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
736
{
737
	struct w83781d_data *data = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
738 739 740 741
	u32 val, reg;

	val = simple_strtoul(buf, NULL, 10);

742
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
743 744 745 746

	switch (val) {
	case 0:
	case 1:
747 748
		reg = w83781d_read_value(data, W83781D_REG_PWMCLK12);
		w83781d_write_value(data, W83781D_REG_PWMCLK12,
L
Linus Torvalds 已提交
749 750
				    (reg & 0xf7) | (val << 3));

751 752
		reg = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
		w83781d_write_value(data, W83781D_REG_BEEP_CONFIG,
L
Linus Torvalds 已提交
753 754
				    (reg & 0xef) | (!val << 4));

755
		data->pwm2_enable = val;
L
Linus Torvalds 已提交
756 757 758
		break;

	default:
759
		mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
760 761 762
		return -EINVAL;
	}

763
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
764 765 766
	return count;
}

767 768 769 770 771 772 773
static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 0);
static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 1);
static SENSOR_DEVICE_ATTR(pwm3, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 2);
static SENSOR_DEVICE_ATTR(pwm4, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 3);
/* only PWM2 can be enabled/disabled */
static DEVICE_ATTR(pwm2_enable, S_IRUGO | S_IWUSR,
		show_pwm2_enable, store_pwm2_enable);
L
Linus Torvalds 已提交
774 775

static ssize_t
776
show_sensor(struct device *dev, struct device_attribute *da, char *buf)
L
Linus Torvalds 已提交
777
{
778
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
L
Linus Torvalds 已提交
779
	struct w83781d_data *data = w83781d_update_device(dev);
780
	return sprintf(buf, "%d\n", (int)data->sens[attr->index]);
L
Linus Torvalds 已提交
781 782 783
}

static ssize_t
784 785
store_sensor(struct device *dev, struct device_attribute *da,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
786
{
787
	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
788
	struct w83781d_data *data = dev_get_drvdata(dev);
789
	int nr = attr->index;
L
Linus Torvalds 已提交
790 791 792 793
	u32 val, tmp;

	val = simple_strtoul(buf, NULL, 10);

794
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
795 796 797

	switch (val) {
	case 1:		/* PII/Celeron diode */
798 799
		tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
		w83781d_write_value(data, W83781D_REG_SCFG1,
800
				    tmp | BIT_SCFG1[nr]);
801 802
		tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
		w83781d_write_value(data, W83781D_REG_SCFG2,
803 804
				    tmp | BIT_SCFG2[nr]);
		data->sens[nr] = val;
L
Linus Torvalds 已提交
805 806
		break;
	case 2:		/* 3904 */
807 808
		tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
		w83781d_write_value(data, W83781D_REG_SCFG1,
809
				    tmp | BIT_SCFG1[nr]);
810 811
		tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
		w83781d_write_value(data, W83781D_REG_SCFG2,
812 813
				    tmp & ~BIT_SCFG2[nr]);
		data->sens[nr] = val;
L
Linus Torvalds 已提交
814
		break;
J
Jean Delvare 已提交
815 816 817 818 819
	case W83781D_DEFAULT_BETA:
		dev_warn(dev, "Sensor type %d is deprecated, please use 4 "
			 "instead\n", W83781D_DEFAULT_BETA);
		/* fall through */
	case 4:		/* thermistor */
820 821
		tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
		w83781d_write_value(data, W83781D_REG_SCFG1,
822 823
				    tmp & ~BIT_SCFG1[nr]);
		data->sens[nr] = val;
L
Linus Torvalds 已提交
824 825
		break;
	default:
J
Jean Delvare 已提交
826 827
		dev_err(dev, "Invalid sensor type %ld; must be 1, 2, or 4\n",
		       (long) val);
L
Linus Torvalds 已提交
828 829 830
		break;
	}

831
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
832 833 834
	return count;
}

835 836 837
static SENSOR_DEVICE_ATTR(temp1_type, S_IRUGO | S_IWUSR,
	show_sensor, store_sensor, 0);
static SENSOR_DEVICE_ATTR(temp2_type, S_IRUGO | S_IWUSR,
838
	show_sensor, store_sensor, 1);
839
static SENSOR_DEVICE_ATTR(temp3_type, S_IRUGO | S_IWUSR,
840
	show_sensor, store_sensor, 2);
L
Linus Torvalds 已提交
841

842 843 844 845 846 847 848 849 850 851
/* I2C devices get this name attribute automatically, but for ISA devices
   we must create it by ourselves. */
static ssize_t
show_name(struct device *dev, struct device_attribute *devattr, char *buf)
{
	struct w83781d_data *data = dev_get_drvdata(dev);
	return sprintf(buf, "%s\n", data->client.name);
}
static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);

L
Linus Torvalds 已提交
852 853 854 855 856 857 858 859 860
/* This function is called when:
     * w83781d_driver is inserted (when this module is loaded), for each
       available adapter
     * when a new adapter is inserted (and w83781d_driver is still present) */
static int
w83781d_attach_adapter(struct i2c_adapter *adapter)
{
	if (!(adapter->class & I2C_CLASS_HWMON))
		return 0;
861
	return i2c_probe(adapter, &addr_data, w83781d_detect);
L
Linus Torvalds 已提交
862 863 864 865 866 867 868 869 870 871 872 873 874 875
}

/* Assumes that adapter is of I2C, not ISA variety.
 * OTHERWISE DON'T CALL THIS
 */
static int
w83781d_detect_subclients(struct i2c_adapter *adapter, int address, int kind,
		struct i2c_client *new_client)
{
	int i, val1 = 0, id;
	int err;
	const char *client_name = "";
	struct w83781d_data *data = i2c_get_clientdata(new_client);

D
Deepak Saxena 已提交
876
	data->lm75[0] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
L
Linus Torvalds 已提交
877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894
	if (!(data->lm75[0])) {
		err = -ENOMEM;
		goto ERROR_SC_0;
	}

	id = i2c_adapter_id(adapter);

	if (force_subclients[0] == id && force_subclients[1] == address) {
		for (i = 2; i <= 3; i++) {
			if (force_subclients[i] < 0x48 ||
			    force_subclients[i] > 0x4f) {
				dev_err(&new_client->dev, "Invalid subclient "
					"address %d; must be 0x48-0x4f\n",
					force_subclients[i]);
				err = -EINVAL;
				goto ERROR_SC_1;
			}
		}
895
		w83781d_write_value(data, W83781D_REG_I2C_SUBADDR,
L
Linus Torvalds 已提交
896 897 898 899
				(force_subclients[2] & 0x07) |
				((force_subclients[3] & 0x07) << 4));
		data->lm75[0]->addr = force_subclients[2];
	} else {
900
		val1 = w83781d_read_value(data, W83781D_REG_I2C_SUBADDR);
L
Linus Torvalds 已提交
901 902 903 904
		data->lm75[0]->addr = 0x48 + (val1 & 0x07);
	}

	if (kind != w83783s) {
D
Deepak Saxena 已提交
905
		data->lm75[1] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
L
Linus Torvalds 已提交
906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 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
		if (!(data->lm75[1])) {
			err = -ENOMEM;
			goto ERROR_SC_1;
		}

		if (force_subclients[0] == id &&
		    force_subclients[1] == address) {
			data->lm75[1]->addr = force_subclients[3];
		} else {
			data->lm75[1]->addr = 0x48 + ((val1 >> 4) & 0x07);
		}
		if (data->lm75[0]->addr == data->lm75[1]->addr) {
			dev_err(&new_client->dev,
			       "Duplicate addresses 0x%x for subclients.\n",
			       data->lm75[0]->addr);
			err = -EBUSY;
			goto ERROR_SC_2;
		}
	}

	if (kind == w83781d)
		client_name = "w83781d subclient";
	else if (kind == w83782d)
		client_name = "w83782d subclient";
	else if (kind == w83783s)
		client_name = "w83783s subclient";
	else if (kind == as99127f)
		client_name = "as99127f subclient";

	for (i = 0; i <= 1; i++) {
		/* store all data in w83781d */
		i2c_set_clientdata(data->lm75[i], NULL);
		data->lm75[i]->adapter = adapter;
		data->lm75[i]->driver = &w83781d_driver;
		data->lm75[i]->flags = 0;
		strlcpy(data->lm75[i]->name, client_name,
			I2C_NAME_SIZE);
		if ((err = i2c_attach_client(data->lm75[i]))) {
			dev_err(&new_client->dev, "Subclient %d "
				"registration at address 0x%x "
				"failed.\n", i, data->lm75[i]->addr);
			if (i == 1)
				goto ERROR_SC_3;
			goto ERROR_SC_2;
		}
		if (kind == w83783s)
			break;
	}

	return 0;

/* Undo inits in case of errors */
ERROR_SC_3:
	i2c_detach_client(data->lm75[0]);
ERROR_SC_2:
961
	kfree(data->lm75[1]);
L
Linus Torvalds 已提交
962
ERROR_SC_1:
963
	kfree(data->lm75[0]);
L
Linus Torvalds 已提交
964 965 966 967
ERROR_SC_0:
	return err;
}

968 969 970
#define IN_UNIT_ATTRS(X)					\
	&sensor_dev_attr_in##X##_input.dev_attr.attr,		\
	&sensor_dev_attr_in##X##_min.dev_attr.attr,		\
J
Jean Delvare 已提交
971
	&sensor_dev_attr_in##X##_max.dev_attr.attr,		\
972 973
	&sensor_dev_attr_in##X##_alarm.dev_attr.attr,		\
	&sensor_dev_attr_in##X##_beep.dev_attr.attr
974

975 976 977
#define FAN_UNIT_ATTRS(X)					\
	&sensor_dev_attr_fan##X##_input.dev_attr.attr,		\
	&sensor_dev_attr_fan##X##_min.dev_attr.attr,		\
978 979 980
	&sensor_dev_attr_fan##X##_div.dev_attr.attr,		\
	&sensor_dev_attr_fan##X##_alarm.dev_attr.attr,		\
	&sensor_dev_attr_fan##X##_beep.dev_attr.attr
981

982 983 984
#define TEMP_UNIT_ATTRS(X)					\
	&sensor_dev_attr_temp##X##_input.dev_attr.attr,		\
	&sensor_dev_attr_temp##X##_max.dev_attr.attr,		\
985 986 987
	&sensor_dev_attr_temp##X##_max_hyst.dev_attr.attr,	\
	&sensor_dev_attr_temp##X##_alarm.dev_attr.attr,		\
	&sensor_dev_attr_temp##X##_beep.dev_attr.attr
988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004

static struct attribute* w83781d_attributes[] = {
	IN_UNIT_ATTRS(0),
	IN_UNIT_ATTRS(2),
	IN_UNIT_ATTRS(3),
	IN_UNIT_ATTRS(4),
	IN_UNIT_ATTRS(5),
	IN_UNIT_ATTRS(6),
	FAN_UNIT_ATTRS(1),
	FAN_UNIT_ATTRS(2),
	FAN_UNIT_ATTRS(3),
	TEMP_UNIT_ATTRS(1),
	TEMP_UNIT_ATTRS(2),
	&dev_attr_cpu0_vid.attr,
	&dev_attr_vrm.attr,
	&dev_attr_alarms.attr,
	&dev_attr_beep_mask.attr,
1005
	&sensor_dev_attr_beep_enable.dev_attr.attr,
1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016
	NULL
};
static const struct attribute_group w83781d_group = {
	.attrs = w83781d_attributes,
};

static struct attribute *w83781d_attributes_opt[] = {
	IN_UNIT_ATTRS(1),
	IN_UNIT_ATTRS(7),
	IN_UNIT_ATTRS(8),
	TEMP_UNIT_ATTRS(3),
1017 1018 1019 1020
	&sensor_dev_attr_pwm1.dev_attr.attr,
	&sensor_dev_attr_pwm2.dev_attr.attr,
	&sensor_dev_attr_pwm3.dev_attr.attr,
	&sensor_dev_attr_pwm4.dev_attr.attr,
1021
	&dev_attr_pwm2_enable.attr,
1022 1023 1024
	&sensor_dev_attr_temp1_type.dev_attr.attr,
	&sensor_dev_attr_temp2_type.dev_attr.attr,
	&sensor_dev_attr_temp3_type.dev_attr.attr,
1025 1026 1027 1028 1029 1030
	NULL
};
static const struct attribute_group w83781d_group_opt = {
	.attrs = w83781d_attributes_opt,
};

1031
/* No clean up is done on error, it's up to the caller */
L
Linus Torvalds 已提交
1032
static int
1033
w83781d_create_files(struct device *dev, int kind, int is_isa)
L
Linus Torvalds 已提交
1034 1035 1036
{
	int err;

1037 1038 1039 1040
	if ((err = sysfs_create_group(&dev->kobj, &w83781d_group)))
		return err;

	if (kind != w83783s) {
1041 1042 1043 1044 1045
		if ((err = device_create_file(dev,
				&sensor_dev_attr_in1_input.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in1_min.dev_attr))
		    || (err = device_create_file(dev,
1046 1047 1048 1049 1050
				&sensor_dev_attr_in1_max.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in1_alarm.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in1_beep.dev_attr)))
1051 1052 1053
			return err;
	}
	if (kind != as99127f && kind != w83781d && kind != w83783s) {
1054 1055 1056 1057 1058 1059
		if ((err = device_create_file(dev,
				&sensor_dev_attr_in7_input.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in7_min.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in7_max.dev_attr))
1060 1061 1062 1063
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in7_alarm.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in7_beep.dev_attr))
1064 1065 1066 1067 1068
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in8_input.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in8_min.dev_attr))
		    || (err = device_create_file(dev,
1069 1070 1071 1072 1073
				&sensor_dev_attr_in8_max.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in8_alarm.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_in8_beep.dev_attr)))
1074 1075 1076
			return err;
	}
	if (kind != w83783s) {
1077 1078 1079 1080
		if ((err = device_create_file(dev,
				&sensor_dev_attr_temp3_input.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_temp3_max.dev_attr))
1081
		    || (err = device_create_file(dev,
1082 1083 1084 1085 1086
				&sensor_dev_attr_temp3_max_hyst.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_temp3_alarm.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_temp3_beep.dev_attr)))
1087
			return err;
1088

1089
		if (kind != w83781d) {
1090 1091 1092 1093 1094
			err = sysfs_chmod_file(&dev->kobj,
				&sensor_dev_attr_temp3_alarm.dev_attr.attr,
				S_IRUGO | S_IWUSR);
			if (err)
				return err;
1095
		}
L
Linus Torvalds 已提交
1096 1097
	}

1098
	if (kind != w83781d && kind != as99127f) {
1099 1100 1101 1102
		if ((err = device_create_file(dev,
				&sensor_dev_attr_pwm1.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_pwm2.dev_attr))
1103 1104
		    || (err = device_create_file(dev, &dev_attr_pwm2_enable)))
			return err;
L
Linus Torvalds 已提交
1105
	}
1106
	if (kind == w83782d && !is_isa) {
1107 1108 1109 1110
		if ((err = device_create_file(dev,
				&sensor_dev_attr_pwm3.dev_attr))
		    || (err = device_create_file(dev,
				&sensor_dev_attr_pwm4.dev_attr)))
1111 1112 1113 1114
			return err;
	}

	if (kind != as99127f && kind != w83781d) {
1115 1116
		if ((err = device_create_file(dev,
				&sensor_dev_attr_temp1_type.dev_attr))
1117
		    || (err = device_create_file(dev,
1118
				&sensor_dev_attr_temp2_type.dev_attr)))
1119 1120 1121
			return err;
		if (kind != w83783s) {
			if ((err = device_create_file(dev,
1122
					&sensor_dev_attr_temp3_type.dev_attr)))
1123
				return err;
L
Linus Torvalds 已提交
1124
		}
1125
	}
L
Linus Torvalds 已提交
1126

1127 1128 1129 1130 1131
	if (is_isa) {
		err = device_create_file(&pdev->dev, &dev_attr_name);
		if (err)
			return err;
	}
L
Linus Torvalds 已提交
1132

1133 1134
	return 0;
}
L
Linus Torvalds 已提交
1135

1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149
static int
w83781d_detect(struct i2c_adapter *adapter, int address, int kind)
{
	int val1 = 0, val2;
	struct i2c_client *client;
	struct device *dev;
	struct w83781d_data *data;
	int err;
	const char *client_name = "";
	enum vendor { winbond, asus } vendid;

	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
		err = -EINVAL;
		goto ERROR1;
L
Linus Torvalds 已提交
1150 1151 1152 1153 1154 1155
	}

	/* OK. For now, we presume we have a valid client. We now create the
	   client structure, even though we cannot fill it completely yet.
	   But it allows us to access w83781d_{read,write}_value. */

D
Deepak Saxena 已提交
1156
	if (!(data = kzalloc(sizeof(struct w83781d_data), GFP_KERNEL))) {
L
Linus Torvalds 已提交
1157 1158 1159 1160
		err = -ENOMEM;
		goto ERROR1;
	}

1161 1162 1163
	client = &data->client;
	i2c_set_clientdata(client, data);
	client->addr = address;
1164
	mutex_init(&data->lock);
1165
	client->adapter = adapter;
1166
	client->driver = &w83781d_driver;
1167
	dev = &client->dev;
L
Linus Torvalds 已提交
1168 1169 1170 1171 1172 1173 1174 1175

	/* Now, we do the remaining detection. */

	/* The w8378?d may be stuck in some other bank than bank 0. This may
	   make reading other information impossible. Specify a force=... or
	   force_*=... parameter, and the Winbond will be reset to the right
	   bank. */
	if (kind < 0) {
1176
		if (w83781d_read_value(data, W83781D_REG_CONFIG) & 0x80) {
1177 1178
			dev_dbg(&adapter->dev, "Detection of w83781d chip "
				"failed at step 3\n");
L
Linus Torvalds 已提交
1179 1180 1181
			err = -ENODEV;
			goto ERROR2;
		}
1182 1183
		val1 = w83781d_read_value(data, W83781D_REG_BANK);
		val2 = w83781d_read_value(data, W83781D_REG_CHIPMAN);
L
Linus Torvalds 已提交
1184 1185 1186 1187
		/* Check for Winbond or Asus ID if in bank 0 */
		if ((!(val1 & 0x07)) &&
		    (((!(val1 & 0x80)) && (val2 != 0xa3) && (val2 != 0xc3))
		     || ((val1 & 0x80) && (val2 != 0x5c) && (val2 != 0x12)))) {
1188 1189
			dev_dbg(&adapter->dev, "Detection of w83781d chip "
				"failed at step 4\n");
L
Linus Torvalds 已提交
1190 1191 1192 1193 1194
			err = -ENODEV;
			goto ERROR2;
		}
		/* If Winbond SMBus, check address at 0x48.
		   Asus doesn't support, except for as99127f rev.2 */
1195 1196
		if ((!(val1 & 0x80) && (val2 == 0xa3)) ||
		    ((val1 & 0x80) && (val2 == 0x5c))) {
L
Linus Torvalds 已提交
1197
			if (w83781d_read_value
1198
			    (data, W83781D_REG_I2C_ADDR) != address) {
1199 1200
				dev_dbg(&adapter->dev, "Detection of w83781d "
					"chip failed at step 5\n");
L
Linus Torvalds 已提交
1201 1202 1203 1204 1205 1206 1207 1208
				err = -ENODEV;
				goto ERROR2;
			}
		}
	}

	/* We have either had a force parameter, or we have already detected the
	   Winbond. Put it now into bank 0 and Vendor ID High Byte */
1209 1210
	w83781d_write_value(data, W83781D_REG_BANK,
			    (w83781d_read_value(data, W83781D_REG_BANK)
1211
			     & 0x78) | 0x80);
L
Linus Torvalds 已提交
1212 1213 1214 1215

	/* Determine the chip type. */
	if (kind <= 0) {
		/* get vendor ID */
1216
		val2 = w83781d_read_value(data, W83781D_REG_CHIPMAN);
L
Linus Torvalds 已提交
1217 1218 1219 1220 1221
		if (val2 == 0x5c)
			vendid = winbond;
		else if (val2 == 0x12)
			vendid = asus;
		else {
1222 1223
			dev_dbg(&adapter->dev, "w83781d chip vendor is "
				"neither Winbond nor Asus\n");
L
Linus Torvalds 已提交
1224 1225 1226 1227
			err = -ENODEV;
			goto ERROR2;
		}

1228
		val1 = w83781d_read_value(data, W83781D_REG_WCHIPID);
L
Linus Torvalds 已提交
1229 1230 1231 1232
		if ((val1 == 0x10 || val1 == 0x11) && vendid == winbond)
			kind = w83781d;
		else if (val1 == 0x30 && vendid == winbond)
			kind = w83782d;
1233
		else if (val1 == 0x40 && vendid == winbond && address == 0x2d)
L
Linus Torvalds 已提交
1234
			kind = w83783s;
1235
		else if (val1 == 0x31)
L
Linus Torvalds 已提交
1236 1237 1238
			kind = as99127f;
		else {
			if (kind == 0)
1239
				dev_warn(&adapter->dev, "Ignoring 'force' "
L
Linus Torvalds 已提交
1240
					 "parameter for unknown chip at "
1241
					 "address 0x%02x\n", address);
L
Linus Torvalds 已提交
1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257
			err = -EINVAL;
			goto ERROR2;
		}
	}

	if (kind == w83781d) {
		client_name = "w83781d";
	} else if (kind == w83782d) {
		client_name = "w83782d";
	} else if (kind == w83783s) {
		client_name = "w83783s";
	} else if (kind == as99127f) {
		client_name = "as99127f";
	}

	/* Fill in the remaining client fields and put into the global list */
1258
	strlcpy(client->name, client_name, I2C_NAME_SIZE);
L
Linus Torvalds 已提交
1259 1260 1261
	data->type = kind;

	/* Tell the I2C layer a new client has arrived */
1262
	if ((err = i2c_attach_client(client)))
L
Linus Torvalds 已提交
1263 1264 1265
		goto ERROR2;

	/* attach secondary i2c lm75-like clients */
1266 1267 1268
	if ((err = w83781d_detect_subclients(adapter, address,
			kind, client)))
		goto ERROR3;
L
Linus Torvalds 已提交
1269 1270

	/* Initialize the chip */
1271
	w83781d_init_device(dev);
L
Linus Torvalds 已提交
1272 1273

	/* Register sysfs hooks */
1274 1275
	err = w83781d_create_files(dev, kind, 0);
	if (err)
1276 1277
		goto ERROR4;

1278 1279 1280
	data->hwmon_dev = hwmon_device_register(dev);
	if (IS_ERR(data->hwmon_dev)) {
		err = PTR_ERR(data->hwmon_dev);
1281
		goto ERROR4;
L
Linus Torvalds 已提交
1282 1283 1284 1285
	}

	return 0;

1286
ERROR4:
1287 1288 1289
	sysfs_remove_group(&dev->kobj, &w83781d_group);
	sysfs_remove_group(&dev->kobj, &w83781d_group_opt);

1290 1291 1292 1293 1294 1295 1296 1297
	if (data->lm75[1]) {
		i2c_detach_client(data->lm75[1]);
		kfree(data->lm75[1]);
	}
	if (data->lm75[0]) {
		i2c_detach_client(data->lm75[0]);
		kfree(data->lm75[0]);
	}
L
Linus Torvalds 已提交
1298
ERROR3:
1299
	i2c_detach_client(client);
L
Linus Torvalds 已提交
1300 1301 1302 1303 1304 1305 1306 1307 1308
ERROR2:
	kfree(data);
ERROR1:
	return err;
}

static int
w83781d_detach_client(struct i2c_client *client)
{
1309
	struct w83781d_data *data = i2c_get_clientdata(client);
L
Linus Torvalds 已提交
1310 1311
	int err;

1312
	/* main client */
1313
	if (data) {
1314
		hwmon_device_unregister(data->hwmon_dev);
1315 1316 1317
		sysfs_remove_group(&client->dev.kobj, &w83781d_group);
		sysfs_remove_group(&client->dev.kobj, &w83781d_group_opt);
	}
L
Linus Torvalds 已提交
1318

1319
	if ((err = i2c_detach_client(client)))
L
Linus Torvalds 已提交
1320 1321
		return err;

1322 1323 1324 1325 1326 1327
	/* main client */
	if (data)
		kfree(data);

	/* subclient */
	else
L
Linus Torvalds 已提交
1328 1329 1330 1331 1332
		kfree(client);

	return 0;
}

1333 1334 1335 1336 1337 1338 1339 1340 1341 1342
static int __devinit
w83781d_isa_probe(struct platform_device *pdev)
{
	int err, reg;
	struct w83781d_data *data;
	struct resource *res;
	const char *name;

	/* Reserve the ISA region */
	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1343 1344
	if (!request_region(res->start + W83781D_ADDR_REG_OFFSET, 2,
			    "w83781d")) {
1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357
		err = -EBUSY;
		goto exit;
	}

	if (!(data = kzalloc(sizeof(struct w83781d_data), GFP_KERNEL))) {
		err = -ENOMEM;
		goto exit_release_region;
	}
	mutex_init(&data->lock);
	data->client.addr = res->start;
	i2c_set_clientdata(&data->client, data);
	platform_set_drvdata(pdev, data);

1358
	reg = w83781d_read_value(data, W83781D_REG_WCHIPID);
1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377
	switch (reg) {
	case 0x30:
		data->type = w83782d;
		name = "w83782d";
		break;
	default:
		data->type = w83781d;
		name = "w83781d";
	}
	strlcpy(data->client.name, name, I2C_NAME_SIZE);

	/* Initialize the W83781D chip */
	w83781d_init_device(&pdev->dev);

	/* Register sysfs hooks */
	err = w83781d_create_files(&pdev->dev, data->type, 1);
	if (err)
		goto exit_remove_files;

1378 1379 1380
	data->hwmon_dev = hwmon_device_register(&pdev->dev);
	if (IS_ERR(data->hwmon_dev)) {
		err = PTR_ERR(data->hwmon_dev);
1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391
		goto exit_remove_files;
	}

	return 0;

 exit_remove_files:
	sysfs_remove_group(&pdev->dev.kobj, &w83781d_group);
	sysfs_remove_group(&pdev->dev.kobj, &w83781d_group_opt);
	device_remove_file(&pdev->dev, &dev_attr_name);
	kfree(data);
 exit_release_region:
1392
	release_region(res->start + W83781D_ADDR_REG_OFFSET, 2);
1393 1394 1395 1396 1397 1398 1399 1400 1401
 exit:
	return err;
}

static int __devexit
w83781d_isa_remove(struct platform_device *pdev)
{
	struct w83781d_data *data = platform_get_drvdata(pdev);

1402
	hwmon_device_unregister(data->hwmon_dev);
1403 1404 1405
	sysfs_remove_group(&pdev->dev.kobj, &w83781d_group);
	sysfs_remove_group(&pdev->dev.kobj, &w83781d_group_opt);
	device_remove_file(&pdev->dev, &dev_attr_name);
1406
	release_region(data->client.addr + W83781D_ADDR_REG_OFFSET, 2);
1407 1408 1409 1410 1411
	kfree(data);

	return 0;
}

L
Linus Torvalds 已提交
1412
/* The SMBus locks itself, usually, but nothing may access the Winbond between
J
Jean Delvare 已提交
1413
   bank switches. ISA access must always be locked explicitly!
L
Linus Torvalds 已提交
1414
   We ignore the W83781D BUSY flag at this moment - it could lead to deadlocks,
J
Jean Delvare 已提交
1415
   would slow down the W83781D access and should not be necessary.
L
Linus Torvalds 已提交
1416 1417 1418
   There are some ugly typecasts here, but the good news is - they should
   nowhere else be necessary! */
static int
1419
w83781d_read_value(struct w83781d_data *data, u16 reg)
L
Linus Torvalds 已提交
1420
{
1421
	struct i2c_client *client = &data->client;
L
Linus Torvalds 已提交
1422 1423 1424
	int res, word_sized, bank;
	struct i2c_client *cl;

1425
	mutex_lock(&data->lock);
1426
	if (!client->driver) { /* ISA device */
L
Linus Torvalds 已提交
1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482
		word_sized = (((reg & 0xff00) == 0x100)
			      || ((reg & 0xff00) == 0x200))
		    && (((reg & 0x00ff) == 0x50)
			|| ((reg & 0x00ff) == 0x53)
			|| ((reg & 0x00ff) == 0x55));
		if (reg & 0xff00) {
			outb_p(W83781D_REG_BANK,
			       client->addr + W83781D_ADDR_REG_OFFSET);
			outb_p(reg >> 8,
			       client->addr + W83781D_DATA_REG_OFFSET);
		}
		outb_p(reg & 0xff, client->addr + W83781D_ADDR_REG_OFFSET);
		res = inb_p(client->addr + W83781D_DATA_REG_OFFSET);
		if (word_sized) {
			outb_p((reg & 0xff) + 1,
			       client->addr + W83781D_ADDR_REG_OFFSET);
			res =
			    (res << 8) + inb_p(client->addr +
					       W83781D_DATA_REG_OFFSET);
		}
		if (reg & 0xff00) {
			outb_p(W83781D_REG_BANK,
			       client->addr + W83781D_ADDR_REG_OFFSET);
			outb_p(0, client->addr + W83781D_DATA_REG_OFFSET);
		}
	} else {
		bank = (reg >> 8) & 0x0f;
		if (bank > 2)
			/* switch banks */
			i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
						  bank);
		if (bank == 0 || bank > 2) {
			res = i2c_smbus_read_byte_data(client, reg & 0xff);
		} else {
			/* switch to subclient */
			cl = data->lm75[bank - 1];
			/* convert from ISA to LM75 I2C addresses */
			switch (reg & 0xff) {
			case 0x50:	/* TEMP */
				res = swab16(i2c_smbus_read_word_data(cl, 0));
				break;
			case 0x52:	/* CONFIG */
				res = i2c_smbus_read_byte_data(cl, 1);
				break;
			case 0x53:	/* HYST */
				res = swab16(i2c_smbus_read_word_data(cl, 2));
				break;
			case 0x55:	/* OVER */
			default:
				res = swab16(i2c_smbus_read_word_data(cl, 3));
				break;
			}
		}
		if (bank > 2)
			i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
	}
1483
	mutex_unlock(&data->lock);
L
Linus Torvalds 已提交
1484 1485 1486 1487
	return res;
}

static int
1488
w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value)
L
Linus Torvalds 已提交
1489
{
1490
	struct i2c_client *client = &data->client;
L
Linus Torvalds 已提交
1491 1492 1493
	int word_sized, bank;
	struct i2c_client *cl;

1494
	mutex_lock(&data->lock);
1495
	if (!client->driver) { /* ISA device */
L
Linus Torvalds 已提交
1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546
		word_sized = (((reg & 0xff00) == 0x100)
			      || ((reg & 0xff00) == 0x200))
		    && (((reg & 0x00ff) == 0x53)
			|| ((reg & 0x00ff) == 0x55));
		if (reg & 0xff00) {
			outb_p(W83781D_REG_BANK,
			       client->addr + W83781D_ADDR_REG_OFFSET);
			outb_p(reg >> 8,
			       client->addr + W83781D_DATA_REG_OFFSET);
		}
		outb_p(reg & 0xff, client->addr + W83781D_ADDR_REG_OFFSET);
		if (word_sized) {
			outb_p(value >> 8,
			       client->addr + W83781D_DATA_REG_OFFSET);
			outb_p((reg & 0xff) + 1,
			       client->addr + W83781D_ADDR_REG_OFFSET);
		}
		outb_p(value & 0xff, client->addr + W83781D_DATA_REG_OFFSET);
		if (reg & 0xff00) {
			outb_p(W83781D_REG_BANK,
			       client->addr + W83781D_ADDR_REG_OFFSET);
			outb_p(0, client->addr + W83781D_DATA_REG_OFFSET);
		}
	} else {
		bank = (reg >> 8) & 0x0f;
		if (bank > 2)
			/* switch banks */
			i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
						  bank);
		if (bank == 0 || bank > 2) {
			i2c_smbus_write_byte_data(client, reg & 0xff,
						  value & 0xff);
		} else {
			/* switch to subclient */
			cl = data->lm75[bank - 1];
			/* convert from ISA to LM75 I2C addresses */
			switch (reg & 0xff) {
			case 0x52:	/* CONFIG */
				i2c_smbus_write_byte_data(cl, 1, value & 0xff);
				break;
			case 0x53:	/* HYST */
				i2c_smbus_write_word_data(cl, 2, swab16(value));
				break;
			case 0x55:	/* OVER */
				i2c_smbus_write_word_data(cl, 3, swab16(value));
				break;
			}
		}
		if (bank > 2)
			i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
	}
1547
	mutex_unlock(&data->lock);
L
Linus Torvalds 已提交
1548 1549 1550 1551
	return 0;
}

static void
1552
w83781d_init_device(struct device *dev)
L
Linus Torvalds 已提交
1553
{
1554
	struct w83781d_data *data = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
1555 1556 1557 1558
	int i, p;
	int type = data->type;
	u8 tmp;

1559
	if (reset && type != as99127f) { /* this resets registers we don't have
L
Linus Torvalds 已提交
1560
					   documentation for on the as99127f */
1561 1562 1563 1564 1565 1566
		/* Resetting the chip has been the default for a long time,
		   but it causes the BIOS initializations (fan clock dividers,
		   thermal sensor types...) to be lost, so it is now optional.
		   It might even go away if nobody reports it as being useful,
		   as I see very little reason why this would be needed at
		   all. */
1567
		dev_info(dev, "If reset=1 solved a problem you were "
1568 1569
			 "having, please report!\n");

L
Linus Torvalds 已提交
1570
		/* save these registers */
1571 1572
		i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
		p = w83781d_read_value(data, W83781D_REG_PWMCLK12);
L
Linus Torvalds 已提交
1573 1574
		/* Reset all except Watchdog values and last conversion values
		   This sets fan-divs to 2, among others */
1575
		w83781d_write_value(data, W83781D_REG_CONFIG, 0x80);
L
Linus Torvalds 已提交
1576 1577
		/* Restore the registers and disable power-on abnormal beep.
		   This saves FAN 1/2/3 input/output values set by BIOS. */
1578 1579
		w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
		w83781d_write_value(data, W83781D_REG_PWMCLK12, p);
L
Linus Torvalds 已提交
1580 1581 1582
		/* Disable master beep-enable (reset turns it on).
		   Individual beep_mask should be reset to off but for some reason
		   disabling this bit helps some people not get beeped */
1583
		w83781d_write_value(data, W83781D_REG_BEEP_INTS2, 0);
L
Linus Torvalds 已提交
1584 1585
	}

1586 1587 1588
	/* Disable power-on abnormal beep, as advised by the datasheet.
	   Already done if reset=1. */
	if (init && !reset && type != as99127f) {
1589 1590
		i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
		w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
1591 1592
	}

1593
	data->vrm = vid_which_vrm();
L
Linus Torvalds 已提交
1594 1595

	if ((type != w83781d) && (type != as99127f)) {
1596
		tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
L
Linus Torvalds 已提交
1597 1598
		for (i = 1; i <= 3; i++) {
			if (!(tmp & BIT_SCFG1[i - 1])) {
J
Jean Delvare 已提交
1599
				data->sens[i - 1] = 4;
L
Linus Torvalds 已提交
1600 1601
			} else {
				if (w83781d_read_value
1602
				    (data,
L
Linus Torvalds 已提交
1603 1604 1605 1606 1607
				     W83781D_REG_SCFG2) & BIT_SCFG2[i - 1])
					data->sens[i - 1] = 1;
				else
					data->sens[i - 1] = 2;
			}
1608
			if (type == w83783s && i == 2)
L
Linus Torvalds 已提交
1609 1610 1611 1612 1613 1614
				break;
		}
	}

	if (init && type != as99127f) {
		/* Enable temp2 */
1615
		tmp = w83781d_read_value(data, W83781D_REG_TEMP2_CONFIG);
L
Linus Torvalds 已提交
1616
		if (tmp & 0x01) {
1617
			dev_warn(dev, "Enabling temp2, readings "
L
Linus Torvalds 已提交
1618
				 "might not make sense\n");
1619
			w83781d_write_value(data, W83781D_REG_TEMP2_CONFIG,
L
Linus Torvalds 已提交
1620 1621 1622 1623
				tmp & 0xfe);
		}

		/* Enable temp3 */
1624
		if (type != w83783s) {
1625
			tmp = w83781d_read_value(data,
L
Linus Torvalds 已提交
1626 1627
				W83781D_REG_TEMP3_CONFIG);
			if (tmp & 0x01) {
1628
				dev_warn(dev, "Enabling temp3, "
L
Linus Torvalds 已提交
1629
					 "readings might not make sense\n");
1630
				w83781d_write_value(data,
L
Linus Torvalds 已提交
1631 1632 1633 1634 1635 1636
					W83781D_REG_TEMP3_CONFIG, tmp & 0xfe);
			}
		}
	}

	/* Start monitoring */
1637 1638
	w83781d_write_value(data, W83781D_REG_CONFIG,
			    (w83781d_read_value(data,
L
Linus Torvalds 已提交
1639 1640
						W83781D_REG_CONFIG) & 0xf7)
			    | 0x01);
1641 1642

	/* A few vars need to be filled upon startup */
1643 1644
	for (i = 0; i < 3; i++) {
		data->fan_min[i] = w83781d_read_value(data,
1645 1646 1647 1648
					W83781D_REG_FAN_MIN(i));
	}

	mutex_init(&data->update_lock);
L
Linus Torvalds 已提交
1649 1650 1651 1652
}

static struct w83781d_data *w83781d_update_device(struct device *dev)
{
1653 1654
	struct w83781d_data *data = dev_get_drvdata(dev);
	struct i2c_client *client = &data->client;
L
Linus Torvalds 已提交
1655 1656
	int i;

1657
	mutex_lock(&data->update_lock);
L
Linus Torvalds 已提交
1658 1659 1660 1661 1662 1663

	if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
	    || !data->valid) {
		dev_dbg(dev, "Starting device update\n");

		for (i = 0; i <= 8; i++) {
1664
			if (data->type == w83783s && i == 1)
L
Linus Torvalds 已提交
1665 1666
				continue;	/* 783S has no in1 */
			data->in[i] =
1667
			    w83781d_read_value(data, W83781D_REG_IN(i));
L
Linus Torvalds 已提交
1668
			data->in_min[i] =
1669
			    w83781d_read_value(data, W83781D_REG_IN_MIN(i));
L
Linus Torvalds 已提交
1670
			data->in_max[i] =
1671
			    w83781d_read_value(data, W83781D_REG_IN_MAX(i));
1672
			if ((data->type != w83782d) && (i == 6))
L
Linus Torvalds 已提交
1673 1674
				break;
		}
1675 1676
		for (i = 0; i < 3; i++) {
			data->fan[i] =
1677
			    w83781d_read_value(data, W83781D_REG_FAN(i));
1678
			data->fan_min[i] =
1679
			    w83781d_read_value(data, W83781D_REG_FAN_MIN(i));
L
Linus Torvalds 已提交
1680 1681
		}
		if (data->type != w83781d && data->type != as99127f) {
1682 1683
			for (i = 0; i < 4; i++) {
				data->pwm[i] =
1684
				    w83781d_read_value(data,
1685
						       W83781D_REG_PWM[i]);
1686
				if ((data->type != w83782d || !client->driver)
1687
				    && i == 1)
L
Linus Torvalds 已提交
1688 1689 1690
					break;
			}
			/* Only PWM2 can be disabled */
1691
			data->pwm2_enable = (w83781d_read_value(data,
L
Linus Torvalds 已提交
1692 1693 1694
					      W83781D_REG_PWMCLK12) & 0x08) >> 3;
		}

1695
		data->temp = w83781d_read_value(data, W83781D_REG_TEMP(1));
L
Linus Torvalds 已提交
1696
		data->temp_max =
1697
		    w83781d_read_value(data, W83781D_REG_TEMP_OVER(1));
L
Linus Torvalds 已提交
1698
		data->temp_max_hyst =
1699
		    w83781d_read_value(data, W83781D_REG_TEMP_HYST(1));
L
Linus Torvalds 已提交
1700
		data->temp_add[0] =
1701
		    w83781d_read_value(data, W83781D_REG_TEMP(2));
L
Linus Torvalds 已提交
1702
		data->temp_max_add[0] =
1703
		    w83781d_read_value(data, W83781D_REG_TEMP_OVER(2));
L
Linus Torvalds 已提交
1704
		data->temp_max_hyst_add[0] =
1705
		    w83781d_read_value(data, W83781D_REG_TEMP_HYST(2));
1706
		if (data->type != w83783s) {
L
Linus Torvalds 已提交
1707
			data->temp_add[1] =
1708
			    w83781d_read_value(data, W83781D_REG_TEMP(3));
L
Linus Torvalds 已提交
1709
			data->temp_max_add[1] =
1710
			    w83781d_read_value(data,
L
Linus Torvalds 已提交
1711 1712
					       W83781D_REG_TEMP_OVER(3));
			data->temp_max_hyst_add[1] =
1713
			    w83781d_read_value(data,
L
Linus Torvalds 已提交
1714 1715
					       W83781D_REG_TEMP_HYST(3));
		}
1716
		i = w83781d_read_value(data, W83781D_REG_VID_FANDIV);
1717
		data->vid = i & 0x0f;
1718
		data->vid |= (w83781d_read_value(data,
1719
					W83781D_REG_CHIPID) & 0x01) << 4;
L
Linus Torvalds 已提交
1720 1721
		data->fan_div[0] = (i >> 4) & 0x03;
		data->fan_div[1] = (i >> 6) & 0x03;
1722
		data->fan_div[2] = (w83781d_read_value(data,
1723
					W83781D_REG_PIN) >> 6) & 0x03;
L
Linus Torvalds 已提交
1724
		if ((data->type != w83781d) && (data->type != as99127f)) {
1725
			i = w83781d_read_value(data, W83781D_REG_VBAT);
L
Linus Torvalds 已提交
1726 1727
			data->fan_div[0] |= (i >> 3) & 0x04;
			data->fan_div[1] |= (i >> 4) & 0x04;
1728
			data->fan_div[2] |= (i >> 5) & 0x04;
L
Linus Torvalds 已提交
1729
		}
1730
		if (data->type == w83782d) {
1731
			data->alarms = w83781d_read_value(data,
1732
						W83782D_REG_ALARM1)
1733
				     | (w83781d_read_value(data,
1734
						W83782D_REG_ALARM2) << 8)
1735
				     | (w83781d_read_value(data,
1736 1737
						W83782D_REG_ALARM3) << 16);
		} else if (data->type == w83783s) {
1738
			data->alarms = w83781d_read_value(data,
1739
						W83782D_REG_ALARM1)
1740
				     | (w83781d_read_value(data,
1741 1742 1743 1744
						W83782D_REG_ALARM2) << 8);
		} else {
			/* No real-time status registers, fall back to
			   interrupt status registers */
1745
			data->alarms = w83781d_read_value(data,
1746
						W83781D_REG_ALARM1)
1747
				     | (w83781d_read_value(data,
1748
						W83781D_REG_ALARM2) << 8);
L
Linus Torvalds 已提交
1749
		}
1750
		i = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
1751
		data->beep_mask = (i << 8) +
1752
		    w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
L
Linus Torvalds 已提交
1753 1754
		if ((data->type != w83781d) && (data->type != as99127f)) {
			data->beep_mask |=
1755
			    w83781d_read_value(data,
L
Linus Torvalds 已提交
1756 1757 1758 1759 1760 1761
					       W83781D_REG_BEEP_INTS3) << 16;
		}
		data->last_updated = jiffies;
		data->valid = 1;
	}

1762
	mutex_unlock(&data->update_lock);
L
Linus Torvalds 已提交
1763 1764 1765 1766

	return data;
}

1767 1768 1769 1770 1771 1772
/* return 1 if a supported chip is found, 0 otherwise */
static int __init
w83781d_isa_found(unsigned short address)
{
	int val, save, found = 0;

1773 1774 1775 1776
	/* We have to request the region in two parts because some
	   boards declare base+4 to base+7 as a PNP device */
	if (!request_region(address, 4, "w83781d")) {
		pr_debug("w83781d: Failed to request low part of region\n");
1777
		return 0;
1778 1779 1780 1781 1782 1783
	}
	if (!request_region(address + 4, 4, "w83781d")) {
		pr_debug("w83781d: Failed to request high part of region\n");
		release_region(address, 4);
		return 0;
	}
1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847

#define REALLY_SLOW_IO
	/* We need the timeouts for at least some W83781D-like
	   chips. But only if we read 'undefined' registers. */
	val = inb_p(address + 1);
	if (inb_p(address + 2) != val
	 || inb_p(address + 3) != val
	 || inb_p(address + 7) != val) {
		pr_debug("w83781d: Detection failed at step 1\n");
		goto release;
	}
#undef REALLY_SLOW_IO

	/* We should be able to change the 7 LSB of the address port. The
	   MSB (busy flag) should be clear initially, set after the write. */
	save = inb_p(address + W83781D_ADDR_REG_OFFSET);
	if (save & 0x80) {
		pr_debug("w83781d: Detection failed at step 2\n");
		goto release;
	}
	val = ~save & 0x7f;
	outb_p(val, address + W83781D_ADDR_REG_OFFSET);
	if (inb_p(address + W83781D_ADDR_REG_OFFSET) != (val | 0x80)) {
		outb_p(save, address + W83781D_ADDR_REG_OFFSET);
		pr_debug("w83781d: Detection failed at step 3\n");
		goto release;
	}

	/* We found a device, now see if it could be a W83781D */
	outb_p(W83781D_REG_CONFIG, address + W83781D_ADDR_REG_OFFSET);
	val = inb_p(address + W83781D_DATA_REG_OFFSET);
	if (val & 0x80) {
		pr_debug("w83781d: Detection failed at step 4\n");
		goto release;
	}
	outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
	save = inb_p(address + W83781D_DATA_REG_OFFSET);
	outb_p(W83781D_REG_CHIPMAN, address + W83781D_ADDR_REG_OFFSET);
	val = inb_p(address + W83781D_DATA_REG_OFFSET);
	if ((!(save & 0x80) && (val != 0xa3))
	 || ((save & 0x80) && (val != 0x5c))) {
		pr_debug("w83781d: Detection failed at step 5\n");
		goto release;
	}
	outb_p(W83781D_REG_I2C_ADDR, address + W83781D_ADDR_REG_OFFSET);
	val = inb_p(address + W83781D_DATA_REG_OFFSET);
	if (val < 0x03 || val > 0x77) {	/* Not a valid I2C address */
		pr_debug("w83781d: Detection failed at step 6\n");
		goto release;
	}

	/* The busy flag should be clear again */
	if (inb_p(address + W83781D_ADDR_REG_OFFSET) & 0x80) {
		pr_debug("w83781d: Detection failed at step 7\n");
		goto release;
	}

	/* Determine the chip type */
	outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
	save = inb_p(address + W83781D_DATA_REG_OFFSET);
	outb_p(save & 0xf8, address + W83781D_DATA_REG_OFFSET);
	outb_p(W83781D_REG_WCHIPID, address + W83781D_ADDR_REG_OFFSET);
	val = inb_p(address + W83781D_DATA_REG_OFFSET);
	if ((val & 0xfe) == 0x10	/* W83781D */
1848
	 || val == 0x30)		/* W83782D */
1849 1850 1851 1852 1853 1854 1855
		found = 1;

	if (found)
		pr_info("w83781d: Found a %s chip at %#x\n",
			val == 0x30 ? "W83782D" : "W83781D", (int)address);

 release:
1856 1857
	release_region(address + 4, 4);
	release_region(address, 4);
1858 1859 1860 1861 1862 1863 1864 1865
	return found;
}

static int __init
w83781d_isa_device_add(unsigned short address)
{
	struct resource res = {
		.start	= address,
1866
		.end	= address + W83781D_EXTENT - 1,
1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901
		.name	= "w83781d",
		.flags	= IORESOURCE_IO,
	};
	int err;

	pdev = platform_device_alloc("w83781d", address);
	if (!pdev) {
		err = -ENOMEM;
		printk(KERN_ERR "w83781d: Device allocation failed\n");
		goto exit;
	}

	err = platform_device_add_resources(pdev, &res, 1);
	if (err) {
		printk(KERN_ERR "w83781d: Device resource addition failed "
		       "(%d)\n", err);
		goto exit_device_put;
	}

	err = platform_device_add(pdev);
	if (err) {
		printk(KERN_ERR "w83781d: Device addition failed (%d)\n",
		       err);
		goto exit_device_put;
	}

	return 0;

 exit_device_put:
	platform_device_put(pdev);
 exit:
	pdev = NULL;
	return err;
}

L
Linus Torvalds 已提交
1902 1903 1904
static int __init
sensors_w83781d_init(void)
{
1905 1906 1907 1908
	int res;

	res = i2c_add_driver(&w83781d_driver);
	if (res)
1909 1910 1911 1912 1913 1914
		goto exit;

	if (w83781d_isa_found(isa_address)) {
		res = platform_driver_register(&w83781d_isa_driver);
		if (res)
			goto exit_unreg_i2c_driver;
1915

1916 1917 1918 1919 1920
		/* Sets global pdev as a side effect */
		res = w83781d_isa_device_add(isa_address);
		if (res)
			goto exit_unreg_isa_driver;
	}
1921 1922

	return 0;
1923 1924 1925 1926 1927 1928 1929

 exit_unreg_isa_driver:
	platform_driver_unregister(&w83781d_isa_driver);
 exit_unreg_i2c_driver:
	i2c_del_driver(&w83781d_driver);
 exit:
	return res;
L
Linus Torvalds 已提交
1930 1931 1932 1933 1934
}

static void __exit
sensors_w83781d_exit(void)
{
1935 1936 1937 1938
	if (pdev) {
		platform_device_unregister(pdev);
		platform_driver_unregister(&w83781d_isa_driver);
	}
L
Linus Torvalds 已提交
1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949
	i2c_del_driver(&w83781d_driver);
}

MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
	      "Philip Edelbrock <phil@netroedge.com>, "
	      "and Mark Studebaker <mdsxyz123@yahoo.com>");
MODULE_DESCRIPTION("W83781D driver");
MODULE_LICENSE("GPL");

module_init(sensors_w83781d_init);
module_exit(sensors_w83781d_exit);