1/*
   2 *  w83795.c - Linux kernel driver for hardware monitoring
   3 *  Copyright (C) 2008 Nuvoton Technology Corp.
   4 *                Wei Song
   5 *  Copyright (C) 2010 Jean Delvare <khali@linux-fr.org>
   6 *
   7 *  This program is free software; you can redistribute it and/or modify
   8 *  it under the terms of the GNU General Public License as published by
   9 *  the Free Software Foundation - version 2.
  10 *
  11 *  This program is distributed in the hope that it will be useful,
  12 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14 *  GNU General Public License for more details.
  15 *
  16 *  You should have received a copy of the GNU General Public License
  17 *  along with this program; if not, write to the Free Software
  18 *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  19 *  02110-1301 USA.
  20 *
  21 *  Supports following chips:
  22 *
  23 *  Chip       #vin   #fanin #pwm #temp #dts wchipid  vendid  i2c  ISA
  24 *  w83795g     21     14     8     6     8    0x79   0x5ca3  yes   no
  25 *  w83795adg   18     14     2     6     8    0x79   0x5ca3  yes   no
  26 */
  27
  28#include <linux/kernel.h>
  29#include <linux/module.h>
  30#include <linux/init.h>
  31#include <linux/slab.h>
  32#include <linux/i2c.h>
  33#include <linux/hwmon.h>
  34#include <linux/hwmon-sysfs.h>
  35#include <linux/err.h>
  36#include <linux/mutex.h>
  37#include <linux/delay.h>
 
  38
  39/* Addresses to scan */
  40static const unsigned short normal_i2c[] = {
  41	0x2c, 0x2d, 0x2e, 0x2f, I2C_CLIENT_END
  42};
  43
  44
  45static int reset;
  46module_param(reset, bool, 0);
  47MODULE_PARM_DESC(reset, "Set to 1 to reset chip, not recommended");
  48
  49
  50#define W83795_REG_BANKSEL		0x00
  51#define W83795_REG_VENDORID		0xfd
  52#define W83795_REG_CHIPID		0xfe
  53#define W83795_REG_DEVICEID		0xfb
  54#define W83795_REG_DEVICEID_A		0xff
  55
  56#define W83795_REG_I2C_ADDR		0xfc
  57#define W83795_REG_CONFIG		0x01
  58#define W83795_REG_CONFIG_CONFIG48	0x04
  59#define W83795_REG_CONFIG_START	0x01
  60
  61/* Multi-Function Pin Ctrl Registers */
  62#define W83795_REG_VOLT_CTRL1		0x02
  63#define W83795_REG_VOLT_CTRL2		0x03
  64#define W83795_REG_TEMP_CTRL1		0x04
  65#define W83795_REG_TEMP_CTRL2		0x05
  66#define W83795_REG_FANIN_CTRL1		0x06
  67#define W83795_REG_FANIN_CTRL2		0x07
  68#define W83795_REG_VMIGB_CTRL		0x08
  69
  70#define TEMP_READ			0
  71#define TEMP_CRIT			1
  72#define TEMP_CRIT_HYST			2
  73#define TEMP_WARN			3
  74#define TEMP_WARN_HYST			4
  75/* only crit and crit_hyst affect real-time alarm status
  76 * current crit crit_hyst warn warn_hyst */
 
 
  77static const u16 W83795_REG_TEMP[][5] = {
  78	{0x21, 0x96, 0x97, 0x98, 0x99},	/* TD1/TR1 */
  79	{0x22, 0x9a, 0x9b, 0x9c, 0x9d},	/* TD2/TR2 */
  80	{0x23, 0x9e, 0x9f, 0xa0, 0xa1},	/* TD3/TR3 */
  81	{0x24, 0xa2, 0xa3, 0xa4, 0xa5},	/* TD4/TR4 */
  82	{0x1f, 0xa6, 0xa7, 0xa8, 0xa9},	/* TR5 */
  83	{0x20, 0xaa, 0xab, 0xac, 0xad},	/* TR6 */
  84};
  85
  86#define IN_READ				0
  87#define IN_MAX				1
  88#define IN_LOW				2
  89static const u16 W83795_REG_IN[][3] = {
  90	/* Current, HL, LL */
  91	{0x10, 0x70, 0x71},	/* VSEN1 */
  92	{0x11, 0x72, 0x73},	/* VSEN2 */
  93	{0x12, 0x74, 0x75},	/* VSEN3 */
  94	{0x13, 0x76, 0x77},	/* VSEN4 */
  95	{0x14, 0x78, 0x79},	/* VSEN5 */
  96	{0x15, 0x7a, 0x7b},	/* VSEN6 */
  97	{0x16, 0x7c, 0x7d},	/* VSEN7 */
  98	{0x17, 0x7e, 0x7f},	/* VSEN8 */
  99	{0x18, 0x80, 0x81},	/* VSEN9 */
 100	{0x19, 0x82, 0x83},	/* VSEN10 */
 101	{0x1A, 0x84, 0x85},	/* VSEN11 */
 102	{0x1B, 0x86, 0x87},	/* VTT */
 103	{0x1C, 0x88, 0x89},	/* 3VDD */
 104	{0x1D, 0x8a, 0x8b},	/* 3VSB */
 105	{0x1E, 0x8c, 0x8d},	/* VBAT */
 106	{0x1F, 0xa6, 0xa7},	/* VSEN12 */
 107	{0x20, 0xaa, 0xab},	/* VSEN13 */
 108	{0x21, 0x96, 0x97},	/* VSEN14 */
 109	{0x22, 0x9a, 0x9b},	/* VSEN15 */
 110	{0x23, 0x9e, 0x9f},	/* VSEN16 */
 111	{0x24, 0xa2, 0xa3},	/* VSEN17 */
 112};
 113#define W83795_REG_VRLSB		0x3C
 114
 115static const u8 W83795_REG_IN_HL_LSB[] = {
 116	0x8e,	/* VSEN1-4 */
 117	0x90,	/* VSEN5-8 */
 118	0x92,	/* VSEN9-11 */
 119	0x94,	/* VTT, 3VDD, 3VSB, 3VBAT */
 120	0xa8,	/* VSEN12 */
 121	0xac,	/* VSEN13 */
 122	0x98,	/* VSEN14 */
 123	0x9c,	/* VSEN15 */
 124	0xa0,	/* VSEN16 */
 125	0xa4,	/* VSEN17 */
 126};
 127
 128#define IN_LSB_REG(index, type) \
 129	(((type) == 1) ? W83795_REG_IN_HL_LSB[(index)] \
 130	: (W83795_REG_IN_HL_LSB[(index)] + 1))
 131
 132#define IN_LSB_SHIFT			0
 133#define IN_LSB_IDX			1
 134static const u8 IN_LSB_SHIFT_IDX[][2] = {
 135	/* High/Low LSB shift, LSB No. */
 136	{0x00, 0x00},	/* VSEN1 */
 137	{0x02, 0x00},	/* VSEN2 */
 138	{0x04, 0x00},	/* VSEN3 */
 139	{0x06, 0x00},	/* VSEN4 */
 140	{0x00, 0x01},	/* VSEN5 */
 141	{0x02, 0x01},	/* VSEN6 */
 142	{0x04, 0x01},	/* VSEN7 */
 143	{0x06, 0x01},	/* VSEN8 */
 144	{0x00, 0x02},	/* VSEN9 */
 145	{0x02, 0x02},	/* VSEN10 */
 146	{0x04, 0x02},	/* VSEN11 */
 147	{0x00, 0x03},	/* VTT */
 148	{0x02, 0x03},	/* 3VDD */
 149	{0x04, 0x03},	/* 3VSB	*/
 150	{0x06, 0x03},	/* VBAT	*/
 151	{0x06, 0x04},	/* VSEN12 */
 152	{0x06, 0x05},	/* VSEN13 */
 153	{0x06, 0x06},	/* VSEN14 */
 154	{0x06, 0x07},	/* VSEN15 */
 155	{0x06, 0x08},	/* VSEN16 */
 156	{0x06, 0x09},	/* VSEN17 */
 157};
 158
 159
 160#define W83795_REG_FAN(index)		(0x2E + (index))
 161#define W83795_REG_FAN_MIN_HL(index)	(0xB6 + (index))
 162#define W83795_REG_FAN_MIN_LSB(index)	(0xC4 + (index) / 2)
 163#define W83795_REG_FAN_MIN_LSB_SHIFT(index) \
 164	(((index) & 1) ? 4 : 0)
 165
 166#define W83795_REG_VID_CTRL		0x6A
 167
 168#define W83795_REG_ALARM_CTRL		0x40
 169#define ALARM_CTRL_RTSACS		(1 << 7)
 170#define W83795_REG_ALARM(index)		(0x41 + (index))
 171#define W83795_REG_CLR_CHASSIS		0x4D
 172#define W83795_REG_BEEP(index)		(0x50 + (index))
 173
 174#define W83795_REG_OVT_CFG		0x58
 175#define OVT_CFG_SEL			(1 << 7)
 176
 177
 178#define W83795_REG_FCMS1		0x201
 179#define W83795_REG_FCMS2		0x208
 180#define W83795_REG_TFMR(index)		(0x202 + (index))
 181#define W83795_REG_FOMC			0x20F
 182
 183#define W83795_REG_TSS(index)		(0x209 + (index))
 184
 185#define TSS_MAP_RESERVED		0xff
 186static const u8 tss_map[4][6] = {
 187	{ 0,  1,  2,  3,  4,  5},
 188	{ 6,  7,  8,  9,  0,  1},
 189	{10, 11, 12, 13,  2,  3},
 190	{ 4,  5,  4,  5, TSS_MAP_RESERVED, TSS_MAP_RESERVED},
 191};
 192
 193#define PWM_OUTPUT			0
 194#define PWM_FREQ			1
 195#define PWM_START			2
 196#define PWM_NONSTOP			3
 197#define PWM_STOP_TIME			4
 198#define W83795_REG_PWM(index, nr)	(0x210 + (nr) * 8 + (index))
 199
 200#define W83795_REG_FTSH(index)		(0x240 + (index) * 2)
 201#define W83795_REG_FTSL(index)		(0x241 + (index) * 2)
 202#define W83795_REG_TFTS			0x250
 203
 204#define TEMP_PWM_TTTI			0
 205#define TEMP_PWM_CTFS			1
 206#define TEMP_PWM_HCT			2
 207#define TEMP_PWM_HOT			3
 208#define W83795_REG_TTTI(index)		(0x260 + (index))
 209#define W83795_REG_CTFS(index)		(0x268 + (index))
 210#define W83795_REG_HT(index)		(0x270 + (index))
 211
 212#define SF4_TEMP			0
 213#define SF4_PWM				1
 214#define W83795_REG_SF4_TEMP(temp_num, index) \
 215	(0x280 + 0x10 * (temp_num) + (index))
 216#define W83795_REG_SF4_PWM(temp_num, index) \
 217	(0x288 + 0x10 * (temp_num) + (index))
 218
 219#define W83795_REG_DTSC			0x301
 220#define W83795_REG_DTSE			0x302
 221#define W83795_REG_DTS(index)		(0x26 + (index))
 222#define W83795_REG_PECI_TBASE(index)	(0x320 + (index))
 223
 224#define DTS_CRIT			0
 225#define DTS_CRIT_HYST			1
 226#define DTS_WARN			2
 227#define DTS_WARN_HYST			3
 228#define W83795_REG_DTS_EXT(index)	(0xB2 + (index))
 229
 230#define SETUP_PWM_DEFAULT		0
 231#define SETUP_PWM_UPTIME		1
 232#define SETUP_PWM_DOWNTIME		2
 233#define W83795_REG_SETUP_PWM(index)    (0x20C + (index))
 234
 235static inline u16 in_from_reg(u8 index, u16 val)
 236{
 237	/* 3VDD, 3VSB and VBAT: 6 mV/bit; other inputs: 2 mV/bit */
 238	if (index >= 12 && index <= 14)
 239		return val * 6;
 240	else
 241		return val * 2;
 242}
 243
 244static inline u16 in_to_reg(u8 index, u16 val)
 245{
 246	if (index >= 12 && index <= 14)
 247		return val / 6;
 248	else
 249		return val / 2;
 250}
 251
 252static inline unsigned long fan_from_reg(u16 val)
 253{
 254	if ((val == 0xfff) || (val == 0))
 255		return 0;
 256	return 1350000UL / val;
 257}
 258
 259static inline u16 fan_to_reg(long rpm)
 260{
 261	if (rpm <= 0)
 262		return 0x0fff;
 263	return SENSORS_LIMIT((1350000 + (rpm >> 1)) / rpm, 1, 0xffe);
 264}
 265
 266static inline unsigned long time_from_reg(u8 reg)
 267{
 268	return reg * 100;
 269}
 270
 271static inline u8 time_to_reg(unsigned long val)
 272{
 273	return SENSORS_LIMIT((val + 50) / 100, 0, 0xff);
 274}
 275
 276static inline long temp_from_reg(s8 reg)
 277{
 278	return reg * 1000;
 279}
 280
 281static inline s8 temp_to_reg(long val, s8 min, s8 max)
 282{
 283	return SENSORS_LIMIT(val / 1000, min, max);
 284}
 285
 286static const u16 pwm_freq_cksel0[16] = {
 287	1024, 512, 341, 256, 205, 171, 146, 128,
 288	85, 64, 32, 16, 8, 4, 2, 1
 289};
 290
 291static unsigned int pwm_freq_from_reg(u8 reg, u16 clkin)
 292{
 293	unsigned long base_clock;
 294
 295	if (reg & 0x80) {
 296		base_clock = clkin * 1000 / ((clkin == 48000) ? 384 : 256);
 297		return base_clock / ((reg & 0x7f) + 1);
 298	} else
 299		return pwm_freq_cksel0[reg & 0x0f];
 300}
 301
 302static u8 pwm_freq_to_reg(unsigned long val, u16 clkin)
 303{
 304	unsigned long base_clock;
 305	u8 reg0, reg1;
 306	unsigned long best0, best1;
 307
 308	/* Best fit for cksel = 0 */
 309	for (reg0 = 0; reg0 < ARRAY_SIZE(pwm_freq_cksel0) - 1; reg0++) {
 310		if (val > (pwm_freq_cksel0[reg0] +
 311			   pwm_freq_cksel0[reg0 + 1]) / 2)
 312			break;
 313	}
 314	if (val < 375)	/* cksel = 1 can't beat this */
 315		return reg0;
 316	best0 = pwm_freq_cksel0[reg0];
 317
 318	/* Best fit for cksel = 1 */
 319	base_clock = clkin * 1000 / ((clkin == 48000) ? 384 : 256);
 320	reg1 = SENSORS_LIMIT(DIV_ROUND_CLOSEST(base_clock, val), 1, 128);
 321	best1 = base_clock / reg1;
 322	reg1 = 0x80 | (reg1 - 1);
 323
 324	/* Choose the closest one */
 325	if (abs(val - best0) > abs(val - best1))
 326		return reg1;
 327	else
 328		return reg0;
 329}
 330
 331enum chip_types {w83795g, w83795adg};
 332
 333struct w83795_data {
 334	struct device *hwmon_dev;
 335	struct mutex update_lock;
 336	unsigned long last_updated;	/* In jiffies */
 337	enum chip_types chip_type;
 338
 339	u8 bank;
 340
 341	u32 has_in;		/* Enable monitor VIN or not */
 342	u8 has_dyn_in;		/* Only in2-0 can have this */
 343	u16 in[21][3];		/* Register value, read/high/low */
 344	u8 in_lsb[10][3];	/* LSB Register value, high/low */
 345	u8 has_gain;		/* has gain: in17-20 * 8 */
 346
 347	u16 has_fan;		/* Enable fan14-1 or not */
 348	u16 fan[14];		/* Register value combine */
 349	u16 fan_min[14];	/* Register value combine */
 350
 351	u8 has_temp;		/* Enable monitor temp6-1 or not */
 352	s8 temp[6][5];		/* current, crit, crit_hyst, warn, warn_hyst */
 353	u8 temp_read_vrlsb[6];
 354	u8 temp_mode;		/* Bit vector, 0 = TR, 1 = TD */
 355	u8 temp_src[3];		/* Register value */
 356
 357	u8 enable_dts;		/* Enable PECI and SB-TSI,
 
 358				 * bit 0: =1 enable, =0 disable,
 359				 * bit 1: =1 AMD SB-TSI, =0 Intel PECI */
 
 360	u8 has_dts;		/* Enable monitor DTS temp */
 361	s8 dts[8];		/* Register value */
 362	u8 dts_read_vrlsb[8];	/* Register value */
 363	s8 dts_ext[4];		/* Register value */
 364
 365	u8 has_pwm;		/* 795g supports 8 pwm, 795adg only supports 2,
 
 366				 * no config register, only affected by chip
 367				 * type */
 368	u8 pwm[8][5];		/* Register value, output, freq, start,
 369				 *  non stop, stop time */
 
 
 
 370	u16 clkin;		/* CLKIN frequency in kHz */
 371	u8 pwm_fcms[2];		/* Register value */
 372	u8 pwm_tfmr[6];		/* Register value */
 373	u8 pwm_fomc;		/* Register value */
 374
 375	u16 target_speed[8];	/* Register value, target speed for speed
 376				 * cruise */
 
 
 377	u8 tol_speed;		/* tolerance of target speed */
 378	u8 pwm_temp[6][4];	/* TTTI, CTFS, HCT, HOT */
 379	u8 sf4_reg[6][2][7];	/* 6 temp, temp/dcpwm, 7 registers */
 380
 381	u8 setup_pwm[3];	/* Register value */
 382
 383	u8 alarms[6];		/* Register value */
 384	u8 enable_beep;
 385	u8 beeps[6];		/* Register value */
 386
 387	char valid;
 388	char valid_limits;
 389	char valid_pwm_config;
 390};
 391
 392/*
 393 * Hardware access
 394 * We assume that nobdody can change the bank outside the driver.
 395 */
 396
 397/* Must be called with data->update_lock held, except during initialization */
 398static int w83795_set_bank(struct i2c_client *client, u8 bank)
 399{
 400	struct w83795_data *data = i2c_get_clientdata(client);
 401	int err;
 402
 403	/* If the same bank is already set, nothing to do */
 404	if ((data->bank & 0x07) == bank)
 405		return 0;
 406
 407	/* Change to new bank, preserve all other bits */
 408	bank |= data->bank & ~0x07;
 409	err = i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL, bank);
 410	if (err < 0) {
 411		dev_err(&client->dev,
 412			"Failed to set bank to %d, err %d\n",
 413			(int)bank, err);
 414		return err;
 415	}
 416	data->bank = bank;
 417
 418	return 0;
 419}
 420
 421/* Must be called with data->update_lock held, except during initialization */
 422static u8 w83795_read(struct i2c_client *client, u16 reg)
 423{
 424	int err;
 425
 426	err = w83795_set_bank(client, reg >> 8);
 427	if (err < 0)
 428		return 0x00;	/* Arbitrary */
 429
 430	err = i2c_smbus_read_byte_data(client, reg & 0xff);
 431	if (err < 0) {
 432		dev_err(&client->dev,
 433			"Failed to read from register 0x%03x, err %d\n",
 434			(int)reg, err);
 435		return 0x00;	/* Arbitrary */
 436	}
 437	return err;
 438}
 439
 440/* Must be called with data->update_lock held, except during initialization */
 441static int w83795_write(struct i2c_client *client, u16 reg, u8 value)
 442{
 443	int err;
 444
 445	err = w83795_set_bank(client, reg >> 8);
 446	if (err < 0)
 447		return err;
 448
 449	err = i2c_smbus_write_byte_data(client, reg & 0xff, value);
 450	if (err < 0)
 451		dev_err(&client->dev,
 452			"Failed to write to register 0x%03x, err %d\n",
 453			(int)reg, err);
 454	return err;
 455}
 456
 457static void w83795_update_limits(struct i2c_client *client)
 458{
 459	struct w83795_data *data = i2c_get_clientdata(client);
 460	int i, limit;
 461	u8 lsb;
 462
 463	/* Read the voltage limits */
 464	for (i = 0; i < ARRAY_SIZE(data->in); i++) {
 465		if (!(data->has_in & (1 << i)))
 466			continue;
 467		data->in[i][IN_MAX] =
 468			w83795_read(client, W83795_REG_IN[i][IN_MAX]);
 469		data->in[i][IN_LOW] =
 470			w83795_read(client, W83795_REG_IN[i][IN_LOW]);
 471	}
 472	for (i = 0; i < ARRAY_SIZE(data->in_lsb); i++) {
 473		if ((i == 2 && data->chip_type == w83795adg) ||
 474		    (i >= 4 && !(data->has_in & (1 << (i + 11)))))
 475			continue;
 476		data->in_lsb[i][IN_MAX] =
 477			w83795_read(client, IN_LSB_REG(i, IN_MAX));
 478		data->in_lsb[i][IN_LOW] =
 479			w83795_read(client, IN_LSB_REG(i, IN_LOW));
 480	}
 481
 482	/* Read the fan limits */
 483	lsb = 0; /* Silent false gcc warning */
 484	for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
 485		/* Each register contains LSB for 2 fans, but we want to
 486		 * read it only once to save time */
 
 
 487		if ((i & 1) == 0 && (data->has_fan & (3 << i)))
 488			lsb = w83795_read(client, W83795_REG_FAN_MIN_LSB(i));
 489
 490		if (!(data->has_fan & (1 << i)))
 491			continue;
 492		data->fan_min[i] =
 493			w83795_read(client, W83795_REG_FAN_MIN_HL(i)) << 4;
 494		data->fan_min[i] |=
 495			(lsb >> W83795_REG_FAN_MIN_LSB_SHIFT(i)) & 0x0F;
 496	}
 497
 498	/* Read the temperature limits */
 499	for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
 500		if (!(data->has_temp & (1 << i)))
 501			continue;
 502		for (limit = TEMP_CRIT; limit <= TEMP_WARN_HYST; limit++)
 503			data->temp[i][limit] =
 504				w83795_read(client, W83795_REG_TEMP[i][limit]);
 505	}
 506
 507	/* Read the DTS limits */
 508	if (data->enable_dts) {
 509		for (limit = DTS_CRIT; limit <= DTS_WARN_HYST; limit++)
 510			data->dts_ext[limit] =
 511				w83795_read(client, W83795_REG_DTS_EXT(limit));
 512	}
 513
 514	/* Read beep settings */
 515	if (data->enable_beep) {
 516		for (i = 0; i < ARRAY_SIZE(data->beeps); i++)
 517			data->beeps[i] =
 518				w83795_read(client, W83795_REG_BEEP(i));
 519	}
 520
 521	data->valid_limits = 1;
 522}
 523
 524static struct w83795_data *w83795_update_pwm_config(struct device *dev)
 525{
 526	struct i2c_client *client = to_i2c_client(dev);
 527	struct w83795_data *data = i2c_get_clientdata(client);
 528	int i, tmp;
 529
 530	mutex_lock(&data->update_lock);
 531
 532	if (data->valid_pwm_config)
 533		goto END;
 534
 535	/* Read temperature source selection */
 536	for (i = 0; i < ARRAY_SIZE(data->temp_src); i++)
 537		data->temp_src[i] = w83795_read(client, W83795_REG_TSS(i));
 538
 539	/* Read automatic fan speed control settings */
 540	data->pwm_fcms[0] = w83795_read(client, W83795_REG_FCMS1);
 541	data->pwm_fcms[1] = w83795_read(client, W83795_REG_FCMS2);
 542	for (i = 0; i < ARRAY_SIZE(data->pwm_tfmr); i++)
 543		data->pwm_tfmr[i] = w83795_read(client, W83795_REG_TFMR(i));
 544	data->pwm_fomc = w83795_read(client, W83795_REG_FOMC);
 545	for (i = 0; i < data->has_pwm; i++) {
 546		for (tmp = PWM_FREQ; tmp <= PWM_STOP_TIME; tmp++)
 547			data->pwm[i][tmp] =
 548				w83795_read(client, W83795_REG_PWM(i, tmp));
 549	}
 550	for (i = 0; i < ARRAY_SIZE(data->target_speed); i++) {
 551		data->target_speed[i] =
 552			w83795_read(client, W83795_REG_FTSH(i)) << 4;
 553		data->target_speed[i] |=
 554			w83795_read(client, W83795_REG_FTSL(i)) >> 4;
 555	}
 556	data->tol_speed = w83795_read(client, W83795_REG_TFTS) & 0x3f;
 557
 558	for (i = 0; i < ARRAY_SIZE(data->pwm_temp); i++) {
 559		data->pwm_temp[i][TEMP_PWM_TTTI] =
 560			w83795_read(client, W83795_REG_TTTI(i)) & 0x7f;
 561		data->pwm_temp[i][TEMP_PWM_CTFS] =
 562			w83795_read(client, W83795_REG_CTFS(i));
 563		tmp = w83795_read(client, W83795_REG_HT(i));
 564		data->pwm_temp[i][TEMP_PWM_HCT] = tmp >> 4;
 565		data->pwm_temp[i][TEMP_PWM_HOT] = tmp & 0x0f;
 566	}
 567
 568	/* Read SmartFanIV trip points */
 569	for (i = 0; i < ARRAY_SIZE(data->sf4_reg); i++) {
 570		for (tmp = 0; tmp < 7; tmp++) {
 571			data->sf4_reg[i][SF4_TEMP][tmp] =
 572				w83795_read(client,
 573					    W83795_REG_SF4_TEMP(i, tmp));
 574			data->sf4_reg[i][SF4_PWM][tmp] =
 575				w83795_read(client, W83795_REG_SF4_PWM(i, tmp));
 576		}
 577	}
 578
 579	/* Read setup PWM */
 580	for (i = 0; i < ARRAY_SIZE(data->setup_pwm); i++)
 581		data->setup_pwm[i] =
 582			w83795_read(client, W83795_REG_SETUP_PWM(i));
 583
 584	data->valid_pwm_config = 1;
 585
 586END:
 587	mutex_unlock(&data->update_lock);
 588	return data;
 589}
 590
 591static struct w83795_data *w83795_update_device(struct device *dev)
 592{
 593	struct i2c_client *client = to_i2c_client(dev);
 594	struct w83795_data *data = i2c_get_clientdata(client);
 595	u16 tmp;
 596	u8 intrusion;
 597	int i;
 598
 599	mutex_lock(&data->update_lock);
 600
 601	if (!data->valid_limits)
 602		w83795_update_limits(client);
 603
 604	if (!(time_after(jiffies, data->last_updated + HZ * 2)
 605	      || !data->valid))
 606		goto END;
 607
 608	/* Update the voltages value */
 609	for (i = 0; i < ARRAY_SIZE(data->in); i++) {
 610		if (!(data->has_in & (1 << i)))
 611			continue;
 612		tmp = w83795_read(client, W83795_REG_IN[i][IN_READ]) << 2;
 613		tmp |= w83795_read(client, W83795_REG_VRLSB) >> 6;
 614		data->in[i][IN_READ] = tmp;
 615	}
 616
 617	/* in0-2 can have dynamic limits (W83795G only) */
 618	if (data->has_dyn_in) {
 619		u8 lsb_max = w83795_read(client, IN_LSB_REG(0, IN_MAX));
 620		u8 lsb_low = w83795_read(client, IN_LSB_REG(0, IN_LOW));
 621
 622		for (i = 0; i < 3; i++) {
 623			if (!(data->has_dyn_in & (1 << i)))
 624				continue;
 625			data->in[i][IN_MAX] =
 626				w83795_read(client, W83795_REG_IN[i][IN_MAX]);
 627			data->in[i][IN_LOW] =
 628				w83795_read(client, W83795_REG_IN[i][IN_LOW]);
 629			data->in_lsb[i][IN_MAX] = (lsb_max >> (2 * i)) & 0x03;
 630			data->in_lsb[i][IN_LOW] = (lsb_low >> (2 * i)) & 0x03;
 631		}
 632	}
 633
 634	/* Update fan */
 635	for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
 636		if (!(data->has_fan & (1 << i)))
 637			continue;
 638		data->fan[i] = w83795_read(client, W83795_REG_FAN(i)) << 4;
 639		data->fan[i] |= w83795_read(client, W83795_REG_VRLSB) >> 4;
 640	}
 641
 642	/* Update temperature */
 643	for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
 644		data->temp[i][TEMP_READ] =
 645			w83795_read(client, W83795_REG_TEMP[i][TEMP_READ]);
 646		data->temp_read_vrlsb[i] =
 647			w83795_read(client, W83795_REG_VRLSB);
 648	}
 649
 650	/* Update dts temperature */
 651	if (data->enable_dts) {
 652		for (i = 0; i < ARRAY_SIZE(data->dts); i++) {
 653			if (!(data->has_dts & (1 << i)))
 654				continue;
 655			data->dts[i] =
 656				w83795_read(client, W83795_REG_DTS(i));
 657			data->dts_read_vrlsb[i] =
 658				w83795_read(client, W83795_REG_VRLSB);
 659		}
 660	}
 661
 662	/* Update pwm output */
 663	for (i = 0; i < data->has_pwm; i++) {
 664		data->pwm[i][PWM_OUTPUT] =
 665		    w83795_read(client, W83795_REG_PWM(i, PWM_OUTPUT));
 666	}
 667
 668	/* Update intrusion and alarms
 
 669	 * It is important to read intrusion first, because reading from
 670	 * register SMI STS6 clears the interrupt status temporarily. */
 
 671	tmp = w83795_read(client, W83795_REG_ALARM_CTRL);
 672	/* Switch to interrupt status for intrusion if needed */
 673	if (tmp & ALARM_CTRL_RTSACS)
 674		w83795_write(client, W83795_REG_ALARM_CTRL,
 675			     tmp & ~ALARM_CTRL_RTSACS);
 676	intrusion = w83795_read(client, W83795_REG_ALARM(5)) & (1 << 6);
 677	/* Switch to real-time alarms */
 678	w83795_write(client, W83795_REG_ALARM_CTRL, tmp | ALARM_CTRL_RTSACS);
 679	for (i = 0; i < ARRAY_SIZE(data->alarms); i++)
 680		data->alarms[i] = w83795_read(client, W83795_REG_ALARM(i));
 681	data->alarms[5] |= intrusion;
 682	/* Restore original configuration if needed */
 683	if (!(tmp & ALARM_CTRL_RTSACS))
 684		w83795_write(client, W83795_REG_ALARM_CTRL,
 685			     tmp & ~ALARM_CTRL_RTSACS);
 686
 687	data->last_updated = jiffies;
 688	data->valid = 1;
 689
 690END:
 691	mutex_unlock(&data->update_lock);
 692	return data;
 693}
 694
 695/*
 696 * Sysfs attributes
 697 */
 698
 699#define ALARM_STATUS      0
 700#define BEEP_ENABLE       1
 701static ssize_t
 702show_alarm_beep(struct device *dev, struct device_attribute *attr, char *buf)
 703{
 704	struct w83795_data *data = w83795_update_device(dev);
 705	struct sensor_device_attribute_2 *sensor_attr =
 706	    to_sensor_dev_attr_2(attr);
 707	int nr = sensor_attr->nr;
 708	int index = sensor_attr->index >> 3;
 709	int bit = sensor_attr->index & 0x07;
 710	u8 val;
 711
 712	if (nr == ALARM_STATUS)
 713		val = (data->alarms[index] >> bit) & 1;
 714	else		/* BEEP_ENABLE */
 715		val = (data->beeps[index] >> bit) & 1;
 716
 717	return sprintf(buf, "%u\n", val);
 718}
 719
 720static ssize_t
 721store_beep(struct device *dev, struct device_attribute *attr,
 722	   const char *buf, size_t count)
 723{
 724	struct i2c_client *client = to_i2c_client(dev);
 725	struct w83795_data *data = i2c_get_clientdata(client);
 726	struct sensor_device_attribute_2 *sensor_attr =
 727	    to_sensor_dev_attr_2(attr);
 728	int index = sensor_attr->index >> 3;
 729	int shift = sensor_attr->index & 0x07;
 730	u8 beep_bit = 1 << shift;
 731	unsigned long val;
 732
 733	if (strict_strtoul(buf, 10, &val) < 0)
 734		return -EINVAL;
 735	if (val != 0 && val != 1)
 736		return -EINVAL;
 737
 738	mutex_lock(&data->update_lock);
 739	data->beeps[index] = w83795_read(client, W83795_REG_BEEP(index));
 740	data->beeps[index] &= ~beep_bit;
 741	data->beeps[index] |= val << shift;
 742	w83795_write(client, W83795_REG_BEEP(index), data->beeps[index]);
 743	mutex_unlock(&data->update_lock);
 744
 745	return count;
 746}
 747
 748/* Write 0 to clear chassis alarm */
 749static ssize_t
 750store_chassis_clear(struct device *dev,
 751		    struct device_attribute *attr, const char *buf,
 752		    size_t count)
 753{
 754	struct i2c_client *client = to_i2c_client(dev);
 755	struct w83795_data *data = i2c_get_clientdata(client);
 756	unsigned long val;
 757
 758	if (strict_strtoul(buf, 10, &val) < 0 || val != 0)
 759		return -EINVAL;
 760
 761	mutex_lock(&data->update_lock);
 762	val = w83795_read(client, W83795_REG_CLR_CHASSIS);
 763	val |= 0x80;
 764	w83795_write(client, W83795_REG_CLR_CHASSIS, val);
 765
 766	/* Clear status and force cache refresh */
 767	w83795_read(client, W83795_REG_ALARM(5));
 768	data->valid = 0;
 769	mutex_unlock(&data->update_lock);
 770	return count;
 771}
 772
 773#define FAN_INPUT     0
 774#define FAN_MIN       1
 775static ssize_t
 776show_fan(struct device *dev, struct device_attribute *attr, char *buf)
 777{
 778	struct sensor_device_attribute_2 *sensor_attr =
 779	    to_sensor_dev_attr_2(attr);
 780	int nr = sensor_attr->nr;
 781	int index = sensor_attr->index;
 782	struct w83795_data *data = w83795_update_device(dev);
 783	u16 val;
 784
 785	if (nr == FAN_INPUT)
 786		val = data->fan[index] & 0x0fff;
 787	else
 788		val = data->fan_min[index] & 0x0fff;
 789
 790	return sprintf(buf, "%lu\n", fan_from_reg(val));
 791}
 792
 793static ssize_t
 794store_fan_min(struct device *dev, struct device_attribute *attr,
 795	      const char *buf, size_t count)
 796{
 797	struct sensor_device_attribute_2 *sensor_attr =
 798	    to_sensor_dev_attr_2(attr);
 799	int index = sensor_attr->index;
 800	struct i2c_client *client = to_i2c_client(dev);
 801	struct w83795_data *data = i2c_get_clientdata(client);
 802	unsigned long val;
 803
 804	if (strict_strtoul(buf, 10, &val))
 805		return -EINVAL;
 806	val = fan_to_reg(val);
 807
 808	mutex_lock(&data->update_lock);
 809	data->fan_min[index] = val;
 810	w83795_write(client, W83795_REG_FAN_MIN_HL(index), (val >> 4) & 0xff);
 811	val &= 0x0f;
 812	if (index & 1) {
 813		val <<= 4;
 814		val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
 815		       & 0x0f;
 816	} else {
 817		val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
 818		       & 0xf0;
 819	}
 820	w83795_write(client, W83795_REG_FAN_MIN_LSB(index), val & 0xff);
 821	mutex_unlock(&data->update_lock);
 822
 823	return count;
 824}
 825
 826static ssize_t
 827show_pwm(struct device *dev, struct device_attribute *attr, char *buf)
 828{
 829	struct w83795_data *data;
 830	struct sensor_device_attribute_2 *sensor_attr =
 831	    to_sensor_dev_attr_2(attr);
 832	int nr = sensor_attr->nr;
 833	int index = sensor_attr->index;
 834	unsigned int val;
 835
 836	data = nr == PWM_OUTPUT ? w83795_update_device(dev)
 837				: w83795_update_pwm_config(dev);
 838
 839	switch (nr) {
 840	case PWM_STOP_TIME:
 841		val = time_from_reg(data->pwm[index][nr]);
 842		break;
 843	case PWM_FREQ:
 844		val = pwm_freq_from_reg(data->pwm[index][nr], data->clkin);
 845		break;
 846	default:
 847		val = data->pwm[index][nr];
 848		break;
 849	}
 850
 851	return sprintf(buf, "%u\n", val);
 852}
 853
 854static ssize_t
 855store_pwm(struct device *dev, struct device_attribute *attr,
 856	  const char *buf, size_t count)
 857{
 858	struct i2c_client *client = to_i2c_client(dev);
 859	struct w83795_data *data = i2c_get_clientdata(client);
 860	struct sensor_device_attribute_2 *sensor_attr =
 861	    to_sensor_dev_attr_2(attr);
 862	int nr = sensor_attr->nr;
 863	int index = sensor_attr->index;
 864	unsigned long val;
 865
 866	if (strict_strtoul(buf, 10, &val) < 0)
 867		return -EINVAL;
 868
 869	mutex_lock(&data->update_lock);
 870	switch (nr) {
 871	case PWM_STOP_TIME:
 872		val = time_to_reg(val);
 873		break;
 874	case PWM_FREQ:
 875		val = pwm_freq_to_reg(val, data->clkin);
 876		break;
 877	default:
 878		val = SENSORS_LIMIT(val, 0, 0xff);
 879		break;
 880	}
 881	w83795_write(client, W83795_REG_PWM(index, nr), val);
 882	data->pwm[index][nr] = val;
 883	mutex_unlock(&data->update_lock);
 884	return count;
 885}
 886
 887static ssize_t
 888show_pwm_enable(struct device *dev, struct device_attribute *attr, char *buf)
 889{
 890	struct sensor_device_attribute_2 *sensor_attr =
 891	    to_sensor_dev_attr_2(attr);
 892	struct w83795_data *data = w83795_update_pwm_config(dev);
 893	int index = sensor_attr->index;
 894	u8 tmp;
 895
 896	/* Speed cruise mode */
 897	if (data->pwm_fcms[0] & (1 << index)) {
 898		tmp = 2;
 899		goto out;
 900	}
 901	/* Thermal cruise or SmartFan IV mode */
 902	for (tmp = 0; tmp < 6; tmp++) {
 903		if (data->pwm_tfmr[tmp] & (1 << index)) {
 904			tmp = 3;
 905			goto out;
 906		}
 907	}
 908	/* Manual mode */
 909	tmp = 1;
 910
 911out:
 912	return sprintf(buf, "%u\n", tmp);
 913}
 914
 915static ssize_t
 916store_pwm_enable(struct device *dev, struct device_attribute *attr,
 917	  const char *buf, size_t count)
 918{
 919	struct i2c_client *client = to_i2c_client(dev);
 920	struct w83795_data *data = w83795_update_pwm_config(dev);
 921	struct sensor_device_attribute_2 *sensor_attr =
 922	    to_sensor_dev_attr_2(attr);
 923	int index = sensor_attr->index;
 924	unsigned long val;
 925	int i;
 926
 927	if (strict_strtoul(buf, 10, &val) < 0)
 928		return -EINVAL;
 929	if (val < 1 || val > 2)
 930		return -EINVAL;
 931
 
 
 
 
 
 
 
 
 932	mutex_lock(&data->update_lock);
 933	switch (val) {
 934	case 1:
 935		/* Clear speed cruise mode bits */
 936		data->pwm_fcms[0] &= ~(1 << index);
 937		w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
 938		/* Clear thermal cruise mode bits */
 939		for (i = 0; i < 6; i++) {
 940			data->pwm_tfmr[i] &= ~(1 << index);
 941			w83795_write(client, W83795_REG_TFMR(i),
 942				data->pwm_tfmr[i]);
 943		}
 944		break;
 945	case 2:
 946		data->pwm_fcms[0] |= (1 << index);
 947		w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
 948		break;
 949	}
 950	mutex_unlock(&data->update_lock);
 951	return count;
 952}
 953
 954static ssize_t
 955show_pwm_mode(struct device *dev, struct device_attribute *attr, char *buf)
 956{
 957	struct w83795_data *data = w83795_update_pwm_config(dev);
 958	int index = to_sensor_dev_attr_2(attr)->index;
 959	unsigned int mode;
 960
 961	if (data->pwm_fomc & (1 << index))
 962		mode = 0;	/* DC */
 963	else
 964		mode = 1;	/* PWM */
 965
 966	return sprintf(buf, "%u\n", mode);
 967}
 968
 969/*
 970 * Check whether a given temperature source can ever be useful.
 971 * Returns the number of selectable temperature channels which are
 972 * enabled.
 973 */
 974static int w83795_tss_useful(const struct w83795_data *data, int tsrc)
 975{
 976	int useful = 0, i;
 977
 978	for (i = 0; i < 4; i++) {
 979		if (tss_map[i][tsrc] == TSS_MAP_RESERVED)
 980			continue;
 981		if (tss_map[i][tsrc] < 6)	/* Analog */
 982			useful += (data->has_temp >> tss_map[i][tsrc]) & 1;
 983		else				/* Digital */
 984			useful += (data->has_dts >> (tss_map[i][tsrc] - 6)) & 1;
 985	}
 986
 987	return useful;
 988}
 989
 990static ssize_t
 991show_temp_src(struct device *dev, struct device_attribute *attr, char *buf)
 992{
 993	struct sensor_device_attribute_2 *sensor_attr =
 994	    to_sensor_dev_attr_2(attr);
 995	struct w83795_data *data = w83795_update_pwm_config(dev);
 996	int index = sensor_attr->index;
 997	u8 tmp = data->temp_src[index / 2];
 998
 999	if (index & 1)
1000		tmp >>= 4;	/* Pick high nibble */
1001	else
1002		tmp &= 0x0f;	/* Pick low nibble */
1003
1004	/* Look-up the actual temperature channel number */
1005	if (tmp >= 4 || tss_map[tmp][index] == TSS_MAP_RESERVED)
1006		return -EINVAL;		/* Shouldn't happen */
1007
1008	return sprintf(buf, "%u\n", (unsigned int)tss_map[tmp][index] + 1);
1009}
1010
1011static ssize_t
1012store_temp_src(struct device *dev, struct device_attribute *attr,
1013	  const char *buf, size_t count)
1014{
1015	struct i2c_client *client = to_i2c_client(dev);
1016	struct w83795_data *data = w83795_update_pwm_config(dev);
1017	struct sensor_device_attribute_2 *sensor_attr =
1018	    to_sensor_dev_attr_2(attr);
1019	int index = sensor_attr->index;
1020	int tmp;
1021	unsigned long channel;
1022	u8 val = index / 2;
1023
1024	if (strict_strtoul(buf, 10, &channel) < 0 ||
1025	    channel < 1 || channel > 14)
1026		return -EINVAL;
1027
1028	/* Check if request can be fulfilled */
1029	for (tmp = 0; tmp < 4; tmp++) {
1030		if (tss_map[tmp][index] == channel - 1)
1031			break;
1032	}
1033	if (tmp == 4)	/* No match */
1034		return -EINVAL;
1035
1036	mutex_lock(&data->update_lock);
1037	if (index & 1) {
1038		tmp <<= 4;
1039		data->temp_src[val] &= 0x0f;
1040	} else {
1041		data->temp_src[val] &= 0xf0;
1042	}
1043	data->temp_src[val] |= tmp;
1044	w83795_write(client, W83795_REG_TSS(val), data->temp_src[val]);
1045	mutex_unlock(&data->update_lock);
1046
1047	return count;
1048}
1049
1050#define TEMP_PWM_ENABLE   0
1051#define TEMP_PWM_FAN_MAP  1
1052static ssize_t
1053show_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
1054		     char *buf)
1055{
1056	struct w83795_data *data = w83795_update_pwm_config(dev);
1057	struct sensor_device_attribute_2 *sensor_attr =
1058	    to_sensor_dev_attr_2(attr);
1059	int nr = sensor_attr->nr;
1060	int index = sensor_attr->index;
1061	u8 tmp = 0xff;
1062
1063	switch (nr) {
1064	case TEMP_PWM_ENABLE:
1065		tmp = (data->pwm_fcms[1] >> index) & 1;
1066		if (tmp)
1067			tmp = 4;
1068		else
1069			tmp = 3;
1070		break;
1071	case TEMP_PWM_FAN_MAP:
1072		tmp = data->pwm_tfmr[index];
1073		break;
1074	}
1075
1076	return sprintf(buf, "%u\n", tmp);
1077}
1078
1079static ssize_t
1080store_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
1081	  const char *buf, size_t count)
1082{
1083	struct i2c_client *client = to_i2c_client(dev);
1084	struct w83795_data *data = w83795_update_pwm_config(dev);
1085	struct sensor_device_attribute_2 *sensor_attr =
1086	    to_sensor_dev_attr_2(attr);
1087	int nr = sensor_attr->nr;
1088	int index = sensor_attr->index;
1089	unsigned long tmp;
1090
1091	if (strict_strtoul(buf, 10, &tmp) < 0)
1092		return -EINVAL;
1093
1094	switch (nr) {
1095	case TEMP_PWM_ENABLE:
1096		if (tmp != 3 && tmp != 4)
1097			return -EINVAL;
1098		tmp -= 3;
1099		mutex_lock(&data->update_lock);
1100		data->pwm_fcms[1] &= ~(1 << index);
1101		data->pwm_fcms[1] |= tmp << index;
1102		w83795_write(client, W83795_REG_FCMS2, data->pwm_fcms[1]);
1103		mutex_unlock(&data->update_lock);
1104		break;
1105	case TEMP_PWM_FAN_MAP:
1106		mutex_lock(&data->update_lock);
1107		tmp = SENSORS_LIMIT(tmp, 0, 0xff);
1108		w83795_write(client, W83795_REG_TFMR(index), tmp);
1109		data->pwm_tfmr[index] = tmp;
1110		mutex_unlock(&data->update_lock);
1111		break;
1112	}
1113	return count;
1114}
1115
1116#define FANIN_TARGET   0
1117#define FANIN_TOL      1
1118static ssize_t
1119show_fanin(struct device *dev, struct device_attribute *attr, char *buf)
1120{
1121	struct w83795_data *data = w83795_update_pwm_config(dev);
1122	struct sensor_device_attribute_2 *sensor_attr =
1123	    to_sensor_dev_attr_2(attr);
1124	int nr = sensor_attr->nr;
1125	int index = sensor_attr->index;
1126	u16 tmp = 0;
1127
1128	switch (nr) {
1129	case FANIN_TARGET:
1130		tmp = fan_from_reg(data->target_speed[index]);
1131		break;
1132	case FANIN_TOL:
1133		tmp = data->tol_speed;
1134		break;
1135	}
1136
1137	return sprintf(buf, "%u\n", tmp);
1138}
1139
1140static ssize_t
1141store_fanin(struct device *dev, struct device_attribute *attr,
1142	  const char *buf, size_t count)
1143{
1144	struct i2c_client *client = to_i2c_client(dev);
1145	struct w83795_data *data = i2c_get_clientdata(client);
1146	struct sensor_device_attribute_2 *sensor_attr =
1147	    to_sensor_dev_attr_2(attr);
1148	int nr = sensor_attr->nr;
1149	int index = sensor_attr->index;
1150	unsigned long val;
1151
1152	if (strict_strtoul(buf, 10, &val) < 0)
1153		return -EINVAL;
1154
1155	mutex_lock(&data->update_lock);
1156	switch (nr) {
1157	case FANIN_TARGET:
1158		val = fan_to_reg(SENSORS_LIMIT(val, 0, 0xfff));
1159		w83795_write(client, W83795_REG_FTSH(index), val >> 4);
1160		w83795_write(client, W83795_REG_FTSL(index), (val << 4) & 0xf0);
1161		data->target_speed[index] = val;
1162		break;
1163	case FANIN_TOL:
1164		val = SENSORS_LIMIT(val, 0, 0x3f);
1165		w83795_write(client, W83795_REG_TFTS, val);
1166		data->tol_speed = val;
1167		break;
1168	}
1169	mutex_unlock(&data->update_lock);
1170
1171	return count;
1172}
1173
1174
1175static ssize_t
1176show_temp_pwm(struct device *dev, struct device_attribute *attr, char *buf)
1177{
1178	struct w83795_data *data = w83795_update_pwm_config(dev);
1179	struct sensor_device_attribute_2 *sensor_attr =
1180	    to_sensor_dev_attr_2(attr);
1181	int nr = sensor_attr->nr;
1182	int index = sensor_attr->index;
1183	long tmp = temp_from_reg(data->pwm_temp[index][nr]);
1184
1185	return sprintf(buf, "%ld\n", tmp);
1186}
1187
1188static ssize_t
1189store_temp_pwm(struct device *dev, struct device_attribute *attr,
1190	  const char *buf, size_t count)
1191{
1192	struct i2c_client *client = to_i2c_client(dev);
1193	struct w83795_data *data = i2c_get_clientdata(client);
1194	struct sensor_device_attribute_2 *sensor_attr =
1195	    to_sensor_dev_attr_2(attr);
1196	int nr = sensor_attr->nr;
1197	int index = sensor_attr->index;
1198	unsigned long val;
1199	u8 tmp;
1200
1201	if (strict_strtoul(buf, 10, &val) < 0)
1202		return -EINVAL;
1203	val /= 1000;
1204
1205	mutex_lock(&data->update_lock);
1206	switch (nr) {
1207	case TEMP_PWM_TTTI:
1208		val = SENSORS_LIMIT(val, 0, 0x7f);
1209		w83795_write(client, W83795_REG_TTTI(index), val);
1210		break;
1211	case TEMP_PWM_CTFS:
1212		val = SENSORS_LIMIT(val, 0, 0x7f);
1213		w83795_write(client, W83795_REG_CTFS(index), val);
1214		break;
1215	case TEMP_PWM_HCT:
1216		val = SENSORS_LIMIT(val, 0, 0x0f);
1217		tmp = w83795_read(client, W83795_REG_HT(index));
1218		tmp &= 0x0f;
1219		tmp |= (val << 4) & 0xf0;
1220		w83795_write(client, W83795_REG_HT(index), tmp);
1221		break;
1222	case TEMP_PWM_HOT:
1223		val = SENSORS_LIMIT(val, 0, 0x0f);
1224		tmp = w83795_read(client, W83795_REG_HT(index));
1225		tmp &= 0xf0;
1226		tmp |= val & 0x0f;
1227		w83795_write(client, W83795_REG_HT(index), tmp);
1228		break;
1229	}
1230	data->pwm_temp[index][nr] = val;
1231	mutex_unlock(&data->update_lock);
1232
1233	return count;
1234}
1235
1236static ssize_t
1237show_sf4_pwm(struct device *dev, struct device_attribute *attr, char *buf)
1238{
1239	struct w83795_data *data = w83795_update_pwm_config(dev);
1240	struct sensor_device_attribute_2 *sensor_attr =
1241	    to_sensor_dev_attr_2(attr);
1242	int nr = sensor_attr->nr;
1243	int index = sensor_attr->index;
1244
1245	return sprintf(buf, "%u\n", data->sf4_reg[index][SF4_PWM][nr]);
1246}
1247
1248static ssize_t
1249store_sf4_pwm(struct device *dev, struct device_attribute *attr,
1250	  const char *buf, size_t count)
1251{
1252	struct i2c_client *client = to_i2c_client(dev);
1253	struct w83795_data *data = i2c_get_clientdata(client);
1254	struct sensor_device_attribute_2 *sensor_attr =
1255	    to_sensor_dev_attr_2(attr);
1256	int nr = sensor_attr->nr;
1257	int index = sensor_attr->index;
1258	unsigned long val;
1259
1260	if (strict_strtoul(buf, 10, &val) < 0)
1261		return -EINVAL;
1262
1263	mutex_lock(&data->update_lock);
1264	w83795_write(client, W83795_REG_SF4_PWM(index, nr), val);
1265	data->sf4_reg[index][SF4_PWM][nr] = val;
1266	mutex_unlock(&data->update_lock);
1267
1268	return count;
1269}
1270
1271static ssize_t
1272show_sf4_temp(struct device *dev, struct device_attribute *attr, char *buf)
1273{
1274	struct w83795_data *data = w83795_update_pwm_config(dev);
1275	struct sensor_device_attribute_2 *sensor_attr =
1276	    to_sensor_dev_attr_2(attr);
1277	int nr = sensor_attr->nr;
1278	int index = sensor_attr->index;
1279
1280	return sprintf(buf, "%u\n",
1281		(data->sf4_reg[index][SF4_TEMP][nr]) * 1000);
1282}
1283
1284static ssize_t
1285store_sf4_temp(struct device *dev, struct device_attribute *attr,
1286	  const char *buf, size_t count)
1287{
1288	struct i2c_client *client = to_i2c_client(dev);
1289	struct w83795_data *data = i2c_get_clientdata(client);
1290	struct sensor_device_attribute_2 *sensor_attr =
1291	    to_sensor_dev_attr_2(attr);
1292	int nr = sensor_attr->nr;
1293	int index = sensor_attr->index;
1294	unsigned long val;
1295
1296	if (strict_strtoul(buf, 10, &val) < 0)
1297		return -EINVAL;
1298	val /= 1000;
1299
1300	mutex_lock(&data->update_lock);
1301	w83795_write(client, W83795_REG_SF4_TEMP(index, nr), val);
1302	data->sf4_reg[index][SF4_TEMP][nr] = val;
1303	mutex_unlock(&data->update_lock);
1304
1305	return count;
1306}
1307
1308
1309static ssize_t
1310show_temp(struct device *dev, struct device_attribute *attr, char *buf)
1311{
1312	struct sensor_device_attribute_2 *sensor_attr =
1313	    to_sensor_dev_attr_2(attr);
1314	int nr = sensor_attr->nr;
1315	int index = sensor_attr->index;
1316	struct w83795_data *data = w83795_update_device(dev);
1317	long temp = temp_from_reg(data->temp[index][nr]);
1318
1319	if (nr == TEMP_READ)
1320		temp += (data->temp_read_vrlsb[index] >> 6) * 250;
1321	return sprintf(buf, "%ld\n", temp);
1322}
1323
1324static ssize_t
1325store_temp(struct device *dev, struct device_attribute *attr,
1326	   const char *buf, size_t count)
1327{
1328	struct sensor_device_attribute_2 *sensor_attr =
1329	    to_sensor_dev_attr_2(attr);
1330	int nr = sensor_attr->nr;
1331	int index = sensor_attr->index;
1332	struct i2c_client *client = to_i2c_client(dev);
1333	struct w83795_data *data = i2c_get_clientdata(client);
1334	long tmp;
1335
1336	if (strict_strtol(buf, 10, &tmp) < 0)
1337		return -EINVAL;
1338
1339	mutex_lock(&data->update_lock);
1340	data->temp[index][nr] = temp_to_reg(tmp, -128, 127);
1341	w83795_write(client, W83795_REG_TEMP[index][nr], data->temp[index][nr]);
1342	mutex_unlock(&data->update_lock);
1343	return count;
1344}
1345
1346
1347static ssize_t
1348show_dts_mode(struct device *dev, struct device_attribute *attr, char *buf)
1349{
1350	struct w83795_data *data = dev_get_drvdata(dev);
1351	int tmp;
1352
1353	if (data->enable_dts & 2)
1354		tmp = 5;
1355	else
1356		tmp = 6;
1357
1358	return sprintf(buf, "%d\n", tmp);
1359}
1360
1361static ssize_t
1362show_dts(struct device *dev, struct device_attribute *attr, char *buf)
1363{
1364	struct sensor_device_attribute_2 *sensor_attr =
1365	    to_sensor_dev_attr_2(attr);
1366	int index = sensor_attr->index;
1367	struct w83795_data *data = w83795_update_device(dev);
1368	long temp = temp_from_reg(data->dts[index]);
1369
1370	temp += (data->dts_read_vrlsb[index] >> 6) * 250;
1371	return sprintf(buf, "%ld\n", temp);
1372}
1373
1374static ssize_t
1375show_dts_ext(struct device *dev, struct device_attribute *attr, char *buf)
1376{
1377	struct sensor_device_attribute_2 *sensor_attr =
1378	    to_sensor_dev_attr_2(attr);
1379	int nr = sensor_attr->nr;
1380	struct w83795_data *data = dev_get_drvdata(dev);
1381	long temp = temp_from_reg(data->dts_ext[nr]);
1382
1383	return sprintf(buf, "%ld\n", temp);
1384}
1385
1386static ssize_t
1387store_dts_ext(struct device *dev, struct device_attribute *attr,
1388	   const char *buf, size_t count)
1389{
1390	struct sensor_device_attribute_2 *sensor_attr =
1391	    to_sensor_dev_attr_2(attr);
1392	int nr = sensor_attr->nr;
1393	struct i2c_client *client = to_i2c_client(dev);
1394	struct w83795_data *data = i2c_get_clientdata(client);
1395	long tmp;
1396
1397	if (strict_strtol(buf, 10, &tmp) < 0)
1398		return -EINVAL;
1399
1400	mutex_lock(&data->update_lock);
1401	data->dts_ext[nr] = temp_to_reg(tmp, -128, 127);
1402	w83795_write(client, W83795_REG_DTS_EXT(nr), data->dts_ext[nr]);
1403	mutex_unlock(&data->update_lock);
1404	return count;
1405}
1406
1407
1408static ssize_t
1409show_temp_mode(struct device *dev, struct device_attribute *attr, char *buf)
1410{
1411	struct w83795_data *data = dev_get_drvdata(dev);
1412	struct sensor_device_attribute_2 *sensor_attr =
1413	    to_sensor_dev_attr_2(attr);
1414	int index = sensor_attr->index;
1415	int tmp;
1416
1417	if (data->temp_mode & (1 << index))
1418		tmp = 3;	/* Thermal diode */
1419	else
1420		tmp = 4;	/* Thermistor */
1421
1422	return sprintf(buf, "%d\n", tmp);
1423}
1424
1425/* Only for temp1-4 (temp5-6 can only be thermistor) */
1426static ssize_t
1427store_temp_mode(struct device *dev, struct device_attribute *attr,
1428		const char *buf, size_t count)
1429{
1430	struct i2c_client *client = to_i2c_client(dev);
1431	struct w83795_data *data = i2c_get_clientdata(client);
1432	struct sensor_device_attribute_2 *sensor_attr =
1433	    to_sensor_dev_attr_2(attr);
1434	int index = sensor_attr->index;
1435	int reg_shift;
1436	unsigned long val;
1437	u8 tmp;
1438
1439	if (strict_strtoul(buf, 10, &val) < 0)
1440		return -EINVAL;
1441	if ((val != 4) && (val != 3))
1442		return -EINVAL;
1443
1444	mutex_lock(&data->update_lock);
1445	if (val == 3) {
1446		/* Thermal diode */
1447		val = 0x01;
1448		data->temp_mode |= 1 << index;
1449	} else if (val == 4) {
1450		/* Thermistor */
1451		val = 0x03;
1452		data->temp_mode &= ~(1 << index);
1453	}
1454
1455	reg_shift = 2 * index;
1456	tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
1457	tmp &= ~(0x03 << reg_shift);
1458	tmp |= val << reg_shift;
1459	w83795_write(client, W83795_REG_TEMP_CTRL2, tmp);
1460
1461	mutex_unlock(&data->update_lock);
1462	return count;
1463}
1464
1465
1466/* show/store VIN */
1467static ssize_t
1468show_in(struct device *dev, struct device_attribute *attr, char *buf)
1469{
1470	struct sensor_device_attribute_2 *sensor_attr =
1471	    to_sensor_dev_attr_2(attr);
1472	int nr = sensor_attr->nr;
1473	int index = sensor_attr->index;
1474	struct w83795_data *data = w83795_update_device(dev);
1475	u16 val = data->in[index][nr];
1476	u8 lsb_idx;
1477
1478	switch (nr) {
1479	case IN_READ:
1480		/* calculate this value again by sensors as sensors3.conf */
1481		if ((index >= 17) &&
1482		    !((data->has_gain >> (index - 17)) & 1))
1483			val *= 8;
1484		break;
1485	case IN_MAX:
1486	case IN_LOW:
1487		lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1488		val <<= 2;
1489		val |= (data->in_lsb[lsb_idx][nr] >>
1490			IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT]) & 0x03;
1491		if ((index >= 17) &&
1492		    !((data->has_gain >> (index - 17)) & 1))
1493			val *= 8;
1494		break;
1495	}
1496	val = in_from_reg(index, val);
1497
1498	return sprintf(buf, "%d\n", val);
1499}
1500
1501static ssize_t
1502store_in(struct device *dev, struct device_attribute *attr,
1503	 const char *buf, size_t count)
1504{
1505	struct sensor_device_attribute_2 *sensor_attr =
1506	    to_sensor_dev_attr_2(attr);
1507	int nr = sensor_attr->nr;
1508	int index = sensor_attr->index;
1509	struct i2c_client *client = to_i2c_client(dev);
1510	struct w83795_data *data = i2c_get_clientdata(client);
1511	unsigned long val;
1512	u8 tmp;
1513	u8 lsb_idx;
1514
1515	if (strict_strtoul(buf, 10, &val) < 0)
1516		return -EINVAL;
1517	val = in_to_reg(index, val);
1518
1519	if ((index >= 17) &&
1520	    !((data->has_gain >> (index - 17)) & 1))
1521		val /= 8;
1522	val = SENSORS_LIMIT(val, 0, 0x3FF);
1523	mutex_lock(&data->update_lock);
1524
1525	lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1526	tmp = w83795_read(client, IN_LSB_REG(lsb_idx, nr));
1527	tmp &= ~(0x03 << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT]);
1528	tmp |= (val & 0x03) << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT];
1529	w83795_write(client, IN_LSB_REG(lsb_idx, nr), tmp);
1530	data->in_lsb[lsb_idx][nr] = tmp;
1531
1532	tmp = (val >> 2) & 0xff;
1533	w83795_write(client, W83795_REG_IN[index][nr], tmp);
1534	data->in[index][nr] = tmp;
1535
1536	mutex_unlock(&data->update_lock);
1537	return count;
1538}
1539
1540
1541#ifdef CONFIG_SENSORS_W83795_FANCTRL
1542static ssize_t
1543show_sf_setup(struct device *dev, struct device_attribute *attr, char *buf)
1544{
1545	struct sensor_device_attribute_2 *sensor_attr =
1546	    to_sensor_dev_attr_2(attr);
1547	int nr = sensor_attr->nr;
1548	struct w83795_data *data = w83795_update_pwm_config(dev);
1549	u16 val = data->setup_pwm[nr];
1550
1551	switch (nr) {
1552	case SETUP_PWM_UPTIME:
1553	case SETUP_PWM_DOWNTIME:
1554		val = time_from_reg(val);
1555		break;
1556	}
1557
1558	return sprintf(buf, "%d\n", val);
1559}
1560
1561static ssize_t
1562store_sf_setup(struct device *dev, struct device_attribute *attr,
1563	 const char *buf, size_t count)
1564{
1565	struct sensor_device_attribute_2 *sensor_attr =
1566	    to_sensor_dev_attr_2(attr);
1567	int nr = sensor_attr->nr;
1568	struct i2c_client *client = to_i2c_client(dev);
1569	struct w83795_data *data = i2c_get_clientdata(client);
1570	unsigned long val;
1571
1572	if (strict_strtoul(buf, 10, &val) < 0)
1573		return -EINVAL;
1574
1575	switch (nr) {
1576	case SETUP_PWM_DEFAULT:
1577		val = SENSORS_LIMIT(val, 0, 0xff);
1578		break;
1579	case SETUP_PWM_UPTIME:
1580	case SETUP_PWM_DOWNTIME:
1581		val = time_to_reg(val);
1582		if (val == 0)
1583			return -EINVAL;
1584		break;
1585	}
1586
1587	mutex_lock(&data->update_lock);
1588	data->setup_pwm[nr] = val;
1589	w83795_write(client, W83795_REG_SETUP_PWM(nr), val);
1590	mutex_unlock(&data->update_lock);
1591	return count;
1592}
1593#endif
1594
1595
1596#define NOT_USED			-1
1597
1598/* Don't change the attribute order, _max, _min and _beep are accessed by index
1599 * somewhere else in the code */
 
 
1600#define SENSOR_ATTR_IN(index) {						\
1601	SENSOR_ATTR_2(in##index##_input, S_IRUGO, show_in, NULL,	\
1602		IN_READ, index), \
1603	SENSOR_ATTR_2(in##index##_max, S_IRUGO | S_IWUSR, show_in,	\
1604		store_in, IN_MAX, index),				\
1605	SENSOR_ATTR_2(in##index##_min, S_IRUGO | S_IWUSR, show_in,	\
1606		store_in, IN_LOW, index),				\
1607	SENSOR_ATTR_2(in##index##_alarm, S_IRUGO, show_alarm_beep,	\
1608		NULL, ALARM_STATUS, index + ((index > 14) ? 1 : 0)), \
1609	SENSOR_ATTR_2(in##index##_beep, S_IWUSR | S_IRUGO,		\
1610		show_alarm_beep, store_beep, BEEP_ENABLE,		\
1611		index + ((index > 14) ? 1 : 0)) }
1612
1613/* Don't change the attribute order, _beep is accessed by index
1614 * somewhere else in the code */
 
 
1615#define SENSOR_ATTR_FAN(index) {					\
1616	SENSOR_ATTR_2(fan##index##_input, S_IRUGO, show_fan,		\
1617		NULL, FAN_INPUT, index - 1), \
1618	SENSOR_ATTR_2(fan##index##_min, S_IWUSR | S_IRUGO,		\
1619		show_fan, store_fan_min, FAN_MIN, index - 1),	\
1620	SENSOR_ATTR_2(fan##index##_alarm, S_IRUGO, show_alarm_beep,	\
1621		NULL, ALARM_STATUS, index + 31),			\
1622	SENSOR_ATTR_2(fan##index##_beep, S_IWUSR | S_IRUGO,		\
1623		show_alarm_beep, store_beep, BEEP_ENABLE, index + 31) }
1624
1625#define SENSOR_ATTR_PWM(index) {					\
1626	SENSOR_ATTR_2(pwm##index, S_IWUSR | S_IRUGO, show_pwm,		\
1627		store_pwm, PWM_OUTPUT, index - 1),			\
 
 
 
 
 
 
1628	SENSOR_ATTR_2(pwm##index##_nonstop, S_IWUSR | S_IRUGO,		\
1629		show_pwm, store_pwm, PWM_NONSTOP, index - 1),		\
1630	SENSOR_ATTR_2(pwm##index##_start, S_IWUSR | S_IRUGO,		\
1631		show_pwm, store_pwm, PWM_START, index - 1),		\
1632	SENSOR_ATTR_2(pwm##index##_stop_time, S_IWUSR | S_IRUGO,	\
1633		show_pwm, store_pwm, PWM_STOP_TIME, index - 1),	 \
1634	SENSOR_ATTR_2(pwm##index##_freq, S_IWUSR | S_IRUGO,	\
1635		show_pwm, store_pwm, PWM_FREQ, index - 1),	 \
1636	SENSOR_ATTR_2(pwm##index##_enable, S_IWUSR | S_IRUGO,		\
1637		show_pwm_enable, store_pwm_enable, NOT_USED, index - 1), \
1638	SENSOR_ATTR_2(pwm##index##_mode, S_IRUGO,			\
1639		show_pwm_mode, NULL, NOT_USED, index - 1),		\
1640	SENSOR_ATTR_2(fan##index##_target, S_IWUSR | S_IRUGO, \
1641		show_fanin, store_fanin, FANIN_TARGET, index - 1) }
1642
1643/* Don't change the attribute order, _beep is accessed by index
1644 * somewhere else in the code */
 
 
1645#define SENSOR_ATTR_DTS(index) {					\
1646	SENSOR_ATTR_2(temp##index##_type, S_IRUGO ,		\
1647		show_dts_mode, NULL, NOT_USED, index - 7),	\
1648	SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_dts,		\
1649		NULL, NOT_USED, index - 7),				\
1650	SENSOR_ATTR_2(temp##index##_crit, S_IRUGO | S_IWUSR, show_dts_ext, \
1651		store_dts_ext, DTS_CRIT, NOT_USED),			\
1652	SENSOR_ATTR_2(temp##index##_crit_hyst, S_IRUGO | S_IWUSR,	\
1653		show_dts_ext, store_dts_ext, DTS_CRIT_HYST, NOT_USED),	\
1654	SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_dts_ext, \
1655		store_dts_ext, DTS_WARN, NOT_USED),			\
1656	SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR,	\
1657		show_dts_ext, store_dts_ext, DTS_WARN_HYST, NOT_USED),	\
1658	SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO,			\
1659		show_alarm_beep, NULL, ALARM_STATUS, index + 17),	\
1660	SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO,		\
1661		show_alarm_beep, store_beep, BEEP_ENABLE, index + 17) }
1662
1663/* Don't change the attribute order, _beep is accessed by index
1664 * somewhere else in the code */
 
 
1665#define SENSOR_ATTR_TEMP(index) {					\
1666	SENSOR_ATTR_2(temp##index##_type, S_IRUGO | (index < 4 ? S_IWUSR : 0), \
1667		show_temp_mode, store_temp_mode, NOT_USED, index - 1),	\
1668	SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_temp,		\
1669		NULL, TEMP_READ, index - 1),				\
1670	SENSOR_ATTR_2(temp##index##_crit, S_IRUGO | S_IWUSR, show_temp,	\
1671		store_temp, TEMP_CRIT, index - 1),			\
1672	SENSOR_ATTR_2(temp##index##_crit_hyst, S_IRUGO | S_IWUSR,	\
1673		show_temp, store_temp, TEMP_CRIT_HYST, index - 1),	\
1674	SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_temp,	\
1675		store_temp, TEMP_WARN, index - 1),			\
1676	SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR,	\
1677		show_temp, store_temp, TEMP_WARN_HYST, index - 1),	\
1678	SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO,			\
1679		show_alarm_beep, NULL, ALARM_STATUS,			\
1680		index + (index > 4 ? 11 : 17)),				\
1681	SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO,		\
1682		show_alarm_beep, store_beep, BEEP_ENABLE,		\
1683		index + (index > 4 ? 11 : 17)),				\
1684	SENSOR_ATTR_2(temp##index##_pwm_enable, S_IWUSR | S_IRUGO,	\
1685		show_temp_pwm_enable, store_temp_pwm_enable,		\
1686		TEMP_PWM_ENABLE, index - 1),				\
1687	SENSOR_ATTR_2(temp##index##_auto_channels_pwm, S_IWUSR | S_IRUGO, \
1688		show_temp_pwm_enable, store_temp_pwm_enable,		\
1689		TEMP_PWM_FAN_MAP, index - 1),				\
1690	SENSOR_ATTR_2(thermal_cruise##index, S_IWUSR | S_IRUGO,		\
1691		show_temp_pwm, store_temp_pwm, TEMP_PWM_TTTI, index - 1), \
1692	SENSOR_ATTR_2(temp##index##_warn, S_IWUSR | S_IRUGO,		\
1693		show_temp_pwm, store_temp_pwm, TEMP_PWM_CTFS, index - 1), \
1694	SENSOR_ATTR_2(temp##index##_warn_hyst, S_IWUSR | S_IRUGO,	\
1695		show_temp_pwm, store_temp_pwm, TEMP_PWM_HCT, index - 1), \
1696	SENSOR_ATTR_2(temp##index##_operation_hyst, S_IWUSR | S_IRUGO,	\
1697		show_temp_pwm, store_temp_pwm, TEMP_PWM_HOT, index - 1), \
1698	SENSOR_ATTR_2(temp##index##_auto_point1_pwm, S_IRUGO | S_IWUSR, \
1699		show_sf4_pwm, store_sf4_pwm, 0, index - 1),		\
1700	SENSOR_ATTR_2(temp##index##_auto_point2_pwm, S_IRUGO | S_IWUSR, \
1701		show_sf4_pwm, store_sf4_pwm, 1, index - 1),		\
1702	SENSOR_ATTR_2(temp##index##_auto_point3_pwm, S_IRUGO | S_IWUSR, \
1703		show_sf4_pwm, store_sf4_pwm, 2, index - 1),		\
1704	SENSOR_ATTR_2(temp##index##_auto_point4_pwm, S_IRUGO | S_IWUSR, \
1705		show_sf4_pwm, store_sf4_pwm, 3, index - 1),		\
1706	SENSOR_ATTR_2(temp##index##_auto_point5_pwm, S_IRUGO | S_IWUSR, \
1707		show_sf4_pwm, store_sf4_pwm, 4, index - 1),		\
1708	SENSOR_ATTR_2(temp##index##_auto_point6_pwm, S_IRUGO | S_IWUSR, \
1709		show_sf4_pwm, store_sf4_pwm, 5, index - 1),		\
1710	SENSOR_ATTR_2(temp##index##_auto_point7_pwm, S_IRUGO | S_IWUSR, \
1711		show_sf4_pwm, store_sf4_pwm, 6, index - 1),		\
1712	SENSOR_ATTR_2(temp##index##_auto_point1_temp, S_IRUGO | S_IWUSR,\
1713		show_sf4_temp, store_sf4_temp, 0, index - 1),		\
1714	SENSOR_ATTR_2(temp##index##_auto_point2_temp, S_IRUGO | S_IWUSR,\
1715		show_sf4_temp, store_sf4_temp, 1, index - 1),		\
1716	SENSOR_ATTR_2(temp##index##_auto_point3_temp, S_IRUGO | S_IWUSR,\
1717		show_sf4_temp, store_sf4_temp, 2, index - 1),		\
1718	SENSOR_ATTR_2(temp##index##_auto_point4_temp, S_IRUGO | S_IWUSR,\
1719		show_sf4_temp, store_sf4_temp, 3, index - 1),		\
1720	SENSOR_ATTR_2(temp##index##_auto_point5_temp, S_IRUGO | S_IWUSR,\
1721		show_sf4_temp, store_sf4_temp, 4, index - 1),		\
1722	SENSOR_ATTR_2(temp##index##_auto_point6_temp, S_IRUGO | S_IWUSR,\
1723		show_sf4_temp, store_sf4_temp, 5, index - 1),		\
1724	SENSOR_ATTR_2(temp##index##_auto_point7_temp, S_IRUGO | S_IWUSR,\
1725		show_sf4_temp, store_sf4_temp, 6, index - 1) }
1726
1727
1728static struct sensor_device_attribute_2 w83795_in[][5] = {
1729	SENSOR_ATTR_IN(0),
1730	SENSOR_ATTR_IN(1),
1731	SENSOR_ATTR_IN(2),
1732	SENSOR_ATTR_IN(3),
1733	SENSOR_ATTR_IN(4),
1734	SENSOR_ATTR_IN(5),
1735	SENSOR_ATTR_IN(6),
1736	SENSOR_ATTR_IN(7),
1737	SENSOR_ATTR_IN(8),
1738	SENSOR_ATTR_IN(9),
1739	SENSOR_ATTR_IN(10),
1740	SENSOR_ATTR_IN(11),
1741	SENSOR_ATTR_IN(12),
1742	SENSOR_ATTR_IN(13),
1743	SENSOR_ATTR_IN(14),
1744	SENSOR_ATTR_IN(15),
1745	SENSOR_ATTR_IN(16),
1746	SENSOR_ATTR_IN(17),
1747	SENSOR_ATTR_IN(18),
1748	SENSOR_ATTR_IN(19),
1749	SENSOR_ATTR_IN(20),
1750};
1751
1752static const struct sensor_device_attribute_2 w83795_fan[][4] = {
1753	SENSOR_ATTR_FAN(1),
1754	SENSOR_ATTR_FAN(2),
1755	SENSOR_ATTR_FAN(3),
1756	SENSOR_ATTR_FAN(4),
1757	SENSOR_ATTR_FAN(5),
1758	SENSOR_ATTR_FAN(6),
1759	SENSOR_ATTR_FAN(7),
1760	SENSOR_ATTR_FAN(8),
1761	SENSOR_ATTR_FAN(9),
1762	SENSOR_ATTR_FAN(10),
1763	SENSOR_ATTR_FAN(11),
1764	SENSOR_ATTR_FAN(12),
1765	SENSOR_ATTR_FAN(13),
1766	SENSOR_ATTR_FAN(14),
1767};
1768
1769static const struct sensor_device_attribute_2 w83795_temp[][28] = {
1770	SENSOR_ATTR_TEMP(1),
1771	SENSOR_ATTR_TEMP(2),
1772	SENSOR_ATTR_TEMP(3),
1773	SENSOR_ATTR_TEMP(4),
1774	SENSOR_ATTR_TEMP(5),
1775	SENSOR_ATTR_TEMP(6),
1776};
1777
1778static const struct sensor_device_attribute_2 w83795_dts[][8] = {
1779	SENSOR_ATTR_DTS(7),
1780	SENSOR_ATTR_DTS(8),
1781	SENSOR_ATTR_DTS(9),
1782	SENSOR_ATTR_DTS(10),
1783	SENSOR_ATTR_DTS(11),
1784	SENSOR_ATTR_DTS(12),
1785	SENSOR_ATTR_DTS(13),
1786	SENSOR_ATTR_DTS(14),
1787};
1788
1789static const struct sensor_device_attribute_2 w83795_pwm[][8] = {
1790	SENSOR_ATTR_PWM(1),
1791	SENSOR_ATTR_PWM(2),
1792	SENSOR_ATTR_PWM(3),
1793	SENSOR_ATTR_PWM(4),
1794	SENSOR_ATTR_PWM(5),
1795	SENSOR_ATTR_PWM(6),
1796	SENSOR_ATTR_PWM(7),
1797	SENSOR_ATTR_PWM(8),
1798};
1799
1800static const struct sensor_device_attribute_2 w83795_tss[6] = {
1801	SENSOR_ATTR_2(temp1_source_sel, S_IWUSR | S_IRUGO,
1802		      show_temp_src, store_temp_src, NOT_USED, 0),
1803	SENSOR_ATTR_2(temp2_source_sel, S_IWUSR | S_IRUGO,
1804		      show_temp_src, store_temp_src, NOT_USED, 1),
1805	SENSOR_ATTR_2(temp3_source_sel, S_IWUSR | S_IRUGO,
1806		      show_temp_src, store_temp_src, NOT_USED, 2),
1807	SENSOR_ATTR_2(temp4_source_sel, S_IWUSR | S_IRUGO,
1808		      show_temp_src, store_temp_src, NOT_USED, 3),
1809	SENSOR_ATTR_2(temp5_source_sel, S_IWUSR | S_IRUGO,
1810		      show_temp_src, store_temp_src, NOT_USED, 4),
1811	SENSOR_ATTR_2(temp6_source_sel, S_IWUSR | S_IRUGO,
1812		      show_temp_src, store_temp_src, NOT_USED, 5),
1813};
1814
1815static const struct sensor_device_attribute_2 sda_single_files[] = {
1816	SENSOR_ATTR_2(intrusion0_alarm, S_IWUSR | S_IRUGO, show_alarm_beep,
1817		      store_chassis_clear, ALARM_STATUS, 46),
1818#ifdef CONFIG_SENSORS_W83795_FANCTRL
1819	SENSOR_ATTR_2(speed_cruise_tolerance, S_IWUSR | S_IRUGO, show_fanin,
1820		store_fanin, FANIN_TOL, NOT_USED),
1821	SENSOR_ATTR_2(pwm_default, S_IWUSR | S_IRUGO, show_sf_setup,
1822		      store_sf_setup, SETUP_PWM_DEFAULT, NOT_USED),
1823	SENSOR_ATTR_2(pwm_uptime, S_IWUSR | S_IRUGO, show_sf_setup,
1824		      store_sf_setup, SETUP_PWM_UPTIME, NOT_USED),
1825	SENSOR_ATTR_2(pwm_downtime, S_IWUSR | S_IRUGO, show_sf_setup,
1826		      store_sf_setup, SETUP_PWM_DOWNTIME, NOT_USED),
1827#endif
1828};
1829
1830static const struct sensor_device_attribute_2 sda_beep_files[] = {
1831	SENSOR_ATTR_2(intrusion0_beep, S_IWUSR | S_IRUGO, show_alarm_beep,
1832		      store_beep, BEEP_ENABLE, 46),
1833	SENSOR_ATTR_2(beep_enable, S_IWUSR | S_IRUGO, show_alarm_beep,
1834		      store_beep, BEEP_ENABLE, 47),
1835};
1836
1837/*
1838 * Driver interface
1839 */
1840
1841static void w83795_init_client(struct i2c_client *client)
1842{
1843	struct w83795_data *data = i2c_get_clientdata(client);
1844	static const u16 clkin[4] = {	/* in kHz */
1845		14318, 24000, 33333, 48000
1846	};
1847	u8 config;
1848
1849	if (reset)
1850		w83795_write(client, W83795_REG_CONFIG, 0x80);
1851
1852	/* Start monitoring if needed */
1853	config = w83795_read(client, W83795_REG_CONFIG);
1854	if (!(config & W83795_REG_CONFIG_START)) {
1855		dev_info(&client->dev, "Enabling monitoring operations\n");
1856		w83795_write(client, W83795_REG_CONFIG,
1857			     config | W83795_REG_CONFIG_START);
1858	}
1859
1860	data->clkin = clkin[(config >> 3) & 0x3];
1861	dev_dbg(&client->dev, "clkin = %u kHz\n", data->clkin);
1862}
1863
1864static int w83795_get_device_id(struct i2c_client *client)
1865{
1866	int device_id;
1867
1868	device_id = i2c_smbus_read_byte_data(client, W83795_REG_DEVICEID);
1869
1870	/* Special case for rev. A chips; can't be checked first because later
1871	   revisions emulate this for compatibility */
 
 
1872	if (device_id < 0 || (device_id & 0xf0) != 0x50) {
1873		int alt_id;
1874
1875		alt_id = i2c_smbus_read_byte_data(client,
1876						  W83795_REG_DEVICEID_A);
1877		if (alt_id == 0x50)
1878			device_id = alt_id;
1879	}
1880
1881	return device_id;
1882}
1883
1884/* Return 0 if detection is successful, -ENODEV otherwise */
1885static int w83795_detect(struct i2c_client *client,
1886			 struct i2c_board_info *info)
1887{
1888	int bank, vendor_id, device_id, expected, i2c_addr, config;
1889	struct i2c_adapter *adapter = client->adapter;
1890	unsigned short address = client->addr;
1891	const char *chip_name;
1892
1893	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1894		return -ENODEV;
1895	bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
1896	if (bank < 0 || (bank & 0x7c)) {
1897		dev_dbg(&adapter->dev,
1898			"w83795: Detection failed at addr 0x%02hx, check %s\n",
1899			address, "bank");
1900		return -ENODEV;
1901	}
1902
1903	/* Check Nuvoton vendor ID */
1904	vendor_id = i2c_smbus_read_byte_data(client, W83795_REG_VENDORID);
1905	expected = bank & 0x80 ? 0x5c : 0xa3;
1906	if (vendor_id != expected) {
1907		dev_dbg(&adapter->dev,
1908			"w83795: Detection failed at addr 0x%02hx, check %s\n",
1909			address, "vendor id");
1910		return -ENODEV;
1911	}
1912
1913	/* Check device ID */
1914	device_id = w83795_get_device_id(client) |
1915		    (i2c_smbus_read_byte_data(client, W83795_REG_CHIPID) << 8);
1916	if ((device_id >> 4) != 0x795) {
1917		dev_dbg(&adapter->dev,
1918			"w83795: Detection failed at addr 0x%02hx, check %s\n",
1919			address, "device id\n");
1920		return -ENODEV;
1921	}
1922
1923	/* If Nuvoton chip, address of chip and W83795_REG_I2C_ADDR
1924	   should match */
 
 
1925	if ((bank & 0x07) == 0) {
1926		i2c_addr = i2c_smbus_read_byte_data(client,
1927						    W83795_REG_I2C_ADDR);
1928		if ((i2c_addr & 0x7f) != address) {
1929			dev_dbg(&adapter->dev,
1930				"w83795: Detection failed at addr 0x%02hx, "
1931				"check %s\n", address, "i2c addr");
1932			return -ENODEV;
1933		}
1934	}
1935
1936	/* Check 795 chip type: 795G or 795ADG
1937	   Usually we don't write to chips during detection, but here we don't
1938	   quite have the choice; hopefully it's OK, we are about to return
1939	   success anyway */
 
 
1940	if ((bank & 0x07) != 0)
1941		i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL,
1942					  bank & ~0x07);
1943	config = i2c_smbus_read_byte_data(client, W83795_REG_CONFIG);
1944	if (config & W83795_REG_CONFIG_CONFIG48)
1945		chip_name = "w83795adg";
1946	else
1947		chip_name = "w83795g";
1948
1949	strlcpy(info->type, chip_name, I2C_NAME_SIZE);
1950	dev_info(&adapter->dev, "Found %s rev. %c at 0x%02hx\n", chip_name,
1951		 'A' + (device_id & 0xf), address);
1952
1953	return 0;
1954}
1955
 
 
 
 
 
 
 
 
1956static int w83795_handle_files(struct device *dev, int (*fn)(struct device *,
1957			       const struct device_attribute *))
1958{
1959	struct w83795_data *data = dev_get_drvdata(dev);
1960	int err, i, j;
1961
1962	for (i = 0; i < ARRAY_SIZE(w83795_in); i++) {
1963		if (!(data->has_in & (1 << i)))
1964			continue;
1965		for (j = 0; j < ARRAY_SIZE(w83795_in[0]); j++) {
1966			if (j == 4 && !data->enable_beep)
1967				continue;
1968			err = fn(dev, &w83795_in[i][j].dev_attr);
1969			if (err)
1970				return err;
1971		}
1972	}
1973
1974	for (i = 0; i < ARRAY_SIZE(w83795_fan); i++) {
1975		if (!(data->has_fan & (1 << i)))
1976			continue;
1977		for (j = 0; j < ARRAY_SIZE(w83795_fan[0]); j++) {
1978			if (j == 3 && !data->enable_beep)
1979				continue;
1980			err = fn(dev, &w83795_fan[i][j].dev_attr);
1981			if (err)
1982				return err;
1983		}
1984	}
1985
1986	for (i = 0; i < ARRAY_SIZE(w83795_tss); i++) {
1987		j = w83795_tss_useful(data, i);
1988		if (!j)
1989			continue;
1990		err = fn(dev, &w83795_tss[i].dev_attr);
1991		if (err)
1992			return err;
1993	}
1994
1995	for (i = 0; i < ARRAY_SIZE(sda_single_files); i++) {
1996		err = fn(dev, &sda_single_files[i].dev_attr);
1997		if (err)
1998			return err;
1999	}
2000
2001	if (data->enable_beep) {
2002		for (i = 0; i < ARRAY_SIZE(sda_beep_files); i++) {
2003			err = fn(dev, &sda_beep_files[i].dev_attr);
2004			if (err)
2005				return err;
2006		}
2007	}
2008
2009#ifdef CONFIG_SENSORS_W83795_FANCTRL
2010	for (i = 0; i < data->has_pwm; i++) {
2011		for (j = 0; j < ARRAY_SIZE(w83795_pwm[0]); j++) {
2012			err = fn(dev, &w83795_pwm[i][j].dev_attr);
2013			if (err)
2014				return err;
2015		}
2016	}
2017#endif
2018
2019	for (i = 0; i < ARRAY_SIZE(w83795_temp); i++) {
2020		if (!(data->has_temp & (1 << i)))
2021			continue;
2022#ifdef CONFIG_SENSORS_W83795_FANCTRL
2023		for (j = 0; j < ARRAY_SIZE(w83795_temp[0]); j++) {
2024#else
2025		for (j = 0; j < 8; j++) {
2026#endif
2027			if (j == 7 && !data->enable_beep)
2028				continue;
2029			err = fn(dev, &w83795_temp[i][j].dev_attr);
2030			if (err)
2031				return err;
2032		}
2033	}
2034
2035	if (data->enable_dts) {
2036		for (i = 0; i < ARRAY_SIZE(w83795_dts); i++) {
2037			if (!(data->has_dts & (1 << i)))
2038				continue;
2039			for (j = 0; j < ARRAY_SIZE(w83795_dts[0]); j++) {
2040				if (j == 7 && !data->enable_beep)
2041					continue;
2042				err = fn(dev, &w83795_dts[i][j].dev_attr);
2043				if (err)
2044					return err;
2045			}
2046		}
2047	}
2048
2049	return 0;
2050}
2051
2052/* We need a wrapper that fits in w83795_handle_files */
2053static int device_remove_file_wrapper(struct device *dev,
2054				      const struct device_attribute *attr)
2055{
2056	device_remove_file(dev, attr);
2057	return 0;
2058}
2059
2060static void w83795_check_dynamic_in_limits(struct i2c_client *client)
2061{
2062	struct w83795_data *data = i2c_get_clientdata(client);
2063	u8 vid_ctl;
2064	int i, err_max, err_min;
2065
2066	vid_ctl = w83795_read(client, W83795_REG_VID_CTRL);
2067
2068	/* Return immediately if VRM isn't configured */
2069	if ((vid_ctl & 0x07) == 0x00 || (vid_ctl & 0x07) == 0x07)
2070		return;
2071
2072	data->has_dyn_in = (vid_ctl >> 3) & 0x07;
2073	for (i = 0; i < 2; i++) {
2074		if (!(data->has_dyn_in & (1 << i)))
2075			continue;
2076
2077		/* Voltage limits in dynamic mode, switch to read-only */
2078		err_max = sysfs_chmod_file(&client->dev.kobj,
2079					   &w83795_in[i][2].dev_attr.attr,
2080					   S_IRUGO);
2081		err_min = sysfs_chmod_file(&client->dev.kobj,
2082					   &w83795_in[i][3].dev_attr.attr,
2083					   S_IRUGO);
2084		if (err_max || err_min)
2085			dev_warn(&client->dev, "Failed to set in%d limits "
2086				 "read-only (%d, %d)\n", i, err_max, err_min);
 
2087		else
2088			dev_info(&client->dev, "in%d limits set dynamically "
2089				 "from VID\n", i);
2090	}
2091}
2092
2093/* Check pins that can be used for either temperature or voltage monitoring */
2094static void w83795_apply_temp_config(struct w83795_data *data, u8 config,
2095				     int temp_chan, int in_chan)
2096{
2097	/* config is a 2-bit value */
2098	switch (config) {
2099	case 0x2: /* Voltage monitoring */
2100		data->has_in |= 1 << in_chan;
2101		break;
2102	case 0x1: /* Thermal diode */
2103		if (temp_chan >= 4)
2104			break;
2105		data->temp_mode |= 1 << temp_chan;
2106		/* fall through */
2107	case 0x3: /* Thermistor */
2108		data->has_temp |= 1 << temp_chan;
2109		break;
2110	}
2111}
2112
2113static int w83795_probe(struct i2c_client *client,
2114			const struct i2c_device_id *id)
 
2115{
2116	int i;
2117	u8 tmp;
2118	struct device *dev = &client->dev;
2119	struct w83795_data *data;
2120	int err;
2121
2122	data = kzalloc(sizeof(struct w83795_data), GFP_KERNEL);
2123	if (!data) {
2124		err = -ENOMEM;
2125		goto exit;
2126	}
2127
2128	i2c_set_clientdata(client, data);
2129	data->chip_type = id->driver_data;
2130	data->bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
2131	mutex_init(&data->update_lock);
2132
2133	/* Initialize the chip */
2134	w83795_init_client(client);
2135
2136	/* Check which voltages and fans are present */
2137	data->has_in = w83795_read(client, W83795_REG_VOLT_CTRL1)
2138		     | (w83795_read(client, W83795_REG_VOLT_CTRL2) << 8);
2139	data->has_fan = w83795_read(client, W83795_REG_FANIN_CTRL1)
2140		      | (w83795_read(client, W83795_REG_FANIN_CTRL2) << 8);
2141
2142	/* Check which analog temperatures and extra voltages are present */
2143	tmp = w83795_read(client, W83795_REG_TEMP_CTRL1);
2144	if (tmp & 0x20)
2145		data->enable_dts = 1;
2146	w83795_apply_temp_config(data, (tmp >> 2) & 0x3, 5, 16);
2147	w83795_apply_temp_config(data, tmp & 0x3, 4, 15);
2148	tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
2149	w83795_apply_temp_config(data, tmp >> 6, 3, 20);
2150	w83795_apply_temp_config(data, (tmp >> 4) & 0x3, 2, 19);
2151	w83795_apply_temp_config(data, (tmp >> 2) & 0x3, 1, 18);
2152	w83795_apply_temp_config(data, tmp & 0x3, 0, 17);
2153
2154	/* Check DTS enable status */
2155	if (data->enable_dts) {
2156		if (1 & w83795_read(client, W83795_REG_DTSC))
2157			data->enable_dts |= 2;
2158		data->has_dts = w83795_read(client, W83795_REG_DTSE);
2159	}
2160
2161	/* Report PECI Tbase values */
2162	if (data->enable_dts == 1) {
2163		for (i = 0; i < 8; i++) {
2164			if (!(data->has_dts & (1 << i)))
2165				continue;
2166			tmp = w83795_read(client, W83795_REG_PECI_TBASE(i));
2167			dev_info(&client->dev,
2168				 "PECI agent %d Tbase temperature: %u\n",
2169				 i + 1, (unsigned int)tmp & 0x7f);
2170		}
2171	}
2172
2173	data->has_gain = w83795_read(client, W83795_REG_VMIGB_CTRL) & 0x0f;
2174
2175	/* pwm and smart fan */
2176	if (data->chip_type == w83795g)
2177		data->has_pwm = 8;
2178	else
2179		data->has_pwm = 2;
2180
2181	/* Check if BEEP pin is available */
2182	if (data->chip_type == w83795g) {
2183		/* The W83795G has a dedicated BEEP pin */
2184		data->enable_beep = 1;
2185	} else {
2186		/* The W83795ADG has a shared pin for OVT# and BEEP, so you
2187		 * can't have both */
 
 
2188		tmp = w83795_read(client, W83795_REG_OVT_CFG);
2189		if ((tmp & OVT_CFG_SEL) == 0)
2190			data->enable_beep = 1;
2191	}
2192
2193	err = w83795_handle_files(dev, device_create_file);
2194	if (err)
2195		goto exit_remove;
2196
2197	if (data->chip_type == w83795g)
2198		w83795_check_dynamic_in_limits(client);
2199
2200	data->hwmon_dev = hwmon_device_register(dev);
2201	if (IS_ERR(data->hwmon_dev)) {
2202		err = PTR_ERR(data->hwmon_dev);
2203		goto exit_remove;
2204	}
2205
2206	return 0;
2207
2208exit_remove:
2209	w83795_handle_files(dev, device_remove_file_wrapper);
2210	kfree(data);
2211exit:
2212	return err;
2213}
2214
2215static int w83795_remove(struct i2c_client *client)
2216{
2217	struct w83795_data *data = i2c_get_clientdata(client);
2218
2219	hwmon_device_unregister(data->hwmon_dev);
2220	w83795_handle_files(&client->dev, device_remove_file_wrapper);
2221	kfree(data);
2222
2223	return 0;
2224}
2225
2226
2227static const struct i2c_device_id w83795_id[] = {
2228	{ "w83795g", w83795g },
2229	{ "w83795adg", w83795adg },
2230	{ }
2231};
2232MODULE_DEVICE_TABLE(i2c, w83795_id);
2233
2234static struct i2c_driver w83795_driver = {
2235	.driver = {
2236		   .name = "w83795",
2237	},
2238	.probe		= w83795_probe,
2239	.remove		= w83795_remove,
2240	.id_table	= w83795_id,
2241
2242	.class		= I2C_CLASS_HWMON,
2243	.detect		= w83795_detect,
2244	.address_list	= normal_i2c,
2245};
2246
2247static int __init sensors_w83795_init(void)
2248{
2249	return i2c_add_driver(&w83795_driver);
2250}
2251
2252static void __exit sensors_w83795_exit(void)
2253{
2254	i2c_del_driver(&w83795_driver);
2255}
2256
2257MODULE_AUTHOR("Wei Song, Jean Delvare <khali@linux-fr.org>");
2258MODULE_DESCRIPTION("W83795G/ADG hardware monitoring driver");
2259MODULE_LICENSE("GPL");
2260
2261module_init(sensors_w83795_init);
2262module_exit(sensors_w83795_exit);