xref: /openbmc/linux/drivers/hwmon/w83795.c (revision b5f6a90a)
1792d376bSWei Song /*
2792d376bSWei Song  *  w83795.c - Linux kernel driver for hardware monitoring
3792d376bSWei Song  *  Copyright (C) 2008 Nuvoton Technology Corp.
4792d376bSWei Song  *                Wei Song
5792d376bSWei Song  *
6792d376bSWei Song  *  This program is free software; you can redistribute it and/or modify
7792d376bSWei Song  *  it under the terms of the GNU General Public License as published by
8792d376bSWei Song  *  the Free Software Foundation - version 2.
9792d376bSWei Song  *
10792d376bSWei Song  *  This program is distributed in the hope that it will be useful,
11792d376bSWei Song  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
12792d376bSWei Song  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13792d376bSWei Song  *  GNU General Public License for more details.
14792d376bSWei Song  *
15792d376bSWei Song  *  You should have received a copy of the GNU General Public License
16792d376bSWei Song  *  along with this program; if not, write to the Free Software
17792d376bSWei Song  *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
18792d376bSWei Song  *  02110-1301 USA.
19792d376bSWei Song  *
20792d376bSWei Song  *  Supports following chips:
21792d376bSWei Song  *
22792d376bSWei Song  *  Chip       #vin   #fanin #pwm #temp #dts wchipid  vendid  i2c  ISA
23792d376bSWei Song  *  w83795g     21     14     8     6     8    0x79   0x5ca3  yes   no
24792d376bSWei Song  *  w83795adg   18     14     2     6     8    0x79   0x5ca3  yes   no
25792d376bSWei Song  */
26792d376bSWei Song 
27792d376bSWei Song #include <linux/kernel.h>
28792d376bSWei Song #include <linux/module.h>
29792d376bSWei Song #include <linux/init.h>
30792d376bSWei Song #include <linux/slab.h>
31792d376bSWei Song #include <linux/i2c.h>
32792d376bSWei Song #include <linux/hwmon.h>
33792d376bSWei Song #include <linux/hwmon-sysfs.h>
34792d376bSWei Song #include <linux/err.h>
35792d376bSWei Song #include <linux/mutex.h>
36792d376bSWei Song #include <linux/delay.h>
37792d376bSWei Song 
38792d376bSWei Song /* Addresses to scan */
39792d376bSWei Song static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, 0x2f, I2C_CLIENT_END };
40792d376bSWei Song 
41792d376bSWei Song 
42792d376bSWei Song static int reset;
43792d376bSWei Song module_param(reset, bool, 0);
44792d376bSWei Song MODULE_PARM_DESC(reset, "Set to 1 to reset chip, not recommended");
45792d376bSWei Song 
46792d376bSWei Song 
47792d376bSWei Song #define W83795_REG_BANKSEL		0x00
48792d376bSWei Song #define W83795_REG_VENDORID		0xfd
49792d376bSWei Song #define W83795_REG_CHIPID		0xfe
50792d376bSWei Song #define W83795_REG_DEVICEID		0xfb
512be381deSJean Delvare #define W83795_REG_DEVICEID_A		0xff
52792d376bSWei Song 
53792d376bSWei Song #define W83795_REG_I2C_ADDR		0xfc
54792d376bSWei Song #define W83795_REG_CONFIG		0x01
55792d376bSWei Song #define W83795_REG_CONFIG_CONFIG48	0x04
56792d376bSWei Song 
57792d376bSWei Song /* Multi-Function Pin Ctrl Registers */
58792d376bSWei Song #define W83795_REG_VOLT_CTRL1		0x02
59792d376bSWei Song #define W83795_REG_VOLT_CTRL2		0x03
60792d376bSWei Song #define W83795_REG_TEMP_CTRL1		0x04
61792d376bSWei Song #define W83795_REG_TEMP_CTRL2		0x05
62792d376bSWei Song #define W83795_REG_FANIN_CTRL1		0x06
63792d376bSWei Song #define W83795_REG_FANIN_CTRL2		0x07
64792d376bSWei Song #define W83795_REG_VMIGB_CTRL		0x08
65792d376bSWei Song 
66792d376bSWei Song #define TEMP_CTRL_DISABLE		0
67792d376bSWei Song #define TEMP_CTRL_TD			1
68792d376bSWei Song #define TEMP_CTRL_VSEN			2
69792d376bSWei Song #define TEMP_CTRL_TR			3
70792d376bSWei Song #define TEMP_CTRL_SHIFT			4
71792d376bSWei Song #define TEMP_CTRL_HASIN_SHIFT		5
72792d376bSWei Song /* temp mode may effect VSEN17-12 (in20-15) */
73792d376bSWei Song static u16 W83795_REG_TEMP_CTRL[][6] = {
74792d376bSWei Song 	/* Disable, TD, VSEN, TR, register shift value, has_in shift num */
75792d376bSWei Song 	{0x00, 0x01, 0x02, 0x03, 0, 17},	/* TR1 */
76792d376bSWei Song 	{0x00, 0x04, 0x08, 0x0C, 2, 18},	/* TR2 */
77792d376bSWei Song 	{0x00, 0x10, 0x20, 0x30, 4, 19},	/* TR3 */
78792d376bSWei Song 	{0x00, 0x40, 0x80, 0xC0, 6, 20},	/* TR4 */
79792d376bSWei Song 	{0x00, 0x00, 0x02, 0x03, 0, 15},	/* TR5 */
80792d376bSWei Song 	{0x00, 0x00, 0x08, 0x0C, 2, 16},	/* TR6 */
81792d376bSWei Song };
82792d376bSWei Song 
83792d376bSWei Song #define TEMP_READ			0
84792d376bSWei Song #define TEMP_CRIT			1
85792d376bSWei Song #define TEMP_CRIT_HYST			2
86792d376bSWei Song #define TEMP_WARN			3
87792d376bSWei Song #define TEMP_WARN_HYST			4
88792d376bSWei Song /* only crit and crit_hyst affect real-time alarm status
89792d376bSWei Song  * current crit crit_hyst warn warn_hyst */
90792d376bSWei Song static u16 W83795_REG_TEMP[][5] = {
91792d376bSWei Song 	{0x21, 0x96, 0x97, 0x98, 0x99},	/* TD1/TR1 */
92792d376bSWei Song 	{0x22, 0x9a, 0x9b, 0x9c, 0x9d},	/* TD2/TR2 */
93792d376bSWei Song 	{0x23, 0x9e, 0x9f, 0xa0, 0xa1},	/* TD3/TR3 */
94792d376bSWei Song 	{0x24, 0xa2, 0xa3, 0xa4, 0xa5},	/* TD4/TR4 */
95792d376bSWei Song 	{0x1f, 0xa6, 0xa7, 0xa8, 0xa9},	/* TR5 */
96792d376bSWei Song 	{0x20, 0xaa, 0xab, 0xac, 0xad},	/* TR6 */
97792d376bSWei Song };
98792d376bSWei Song 
99792d376bSWei Song #define IN_READ				0
100792d376bSWei Song #define IN_MAX				1
101792d376bSWei Song #define IN_LOW				2
102792d376bSWei Song static const u16 W83795_REG_IN[][3] = {
103792d376bSWei Song 	/* Current, HL, LL */
104792d376bSWei Song 	{0x10, 0x70, 0x71},	/* VSEN1 */
105792d376bSWei Song 	{0x11, 0x72, 0x73},	/* VSEN2 */
106792d376bSWei Song 	{0x12, 0x74, 0x75},	/* VSEN3 */
107792d376bSWei Song 	{0x13, 0x76, 0x77},	/* VSEN4 */
108792d376bSWei Song 	{0x14, 0x78, 0x79},	/* VSEN5 */
109792d376bSWei Song 	{0x15, 0x7a, 0x7b},	/* VSEN6 */
110792d376bSWei Song 	{0x16, 0x7c, 0x7d},	/* VSEN7 */
111792d376bSWei Song 	{0x17, 0x7e, 0x7f},	/* VSEN8 */
112792d376bSWei Song 	{0x18, 0x80, 0x81},	/* VSEN9 */
113792d376bSWei Song 	{0x19, 0x82, 0x83},	/* VSEN10 */
114792d376bSWei Song 	{0x1A, 0x84, 0x85},	/* VSEN11 */
115792d376bSWei Song 	{0x1B, 0x86, 0x87},	/* VTT */
116792d376bSWei Song 	{0x1C, 0x88, 0x89},	/* 3VDD */
117792d376bSWei Song 	{0x1D, 0x8a, 0x8b},	/* 3VSB */
118792d376bSWei Song 	{0x1E, 0x8c, 0x8d},	/* VBAT */
119792d376bSWei Song 	{0x1F, 0xa6, 0xa7},	/* VSEN12 */
120792d376bSWei Song 	{0x20, 0xaa, 0xab},	/* VSEN13 */
121792d376bSWei Song 	{0x21, 0x96, 0x97},	/* VSEN14 */
122792d376bSWei Song 	{0x22, 0x9a, 0x9b},	/* VSEN15 */
123792d376bSWei Song 	{0x23, 0x9e, 0x9f},	/* VSEN16 */
124792d376bSWei Song 	{0x24, 0xa2, 0xa3},	/* VSEN17 */
125792d376bSWei Song };
126792d376bSWei Song #define W83795_REG_VRLSB		0x3C
127792d376bSWei Song #define VRLSB_SHIFT			6
128792d376bSWei Song 
129792d376bSWei Song static const u8 W83795_REG_IN_HL_LSB[] = {
130792d376bSWei Song 	0x8e,	/* VSEN1-4 */
131792d376bSWei Song 	0x90,	/* VSEN5-8 */
132792d376bSWei Song 	0x92,	/* VSEN9-11 */
133792d376bSWei Song 	0x94,	/* VTT, 3VDD, 3VSB, 3VBAT */
134792d376bSWei Song 	0xa8,	/* VSEN12 */
135792d376bSWei Song 	0xac,	/* VSEN13 */
136792d376bSWei Song 	0x98,	/* VSEN14 */
137792d376bSWei Song 	0x9c,	/* VSEN15 */
138792d376bSWei Song 	0xa0,	/* VSEN16 */
139792d376bSWei Song 	0xa4,	/* VSEN17 */
140792d376bSWei Song };
141792d376bSWei Song 
142792d376bSWei Song #define IN_LSB_REG(index, type) \
143792d376bSWei Song 	(((type) == 1) ? W83795_REG_IN_HL_LSB[(index)] \
144792d376bSWei Song 	: (W83795_REG_IN_HL_LSB[(index)] + 1))
145792d376bSWei Song 
146792d376bSWei Song #define IN_LSB_REG_NUM			10
147792d376bSWei Song 
148792d376bSWei Song #define IN_LSB_SHIFT			0
149792d376bSWei Song #define IN_LSB_IDX			1
150792d376bSWei Song static const u8 IN_LSB_SHIFT_IDX[][2] = {
151792d376bSWei Song 	/* High/Low LSB shift, LSB No. */
152792d376bSWei Song 	{0x00, 0x00},	/* VSEN1 */
153792d376bSWei Song 	{0x02, 0x00},	/* VSEN2 */
154792d376bSWei Song 	{0x04, 0x00},	/* VSEN3 */
155792d376bSWei Song 	{0x06, 0x00},	/* VSEN4 */
156792d376bSWei Song 	{0x00, 0x01},	/* VSEN5 */
157792d376bSWei Song 	{0x02, 0x01},	/* VSEN6 */
158792d376bSWei Song 	{0x04, 0x01},	/* VSEN7 */
159792d376bSWei Song 	{0x06, 0x01},	/* VSEN8 */
160792d376bSWei Song 	{0x00, 0x02},	/* VSEN9 */
161792d376bSWei Song 	{0x02, 0x02},	/* VSEN10 */
162792d376bSWei Song 	{0x04, 0x02},	/* VSEN11 */
163792d376bSWei Song 	{0x00, 0x03},	/* VTT */
164792d376bSWei Song 	{0x02, 0x03},	/* 3VDD */
165792d376bSWei Song 	{0x04, 0x03},	/* 3VSB	*/
166792d376bSWei Song 	{0x06, 0x03},	/* VBAT	*/
167792d376bSWei Song 	{0x06, 0x04},	/* VSEN12 */
168792d376bSWei Song 	{0x06, 0x05},	/* VSEN13 */
169792d376bSWei Song 	{0x06, 0x06},	/* VSEN14 */
170792d376bSWei Song 	{0x06, 0x07},	/* VSEN15 */
171792d376bSWei Song 	{0x06, 0x08},	/* VSEN16 */
172792d376bSWei Song 	{0x06, 0x09},	/* VSEN17 */
173792d376bSWei Song };
174792d376bSWei Song 
175792d376bSWei Song 
176792d376bSWei Song /* 3VDD, 3VSB, VBAT * 0.006 */
177792d376bSWei Song #define REST_VLT_BEGIN			12  /* the 13th volt to 15th */
178792d376bSWei Song #define REST_VLT_END			14  /* the 13th volt to 15th */
179792d376bSWei Song 
180792d376bSWei Song #define W83795_REG_FAN(index)		(0x2E + (index))
181792d376bSWei Song #define W83795_REG_FAN_MIN_HL(index)	(0xB6 + (index))
182792d376bSWei Song #define W83795_REG_FAN_MIN_LSB(index)	(0xC4 + (index) / 2)
183792d376bSWei Song #define W83795_REG_FAN_MIN_LSB_SHIFT(index) \
184792d376bSWei Song 	(((index) % 1) ? 4 : 0)
185792d376bSWei Song 
186792d376bSWei Song #define W83795_REG_VID_CTRL		0x6A
187792d376bSWei Song 
188792d376bSWei Song #define ALARM_BEEP_REG_NUM		6
189792d376bSWei Song #define W83795_REG_ALARM(index)		(0x41 + (index))
190792d376bSWei Song #define W83795_REG_BEEP(index)		(0x50 + (index))
191792d376bSWei Song 
192792d376bSWei Song #define W83795_REG_CLR_CHASSIS		0x4D
193792d376bSWei Song 
194792d376bSWei Song 
195792d376bSWei Song #define W83795_REG_TEMP_NUM		6
196792d376bSWei Song #define W83795_REG_FCMS1		0x201
197792d376bSWei Song #define W83795_REG_FCMS2		0x208
198792d376bSWei Song #define W83795_REG_TFMR(index)		(0x202 + (index))
199792d376bSWei Song #define W83795_REG_FOMC			0x20F
200792d376bSWei Song #define W83795_REG_FOPFP(index)		(0x218 + (index))
201792d376bSWei Song 
202792d376bSWei Song #define W83795_REG_TSS(index)		(0x209 + (index))
203792d376bSWei Song 
204792d376bSWei Song #define PWM_OUTPUT			0
205792d376bSWei Song #define PWM_START			1
206792d376bSWei Song #define PWM_NONSTOP			2
207792d376bSWei Song #define PWM_STOP_TIME			3
208792d376bSWei Song #define PWM_DIV				4
209792d376bSWei Song #define W83795_REG_PWM(index, nr) \
210792d376bSWei Song 	(((nr) == 0 ? 0x210 : \
211792d376bSWei Song 	  (nr) == 1 ? 0x220 : \
212792d376bSWei Song 	  (nr) == 2 ? 0x228 : \
213792d376bSWei Song 	  (nr) == 3 ? 0x230 : 0x218) + (index))
214792d376bSWei Song 
215792d376bSWei Song #define W83795_REG_FOPFP_DIV(index) \
216792d376bSWei Song 	(((index) < 8) ? ((index) + 1) : \
217792d376bSWei Song 	 ((index) == 8) ? 12 : \
218792d376bSWei Song 	 (16 << ((index) - 9)))
219792d376bSWei Song 
220792d376bSWei Song #define W83795_REG_FTSH(index)		(0x240 + (index) * 2)
221792d376bSWei Song #define W83795_REG_FTSL(index)		(0x241 + (index) * 2)
222792d376bSWei Song #define W83795_REG_TFTS			0x250
223792d376bSWei Song 
224792d376bSWei Song #define TEMP_PWM_TTTI			0
225792d376bSWei Song #define TEMP_PWM_CTFS			1
226792d376bSWei Song #define TEMP_PWM_HCT			2
227792d376bSWei Song #define TEMP_PWM_HOT			3
228792d376bSWei Song #define W83795_REG_TTTI(index)		(0x260 + (index))
229792d376bSWei Song #define W83795_REG_CTFS(index)		(0x268 + (index))
230792d376bSWei Song #define W83795_REG_HT(index)		(0x270 + (index))
231792d376bSWei Song 
232792d376bSWei Song #define SF4_TEMP			0
233792d376bSWei Song #define SF4_PWM				1
234792d376bSWei Song #define W83795_REG_SF4_TEMP(temp_num, index) \
235792d376bSWei Song 	(0x280 + 0x10 * (temp_num) + (index))
236792d376bSWei Song #define W83795_REG_SF4_PWM(temp_num, index) \
237792d376bSWei Song 	(0x288 + 0x10 * (temp_num) + (index))
238792d376bSWei Song 
239792d376bSWei Song #define W83795_REG_DTSC			0x301
240792d376bSWei Song #define W83795_REG_DTSE			0x302
241792d376bSWei Song #define W83795_REG_DTS(index)		(0x26 + (index))
242792d376bSWei Song 
243792d376bSWei Song #define DTS_CRIT			0
244792d376bSWei Song #define DTS_CRIT_HYST			1
245792d376bSWei Song #define DTS_WARN			2
246792d376bSWei Song #define DTS_WARN_HYST			3
247792d376bSWei Song #define W83795_REG_DTS_EXT(index)	(0xB2 + (index))
248792d376bSWei Song 
249792d376bSWei Song #define SETUP_PWM_DEFAULT		0
250792d376bSWei Song #define SETUP_PWM_UPTIME		1
251792d376bSWei Song #define SETUP_PWM_DOWNTIME		2
252792d376bSWei Song #define W83795_REG_SETUP_PWM(index)    (0x20C + (index))
253792d376bSWei Song 
254792d376bSWei Song static inline u16 in_from_reg(u8 index, u16 val)
255792d376bSWei Song {
256792d376bSWei Song 	if ((index >= REST_VLT_BEGIN) && (index <= REST_VLT_END))
257792d376bSWei Song 		return val * 6;
258792d376bSWei Song 	else
259792d376bSWei Song 		return val * 2;
260792d376bSWei Song }
261792d376bSWei Song 
262792d376bSWei Song static inline u16 in_to_reg(u8 index, u16 val)
263792d376bSWei Song {
264792d376bSWei Song 	if ((index >= REST_VLT_BEGIN) && (index <= REST_VLT_END))
265792d376bSWei Song 		return val / 6;
266792d376bSWei Song 	else
267792d376bSWei Song 		return val / 2;
268792d376bSWei Song }
269792d376bSWei Song 
270792d376bSWei Song static inline unsigned long fan_from_reg(u16 val)
271792d376bSWei Song {
272792d376bSWei Song 	if ((val >= 0xff0) || (val == 0))
273792d376bSWei Song 		return 0;
274792d376bSWei Song 	return 1350000UL / val;
275792d376bSWei Song }
276792d376bSWei Song 
277792d376bSWei Song static inline u16 fan_to_reg(long rpm)
278792d376bSWei Song {
279792d376bSWei Song 	if (rpm <= 0)
280792d376bSWei Song 		return 0x0fff;
281792d376bSWei Song 	return SENSORS_LIMIT((1350000 + (rpm >> 1)) / rpm, 1, 0xffe);
282792d376bSWei Song }
283792d376bSWei Song 
284792d376bSWei Song static inline unsigned long time_from_reg(u8 reg)
285792d376bSWei Song {
286792d376bSWei Song 	return reg * 100;
287792d376bSWei Song }
288792d376bSWei Song 
289792d376bSWei Song static inline u8 time_to_reg(unsigned long val)
290792d376bSWei Song {
291792d376bSWei Song 	return SENSORS_LIMIT((val + 50) / 100, 0, 0xff);
292792d376bSWei Song }
293792d376bSWei Song 
294792d376bSWei Song static inline long temp_from_reg(s8 reg)
295792d376bSWei Song {
296792d376bSWei Song 	return reg * 1000;
297792d376bSWei Song }
298792d376bSWei Song 
299792d376bSWei Song static inline s8 temp_to_reg(long val, s8 min, s8 max)
300792d376bSWei Song {
301792d376bSWei Song 	return SENSORS_LIMIT((val < 0 ? -val : val) / 1000, min, max);
302792d376bSWei Song }
303792d376bSWei Song 
304792d376bSWei Song 
305792d376bSWei Song enum chip_types {w83795g, w83795adg};
306792d376bSWei Song 
307792d376bSWei Song struct w83795_data {
308792d376bSWei Song 	struct device *hwmon_dev;
309792d376bSWei Song 	struct mutex update_lock;
310792d376bSWei Song 	unsigned long last_updated;	/* In jiffies */
311792d376bSWei Song 	enum chip_types chip_type;
312792d376bSWei Song 
313792d376bSWei Song 	u8 bank;
314792d376bSWei Song 
315792d376bSWei Song 	u32 has_in;		/* Enable monitor VIN or not */
316792d376bSWei Song 	u16 in[21][3];		/* Register value, read/high/low */
317792d376bSWei Song 	u8 in_lsb[10][3];	/* LSB Register value, high/low */
318792d376bSWei Song 	u8 has_gain;		/* has gain: in17-20 * 8 */
319792d376bSWei Song 
320792d376bSWei Song 	u16 has_fan;		/* Enable fan14-1 or not */
321792d376bSWei Song 	u16 fan[14];		/* Register value combine */
322792d376bSWei Song 	u16 fan_min[14];	/* Register value combine */
323792d376bSWei Song 
324792d376bSWei Song 	u8 has_temp;		/* Enable monitor temp6-1 or not */
325792d376bSWei Song 	u8 temp[6][5];		/* current, crit, crit_hyst, warn, warn_hyst */
326792d376bSWei Song 	u8 temp_read_vrlsb[6];
327792d376bSWei Song 	u8 temp_mode;		/* bit 0: TR mode, bit 1: TD mode */
328792d376bSWei Song 	u8 temp_src[3];		/* Register value */
329792d376bSWei Song 
330792d376bSWei Song 	u8 enable_dts;		/* Enable PECI and SB-TSI,
331792d376bSWei Song 				 * bit 0: =1 enable, =0 disable,
332792d376bSWei Song 				 * bit 1: =1 AMD SB-TSI, =0 Intel PECI */
333792d376bSWei Song 	u8 has_dts;		/* Enable monitor DTS temp */
334792d376bSWei Song 	u8 dts[8];		/* Register value */
335792d376bSWei Song 	u8 dts_read_vrlsb[8];	/* Register value */
336792d376bSWei Song 	u8 dts_ext[4];		/* Register value */
337792d376bSWei Song 
338792d376bSWei Song 	u8 has_pwm;		/* 795g supports 8 pwm, 795adg only supports 2,
339792d376bSWei Song 				 * no config register, only affected by chip
340792d376bSWei Song 				 * type */
341792d376bSWei Song 	u8 pwm[8][5];		/* Register value, output, start, non stop, stop
342792d376bSWei Song 				 * time, div */
343792d376bSWei Song 	u8 pwm_fcms[2];		/* Register value */
344792d376bSWei Song 	u8 pwm_tfmr[6];		/* Register value */
345792d376bSWei Song 	u8 pwm_fomc;		/* Register value */
346792d376bSWei Song 
347792d376bSWei Song 	u16 target_speed[8];	/* Register value, target speed for speed
348792d376bSWei Song 				 * cruise */
349792d376bSWei Song 	u8 tol_speed;		/* tolerance of target speed */
350792d376bSWei Song 	u8 pwm_temp[6][4];	/* TTTI, CTFS, HCT, HOT */
351792d376bSWei Song 	u8 sf4_reg[6][2][7];	/* 6 temp, temp/dcpwm, 7 registers */
352792d376bSWei Song 
353792d376bSWei Song 	u8 setup_pwm[3];	/* Register value */
354792d376bSWei Song 
355792d376bSWei Song 	u8 alarms[6];		/* Register value */
356792d376bSWei Song 	u8 beeps[6];		/* Register value */
357792d376bSWei Song 	u8 beep_enable;
358792d376bSWei Song 
359792d376bSWei Song 	char valid;
360792d376bSWei Song };
361792d376bSWei Song 
362792d376bSWei Song /*
363792d376bSWei Song  * Hardware access
364b2469f42SJean Delvare  * We assume that nobdody can change the bank outside the driver.
365792d376bSWei Song  */
366792d376bSWei Song 
367b2469f42SJean Delvare /* Must be called with data->update_lock held, except during initialization */
368b2469f42SJean Delvare static int w83795_set_bank(struct i2c_client *client, u8 bank)
369792d376bSWei Song {
370792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
371b2469f42SJean Delvare 	int err;
372792d376bSWei Song 
373b2469f42SJean Delvare 	/* If the same bank is already set, nothing to do */
374b2469f42SJean Delvare 	if ((data->bank & 0x07) == bank)
375b2469f42SJean Delvare 		return 0;
376b2469f42SJean Delvare 
377b2469f42SJean Delvare 	/* Change to new bank, preserve all other bits */
378b2469f42SJean Delvare 	bank |= data->bank & ~0x07;
379b2469f42SJean Delvare 	err = i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL, bank);
380b2469f42SJean Delvare 	if (err < 0) {
381792d376bSWei Song 		dev_err(&client->dev,
382b2469f42SJean Delvare 			"Failed to set bank to %d, err %d\n",
383b2469f42SJean Delvare 			(int)bank, err);
384b2469f42SJean Delvare 		return err;
385792d376bSWei Song 	}
386b2469f42SJean Delvare 	data->bank = bank;
387b2469f42SJean Delvare 
388b2469f42SJean Delvare 	return 0;
389792d376bSWei Song }
390b2469f42SJean Delvare 
391b2469f42SJean Delvare /* Must be called with data->update_lock held, except during initialization */
392b2469f42SJean Delvare static u8 w83795_read(struct i2c_client *client, u16 reg)
393b2469f42SJean Delvare {
394b2469f42SJean Delvare 	int err;
395b2469f42SJean Delvare 
396b2469f42SJean Delvare 	err = w83795_set_bank(client, reg >> 8);
397b2469f42SJean Delvare 	if (err < 0)
398b2469f42SJean Delvare 		return 0x00;	/* Arbitrary */
399b2469f42SJean Delvare 
400b2469f42SJean Delvare 	err = i2c_smbus_read_byte_data(client, reg & 0xff);
401b2469f42SJean Delvare 	if (err < 0) {
402b2469f42SJean Delvare 		dev_err(&client->dev,
403b2469f42SJean Delvare 			"Failed to read from register 0x%03x, err %d\n",
404b2469f42SJean Delvare 			(int)reg, err);
405b2469f42SJean Delvare 		return 0x00;	/* Arbitrary */
406b2469f42SJean Delvare 	}
407b2469f42SJean Delvare 	return err;
408792d376bSWei Song }
409792d376bSWei Song 
410792d376bSWei Song /* Must be called with data->update_lock held, except during initialization */
411792d376bSWei Song static int w83795_write(struct i2c_client *client, u16 reg, u8 value)
412792d376bSWei Song {
413b2469f42SJean Delvare 	int err;
414792d376bSWei Song 
415b2469f42SJean Delvare 	err = w83795_set_bank(client, reg >> 8);
416b2469f42SJean Delvare 	if (err < 0)
417b2469f42SJean Delvare 		return err;
418b2469f42SJean Delvare 
419b2469f42SJean Delvare 	err = i2c_smbus_write_byte_data(client, reg & 0xff, value);
420b2469f42SJean Delvare 	if (err < 0)
421792d376bSWei Song 		dev_err(&client->dev,
422b2469f42SJean Delvare 			"Failed to write to register 0x%03x, err %d\n",
423b2469f42SJean Delvare 			(int)reg, err);
424b2469f42SJean Delvare 	return err;
425792d376bSWei Song }
426792d376bSWei Song 
427792d376bSWei Song static struct w83795_data *w83795_update_device(struct device *dev)
428792d376bSWei Song {
429792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
430792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
431792d376bSWei Song 	u16 tmp;
432792d376bSWei Song 	int i;
433792d376bSWei Song 
434792d376bSWei Song 	mutex_lock(&data->update_lock);
435792d376bSWei Song 
436792d376bSWei Song 	if (!(time_after(jiffies, data->last_updated + HZ * 2)
437792d376bSWei Song 	      || !data->valid))
438792d376bSWei Song 		goto END;
439792d376bSWei Song 
440792d376bSWei Song 	/* Update the voltages value */
441792d376bSWei Song 	for (i = 0; i < ARRAY_SIZE(data->in); i++) {
442792d376bSWei Song 		if (!(data->has_in & (1 << i)))
443792d376bSWei Song 			continue;
444792d376bSWei Song 		tmp = w83795_read(client, W83795_REG_IN[i][IN_READ]) << 2;
445792d376bSWei Song 		tmp |= (w83795_read(client, W83795_REG_VRLSB)
446792d376bSWei Song 			>> VRLSB_SHIFT) & 0x03;
447792d376bSWei Song 		data->in[i][IN_READ] = tmp;
448792d376bSWei Song 	}
449792d376bSWei Song 
450792d376bSWei Song 	/* Update fan */
451792d376bSWei Song 	for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
452792d376bSWei Song 		if (!(data->has_fan & (1 << i)))
453792d376bSWei Song 			continue;
454792d376bSWei Song 		data->fan[i] = w83795_read(client, W83795_REG_FAN(i)) << 4;
455792d376bSWei Song 		data->fan[i] |=
456792d376bSWei Song 		  (w83795_read(client, W83795_REG_VRLSB >> 4)) & 0x0F;
457792d376bSWei Song 	}
458792d376bSWei Song 
459792d376bSWei Song 	/* Update temperature */
460792d376bSWei Song 	for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
461792d376bSWei Song 		/* even stop monitor, register still keep value, just read out
462792d376bSWei Song 		 * it */
463792d376bSWei Song 		if (!(data->has_temp & (1 << i))) {
464792d376bSWei Song 			data->temp[i][TEMP_READ] = 0;
465792d376bSWei Song 			data->temp_read_vrlsb[i] = 0;
466792d376bSWei Song 			continue;
467792d376bSWei Song 		}
468792d376bSWei Song 		data->temp[i][TEMP_READ] =
469792d376bSWei Song 			w83795_read(client, W83795_REG_TEMP[i][TEMP_READ]);
470792d376bSWei Song 		data->temp_read_vrlsb[i] =
471792d376bSWei Song 			w83795_read(client, W83795_REG_VRLSB);
472792d376bSWei Song 	}
473792d376bSWei Song 
474792d376bSWei Song 	/* Update dts temperature */
475792d376bSWei Song 	if (data->enable_dts != 0) {
476792d376bSWei Song 		for (i = 0; i < ARRAY_SIZE(data->dts); i++) {
477792d376bSWei Song 			if (!(data->has_dts & (1 << i)))
478792d376bSWei Song 				continue;
479792d376bSWei Song 			data->dts[i] =
480792d376bSWei Song 				w83795_read(client, W83795_REG_DTS(i));
481792d376bSWei Song 			data->dts_read_vrlsb[i] =
482792d376bSWei Song 				w83795_read(client, W83795_REG_VRLSB);
483792d376bSWei Song 		}
484792d376bSWei Song 	}
485792d376bSWei Song 
486792d376bSWei Song 	/* Update pwm output */
487792d376bSWei Song 	for (i = 0; i < data->has_pwm; i++) {
488792d376bSWei Song 		data->pwm[i][PWM_OUTPUT] =
489792d376bSWei Song 		    w83795_read(client, W83795_REG_PWM(i, PWM_OUTPUT));
490792d376bSWei Song 	}
491792d376bSWei Song 
492792d376bSWei Song 	/* update alarm */
493792d376bSWei Song 	for (i = 0; i < ALARM_BEEP_REG_NUM; i++)
494792d376bSWei Song 		data->alarms[i] = w83795_read(client, W83795_REG_ALARM(i));
495792d376bSWei Song 
496792d376bSWei Song 	data->last_updated = jiffies;
497792d376bSWei Song 	data->valid = 1;
498792d376bSWei Song 
499792d376bSWei Song END:
500792d376bSWei Song 	mutex_unlock(&data->update_lock);
501792d376bSWei Song 	return data;
502792d376bSWei Song }
503792d376bSWei Song 
504792d376bSWei Song /*
505792d376bSWei Song  * Sysfs attributes
506792d376bSWei Song  */
507792d376bSWei Song 
508792d376bSWei Song #define ALARM_STATUS      0
509792d376bSWei Song #define BEEP_ENABLE       1
510792d376bSWei Song static ssize_t
511792d376bSWei Song show_alarm_beep(struct device *dev, struct device_attribute *attr, char *buf)
512792d376bSWei Song {
513792d376bSWei Song 	struct w83795_data *data = w83795_update_device(dev);
514792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
515792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
516792d376bSWei Song 	int nr = sensor_attr->nr;
517792d376bSWei Song 	int index = sensor_attr->index >> 3;
518792d376bSWei Song 	int bit = sensor_attr->index & 0x07;
519792d376bSWei Song 	u8 val;
520792d376bSWei Song 
521792d376bSWei Song 	if (ALARM_STATUS == nr) {
522792d376bSWei Song 		val = (data->alarms[index] >> (bit)) & 1;
523792d376bSWei Song 	} else {		/* BEEP_ENABLE */
524792d376bSWei Song 		val = (data->beeps[index] >> (bit)) & 1;
525792d376bSWei Song 	}
526792d376bSWei Song 
527792d376bSWei Song 	return sprintf(buf, "%u\n", val);
528792d376bSWei Song }
529792d376bSWei Song 
530792d376bSWei Song static ssize_t
531792d376bSWei Song store_beep(struct device *dev, struct device_attribute *attr,
532792d376bSWei Song 	   const char *buf, size_t count)
533792d376bSWei Song {
534792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
535792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
536792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
537792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
538792d376bSWei Song 	int index = sensor_attr->index >> 3;
539792d376bSWei Song 	int shift = sensor_attr->index & 0x07;
540792d376bSWei Song 	u8 beep_bit = 1 << shift;
541792d376bSWei Song 	unsigned long val;
542792d376bSWei Song 
543792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
544792d376bSWei Song 		return -EINVAL;
545792d376bSWei Song 	if (val != 0 && val != 1)
546792d376bSWei Song 		return -EINVAL;
547792d376bSWei Song 
548792d376bSWei Song 	mutex_lock(&data->update_lock);
549792d376bSWei Song 	data->beeps[index] = w83795_read(client, W83795_REG_BEEP(index));
550792d376bSWei Song 	data->beeps[index] &= ~beep_bit;
551792d376bSWei Song 	data->beeps[index] |= val << shift;
552792d376bSWei Song 	w83795_write(client, W83795_REG_BEEP(index), data->beeps[index]);
553792d376bSWei Song 	mutex_unlock(&data->update_lock);
554792d376bSWei Song 
555792d376bSWei Song 	return count;
556792d376bSWei Song }
557792d376bSWei Song 
558792d376bSWei Song static ssize_t
559792d376bSWei Song show_beep_enable(struct device *dev, struct device_attribute *attr, char *buf)
560792d376bSWei Song {
561792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
562792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
563792d376bSWei Song 	return sprintf(buf, "%u\n", data->beep_enable);
564792d376bSWei Song }
565792d376bSWei Song 
566792d376bSWei Song static ssize_t
567792d376bSWei Song store_beep_enable(struct device *dev, struct device_attribute *attr,
568792d376bSWei Song 		  const char *buf, size_t count)
569792d376bSWei Song {
570792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
571792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
572792d376bSWei Song 	unsigned long val;
573792d376bSWei Song 	u8 tmp;
574792d376bSWei Song 
575792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
576792d376bSWei Song 		return -EINVAL;
577792d376bSWei Song 	if (val != 0 && val != 1)
578792d376bSWei Song 		return -EINVAL;
579792d376bSWei Song 
580792d376bSWei Song 	mutex_lock(&data->update_lock);
581792d376bSWei Song 	data->beep_enable = val;
582792d376bSWei Song 	tmp = w83795_read(client, W83795_REG_BEEP(5));
583792d376bSWei Song 	tmp &= 0x7f;
584792d376bSWei Song 	tmp |= val << 7;
585792d376bSWei Song 	w83795_write(client, W83795_REG_BEEP(5), tmp);
586792d376bSWei Song 	mutex_unlock(&data->update_lock);
587792d376bSWei Song 
588792d376bSWei Song 	return count;
589792d376bSWei Song }
590792d376bSWei Song 
591792d376bSWei Song /* Write any value to clear chassis alarm */
592792d376bSWei Song static ssize_t
593792d376bSWei Song store_chassis_clear(struct device *dev,
594792d376bSWei Song 		    struct device_attribute *attr, const char *buf,
595792d376bSWei Song 		    size_t count)
596792d376bSWei Song {
597792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
598792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
599792d376bSWei Song 	u8 val;
600792d376bSWei Song 
601792d376bSWei Song 	mutex_lock(&data->update_lock);
602792d376bSWei Song 	val = w83795_read(client, W83795_REG_CLR_CHASSIS);
603792d376bSWei Song 	val |= 0x80;
604792d376bSWei Song 	w83795_write(client, W83795_REG_CLR_CHASSIS, val);
605792d376bSWei Song 	mutex_unlock(&data->update_lock);
606792d376bSWei Song 	return count;
607792d376bSWei Song }
608792d376bSWei Song 
609792d376bSWei Song #define FAN_INPUT     0
610792d376bSWei Song #define FAN_MIN       1
611792d376bSWei Song static ssize_t
612792d376bSWei Song show_fan(struct device *dev, struct device_attribute *attr, char *buf)
613792d376bSWei Song {
614792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
615792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
616792d376bSWei Song 	int nr = sensor_attr->nr;
617792d376bSWei Song 	int index = sensor_attr->index;
618792d376bSWei Song 	struct w83795_data *data = w83795_update_device(dev);
619792d376bSWei Song 	u16 val;
620792d376bSWei Song 
621792d376bSWei Song 	if (FAN_INPUT == nr)
622792d376bSWei Song 		val = data->fan[index] & 0x0fff;
623792d376bSWei Song 	else
624792d376bSWei Song 		val = data->fan_min[index] & 0x0fff;
625792d376bSWei Song 
626792d376bSWei Song 	return sprintf(buf, "%lu\n", fan_from_reg(val));
627792d376bSWei Song }
628792d376bSWei Song 
629792d376bSWei Song static ssize_t
630792d376bSWei Song store_fan_min(struct device *dev, struct device_attribute *attr,
631792d376bSWei Song 	      const char *buf, size_t count)
632792d376bSWei Song {
633792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
634792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
635792d376bSWei Song 	int index = sensor_attr->index;
636792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
637792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
638792d376bSWei Song 	unsigned long val;
639792d376bSWei Song 
640792d376bSWei Song 	if (strict_strtoul(buf, 10, &val))
641792d376bSWei Song 		return -EINVAL;
642792d376bSWei Song 	val = fan_to_reg(val);
643792d376bSWei Song 
644792d376bSWei Song 	mutex_lock(&data->update_lock);
645792d376bSWei Song 	data->fan_min[index] = val;
646792d376bSWei Song 	w83795_write(client, W83795_REG_FAN_MIN_HL(index), (val >> 4) & 0xff);
647792d376bSWei Song 	val &= 0x0f;
648792d376bSWei Song 	if (index % 1) {
649792d376bSWei Song 		val <<= 4;
650792d376bSWei Song 		val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
651792d376bSWei Song 		       & 0x0f;
652792d376bSWei Song 	} else {
653792d376bSWei Song 		val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
654792d376bSWei Song 		       & 0xf0;
655792d376bSWei Song 	}
656792d376bSWei Song 	w83795_write(client, W83795_REG_FAN_MIN_LSB(index), val & 0xff);
657792d376bSWei Song 	mutex_unlock(&data->update_lock);
658792d376bSWei Song 
659792d376bSWei Song 	return count;
660792d376bSWei Song }
661792d376bSWei Song 
662792d376bSWei Song static ssize_t
663792d376bSWei Song show_pwm(struct device *dev, struct device_attribute *attr, char *buf)
664792d376bSWei Song {
665792d376bSWei Song 	struct w83795_data *data = w83795_update_device(dev);
666792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
667792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
668792d376bSWei Song 	int nr = sensor_attr->nr;
669792d376bSWei Song 	int index = sensor_attr->index;
670792d376bSWei Song 	u16 val;
671792d376bSWei Song 
672792d376bSWei Song 	switch (nr) {
673792d376bSWei Song 	case PWM_STOP_TIME:
674792d376bSWei Song 		val = time_from_reg(data->pwm[index][nr]);
675792d376bSWei Song 		break;
676792d376bSWei Song 	case PWM_DIV:
677792d376bSWei Song 		val = W83795_REG_FOPFP_DIV(data->pwm[index][nr] & 0x0f);
678792d376bSWei Song 		break;
679792d376bSWei Song 	default:
680792d376bSWei Song 		val = data->pwm[index][nr];
681792d376bSWei Song 		break;
682792d376bSWei Song 	}
683792d376bSWei Song 
684792d376bSWei Song 	return sprintf(buf, "%u\n", val);
685792d376bSWei Song }
686792d376bSWei Song 
687792d376bSWei Song static ssize_t
688792d376bSWei Song store_pwm(struct device *dev, struct device_attribute *attr,
689792d376bSWei Song 	  const char *buf, size_t count)
690792d376bSWei Song {
691792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
692792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
693792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
694792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
695792d376bSWei Song 	int nr = sensor_attr->nr;
696792d376bSWei Song 	int index = sensor_attr->index;
697792d376bSWei Song 	unsigned long val;
698792d376bSWei Song 	int i;
699792d376bSWei Song 
700792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
701792d376bSWei Song 		return -EINVAL;
702792d376bSWei Song 
703792d376bSWei Song 	mutex_lock(&data->update_lock);
704792d376bSWei Song 	switch (nr) {
705792d376bSWei Song 	case PWM_STOP_TIME:
706792d376bSWei Song 		val = time_to_reg(val);
707792d376bSWei Song 		break;
708792d376bSWei Song 	case PWM_DIV:
709792d376bSWei Song 		for (i = 0; i < 16; i++) {
710792d376bSWei Song 			if (W83795_REG_FOPFP_DIV(i) == val) {
711792d376bSWei Song 				val = i;
712792d376bSWei Song 				break;
713792d376bSWei Song 			}
714792d376bSWei Song 		}
715792d376bSWei Song 		if (i >= 16)
716792d376bSWei Song 			goto err_end;
717792d376bSWei Song 		val |= w83795_read(client, W83795_REG_PWM(index, nr)) & 0x80;
718792d376bSWei Song 		break;
719792d376bSWei Song 	default:
720792d376bSWei Song 		val = SENSORS_LIMIT(val, 0, 0xff);
721792d376bSWei Song 		break;
722792d376bSWei Song 	}
723792d376bSWei Song 	w83795_write(client, W83795_REG_PWM(index, nr), val);
724792d376bSWei Song 	data->pwm[index][nr] = val & 0xff;
725792d376bSWei Song 	mutex_unlock(&data->update_lock);
726792d376bSWei Song 	return count;
727792d376bSWei Song err_end:
728792d376bSWei Song 	mutex_unlock(&data->update_lock);
729792d376bSWei Song 	return -EINVAL;
730792d376bSWei Song }
731792d376bSWei Song 
732792d376bSWei Song static ssize_t
733792d376bSWei Song show_pwm_enable(struct device *dev, struct device_attribute *attr, char *buf)
734792d376bSWei Song {
735792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
736792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
737792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
738792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
739792d376bSWei Song 	int index = sensor_attr->index;
740792d376bSWei Song 	u8 tmp;
741792d376bSWei Song 
742792d376bSWei Song 	if (1 == (data->pwm_fcms[0] & (1 << index))) {
743792d376bSWei Song 		tmp = 2;
744792d376bSWei Song 		goto out;
745792d376bSWei Song 	}
746792d376bSWei Song 	for (tmp = 0; tmp < 6; tmp++) {
747792d376bSWei Song 		if (data->pwm_tfmr[tmp] & (1 << index)) {
748792d376bSWei Song 			tmp = 3;
749792d376bSWei Song 			goto out;
750792d376bSWei Song 		}
751792d376bSWei Song 	}
752792d376bSWei Song 	if (data->pwm_fomc & (1 << index))
753792d376bSWei Song 		tmp = 0;
754792d376bSWei Song 	else
755792d376bSWei Song 		tmp = 1;
756792d376bSWei Song 
757792d376bSWei Song out:
758792d376bSWei Song 	return sprintf(buf, "%u\n", tmp);
759792d376bSWei Song }
760792d376bSWei Song 
761792d376bSWei Song static ssize_t
762792d376bSWei Song store_pwm_enable(struct device *dev, struct device_attribute *attr,
763792d376bSWei Song 	  const char *buf, size_t count)
764792d376bSWei Song {
765792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
766792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
767792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
768792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
769792d376bSWei Song 	int index = sensor_attr->index;
770792d376bSWei Song 	unsigned long val;
771792d376bSWei Song 	int i;
772792d376bSWei Song 
773792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
774792d376bSWei Song 		return -EINVAL;
775792d376bSWei Song 	if (val > 2)
776792d376bSWei Song 		return -EINVAL;
777792d376bSWei Song 
778792d376bSWei Song 	mutex_lock(&data->update_lock);
779792d376bSWei Song 	switch (val) {
780792d376bSWei Song 	case 0:
781792d376bSWei Song 	case 1:
782792d376bSWei Song 		data->pwm_fcms[0] &= ~(1 << index);
783792d376bSWei Song 		w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
784792d376bSWei Song 		for (i = 0; i < 6; i++) {
785792d376bSWei Song 			data->pwm_tfmr[i] &= ~(1 << index);
786792d376bSWei Song 			w83795_write(client, W83795_REG_TFMR(i),
787792d376bSWei Song 				data->pwm_tfmr[i]);
788792d376bSWei Song 		}
789792d376bSWei Song 		data->pwm_fomc |= 1 << index;
790792d376bSWei Song 		data->pwm_fomc ^= val << index;
791792d376bSWei Song 		w83795_write(client, W83795_REG_FOMC, data->pwm_fomc);
792792d376bSWei Song 		break;
793792d376bSWei Song 	case 2:
794792d376bSWei Song 		data->pwm_fcms[0] |= (1 << index);
795792d376bSWei Song 		w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
796792d376bSWei Song 		break;
797792d376bSWei Song 	}
798792d376bSWei Song 	mutex_unlock(&data->update_lock);
799792d376bSWei Song 	return count;
800792d376bSWei Song }
801792d376bSWei Song 
802792d376bSWei Song static ssize_t
803792d376bSWei Song show_temp_src(struct device *dev, struct device_attribute *attr, char *buf)
804792d376bSWei Song {
805792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
806792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
807792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
808792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
809792d376bSWei Song 	int index = sensor_attr->index;
810792d376bSWei Song 	u8 val = index / 2;
811792d376bSWei Song 	u8 tmp = data->temp_src[val];
812792d376bSWei Song 
813792d376bSWei Song 	if (index % 1)
814792d376bSWei Song 		val = 4;
815792d376bSWei Song 	else
816792d376bSWei Song 		val = 0;
817792d376bSWei Song 	tmp >>= val;
818792d376bSWei Song 	tmp &= 0x0f;
819792d376bSWei Song 
820792d376bSWei Song 	return sprintf(buf, "%u\n", tmp);
821792d376bSWei Song }
822792d376bSWei Song 
823792d376bSWei Song static ssize_t
824792d376bSWei Song store_temp_src(struct device *dev, struct device_attribute *attr,
825792d376bSWei Song 	  const char *buf, size_t count)
826792d376bSWei Song {
827792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
828792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
829792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
830792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
831792d376bSWei Song 	int index = sensor_attr->index;
832792d376bSWei Song 	unsigned long tmp;
833792d376bSWei Song 	u8 val = index / 2;
834792d376bSWei Song 
835792d376bSWei Song 	if (strict_strtoul(buf, 10, &tmp) < 0)
836792d376bSWei Song 		return -EINVAL;
837792d376bSWei Song 	tmp = SENSORS_LIMIT(tmp, 0, 15);
838792d376bSWei Song 
839792d376bSWei Song 	mutex_lock(&data->update_lock);
840792d376bSWei Song 	if (index % 1) {
841792d376bSWei Song 		tmp <<= 4;
842792d376bSWei Song 		data->temp_src[val] &= 0x0f;
843792d376bSWei Song 	} else {
844792d376bSWei Song 		data->temp_src[val] &= 0xf0;
845792d376bSWei Song 	}
846792d376bSWei Song 	data->temp_src[val] |= tmp;
847792d376bSWei Song 	w83795_write(client, W83795_REG_TSS(val), data->temp_src[val]);
848792d376bSWei Song 	mutex_unlock(&data->update_lock);
849792d376bSWei Song 
850792d376bSWei Song 	return count;
851792d376bSWei Song }
852792d376bSWei Song 
853792d376bSWei Song #define TEMP_PWM_ENABLE   0
854792d376bSWei Song #define TEMP_PWM_FAN_MAP  1
855792d376bSWei Song static ssize_t
856792d376bSWei Song show_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
857792d376bSWei Song 		     char *buf)
858792d376bSWei Song {
859792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
860792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
861792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
862792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
863792d376bSWei Song 	int nr = sensor_attr->nr;
864792d376bSWei Song 	int index = sensor_attr->index;
865792d376bSWei Song 	u8 tmp = 0xff;
866792d376bSWei Song 
867792d376bSWei Song 	switch (nr) {
868792d376bSWei Song 	case TEMP_PWM_ENABLE:
869792d376bSWei Song 		tmp = (data->pwm_fcms[1] >> index) & 1;
870792d376bSWei Song 		if (tmp)
871792d376bSWei Song 			tmp = 4;
872792d376bSWei Song 		else
873792d376bSWei Song 			tmp = 3;
874792d376bSWei Song 		break;
875792d376bSWei Song 	case TEMP_PWM_FAN_MAP:
876792d376bSWei Song 		tmp = data->pwm_tfmr[index];
877792d376bSWei Song 		break;
878792d376bSWei Song 	}
879792d376bSWei Song 
880792d376bSWei Song 	return sprintf(buf, "%u\n", tmp);
881792d376bSWei Song }
882792d376bSWei Song 
883792d376bSWei Song static ssize_t
884792d376bSWei Song store_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
885792d376bSWei Song 	  const char *buf, size_t count)
886792d376bSWei Song {
887792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
888792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
889792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
890792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
891792d376bSWei Song 	int nr = sensor_attr->nr;
892792d376bSWei Song 	int index = sensor_attr->index;
893792d376bSWei Song 	unsigned long tmp;
894792d376bSWei Song 
895792d376bSWei Song 	if (strict_strtoul(buf, 10, &tmp) < 0)
896792d376bSWei Song 		return -EINVAL;
897792d376bSWei Song 
898792d376bSWei Song 	switch (nr) {
899792d376bSWei Song 	case TEMP_PWM_ENABLE:
900792d376bSWei Song 		if ((tmp != 3) && (tmp != 4))
901792d376bSWei Song 			return -EINVAL;
902792d376bSWei Song 		tmp -= 3;
903792d376bSWei Song 		mutex_lock(&data->update_lock);
904792d376bSWei Song 		data->pwm_fcms[1] &= ~(1 << index);
905792d376bSWei Song 		data->pwm_fcms[1] |= tmp << index;
906792d376bSWei Song 		w83795_write(client, W83795_REG_FCMS2, data->pwm_fcms[1]);
907792d376bSWei Song 		mutex_unlock(&data->update_lock);
908792d376bSWei Song 		break;
909792d376bSWei Song 	case TEMP_PWM_FAN_MAP:
910792d376bSWei Song 		mutex_lock(&data->update_lock);
911792d376bSWei Song 		tmp = SENSORS_LIMIT(tmp, 0, 0xff);
912792d376bSWei Song 		w83795_write(client, W83795_REG_TFMR(index), tmp);
913792d376bSWei Song 		data->pwm_tfmr[index] = tmp;
914792d376bSWei Song 		mutex_unlock(&data->update_lock);
915792d376bSWei Song 		break;
916792d376bSWei Song 	}
917792d376bSWei Song 	return count;
918792d376bSWei Song }
919792d376bSWei Song 
920792d376bSWei Song #define FANIN_TARGET   0
921792d376bSWei Song #define FANIN_TOL      1
922792d376bSWei Song static ssize_t
923792d376bSWei Song show_fanin(struct device *dev, struct device_attribute *attr, char *buf)
924792d376bSWei Song {
925792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
926792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
927792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
928792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
929792d376bSWei Song 	int nr = sensor_attr->nr;
930792d376bSWei Song 	int index = sensor_attr->index;
931792d376bSWei Song 	u16 tmp = 0;
932792d376bSWei Song 
933792d376bSWei Song 	switch (nr) {
934792d376bSWei Song 	case FANIN_TARGET:
935792d376bSWei Song 		tmp = fan_from_reg(data->target_speed[index]);
936792d376bSWei Song 		break;
937792d376bSWei Song 	case FANIN_TOL:
938792d376bSWei Song 		tmp = data->tol_speed;
939792d376bSWei Song 		break;
940792d376bSWei Song 	}
941792d376bSWei Song 
942792d376bSWei Song 	return sprintf(buf, "%u\n", tmp);
943792d376bSWei Song }
944792d376bSWei Song 
945792d376bSWei Song static ssize_t
946792d376bSWei Song store_fanin(struct device *dev, struct device_attribute *attr,
947792d376bSWei Song 	  const char *buf, size_t count)
948792d376bSWei Song {
949792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
950792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
951792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
952792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
953792d376bSWei Song 	int nr = sensor_attr->nr;
954792d376bSWei Song 	int index = sensor_attr->index;
955792d376bSWei Song 	unsigned long val;
956792d376bSWei Song 
957792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
958792d376bSWei Song 		return -EINVAL;
959792d376bSWei Song 
960792d376bSWei Song 	mutex_lock(&data->update_lock);
961792d376bSWei Song 	switch (nr) {
962792d376bSWei Song 	case FANIN_TARGET:
963792d376bSWei Song 		val = fan_to_reg(SENSORS_LIMIT(val, 0, 0xfff));
964792d376bSWei Song 		w83795_write(client, W83795_REG_FTSH(index), (val >> 4) & 0xff);
965792d376bSWei Song 		w83795_write(client, W83795_REG_FTSL(index), (val << 4) & 0xf0);
966792d376bSWei Song 		data->target_speed[index] = val;
967792d376bSWei Song 		break;
968792d376bSWei Song 	case FANIN_TOL:
969792d376bSWei Song 		val = SENSORS_LIMIT(val, 0, 0x3f);
970792d376bSWei Song 		w83795_write(client, W83795_REG_TFTS, val);
971792d376bSWei Song 		data->tol_speed = val;
972792d376bSWei Song 		break;
973792d376bSWei Song 	}
974792d376bSWei Song 	mutex_unlock(&data->update_lock);
975792d376bSWei Song 
976792d376bSWei Song 	return count;
977792d376bSWei Song }
978792d376bSWei Song 
979792d376bSWei Song 
980792d376bSWei Song static ssize_t
981792d376bSWei Song show_temp_pwm(struct device *dev, struct device_attribute *attr, char *buf)
982792d376bSWei Song {
983792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
984792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
985792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
986792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
987792d376bSWei Song 	int nr = sensor_attr->nr;
988792d376bSWei Song 	int index = sensor_attr->index;
989792d376bSWei Song 	long tmp = temp_from_reg(data->pwm_temp[index][nr]);
990792d376bSWei Song 
991792d376bSWei Song 	return sprintf(buf, "%ld\n", tmp);
992792d376bSWei Song }
993792d376bSWei Song 
994792d376bSWei Song static ssize_t
995792d376bSWei Song store_temp_pwm(struct device *dev, struct device_attribute *attr,
996792d376bSWei Song 	  const char *buf, size_t count)
997792d376bSWei Song {
998792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
999792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1000792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1001792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1002792d376bSWei Song 	int nr = sensor_attr->nr;
1003792d376bSWei Song 	int index = sensor_attr->index;
1004792d376bSWei Song 	unsigned long val;
1005792d376bSWei Song 	u8 tmp;
1006792d376bSWei Song 
1007792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
1008792d376bSWei Song 		return -EINVAL;
1009792d376bSWei Song 	val /= 1000;
1010792d376bSWei Song 
1011792d376bSWei Song 	mutex_lock(&data->update_lock);
1012792d376bSWei Song 	switch (nr) {
1013792d376bSWei Song 	case TEMP_PWM_TTTI:
1014792d376bSWei Song 		val = SENSORS_LIMIT(val, 0, 0x7f);
1015792d376bSWei Song 		w83795_write(client, W83795_REG_TTTI(index), val);
1016792d376bSWei Song 		break;
1017792d376bSWei Song 	case TEMP_PWM_CTFS:
1018792d376bSWei Song 		val = SENSORS_LIMIT(val, 0, 0x7f);
1019792d376bSWei Song 		w83795_write(client, W83795_REG_CTFS(index), val);
1020792d376bSWei Song 		break;
1021792d376bSWei Song 	case TEMP_PWM_HCT:
1022792d376bSWei Song 		val = SENSORS_LIMIT(val, 0, 0x0f);
1023792d376bSWei Song 		tmp = w83795_read(client, W83795_REG_HT(index));
1024792d376bSWei Song 		tmp &= 0x0f;
1025792d376bSWei Song 		tmp |= (val << 4) & 0xf0;
1026792d376bSWei Song 		w83795_write(client, W83795_REG_HT(index), tmp);
1027792d376bSWei Song 		break;
1028792d376bSWei Song 	case TEMP_PWM_HOT:
1029792d376bSWei Song 		val = SENSORS_LIMIT(val, 0, 0x0f);
1030792d376bSWei Song 		tmp = w83795_read(client, W83795_REG_HT(index));
1031792d376bSWei Song 		tmp &= 0xf0;
1032792d376bSWei Song 		tmp |= val & 0x0f;
1033792d376bSWei Song 		w83795_write(client, W83795_REG_HT(index), tmp);
1034792d376bSWei Song 		break;
1035792d376bSWei Song 	}
1036792d376bSWei Song 	data->pwm_temp[index][nr] = val;
1037792d376bSWei Song 	mutex_unlock(&data->update_lock);
1038792d376bSWei Song 
1039792d376bSWei Song 	return count;
1040792d376bSWei Song }
1041792d376bSWei Song 
1042792d376bSWei Song static ssize_t
1043792d376bSWei Song show_sf4_pwm(struct device *dev, struct device_attribute *attr, char *buf)
1044792d376bSWei Song {
1045792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1046792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1047792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1048792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1049792d376bSWei Song 	int nr = sensor_attr->nr;
1050792d376bSWei Song 	int index = sensor_attr->index;
1051792d376bSWei Song 
1052792d376bSWei Song 	return sprintf(buf, "%u\n", data->sf4_reg[index][SF4_PWM][nr]);
1053792d376bSWei Song }
1054792d376bSWei Song 
1055792d376bSWei Song static ssize_t
1056792d376bSWei Song store_sf4_pwm(struct device *dev, struct device_attribute *attr,
1057792d376bSWei Song 	  const char *buf, size_t count)
1058792d376bSWei Song {
1059792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1060792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1061792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1062792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1063792d376bSWei Song 	int nr = sensor_attr->nr;
1064792d376bSWei Song 	int index = sensor_attr->index;
1065792d376bSWei Song 	unsigned long val;
1066792d376bSWei Song 
1067792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
1068792d376bSWei Song 		return -EINVAL;
1069792d376bSWei Song 
1070792d376bSWei Song 	mutex_lock(&data->update_lock);
1071792d376bSWei Song 	w83795_write(client, W83795_REG_SF4_PWM(index, nr), val);
1072792d376bSWei Song 	data->sf4_reg[index][SF4_PWM][nr] = val;
1073792d376bSWei Song 	mutex_unlock(&data->update_lock);
1074792d376bSWei Song 
1075792d376bSWei Song 	return count;
1076792d376bSWei Song }
1077792d376bSWei Song 
1078792d376bSWei Song static ssize_t
1079792d376bSWei Song show_sf4_temp(struct device *dev, struct device_attribute *attr, char *buf)
1080792d376bSWei Song {
1081792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1082792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1083792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1084792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1085792d376bSWei Song 	int nr = sensor_attr->nr;
1086792d376bSWei Song 	int index = sensor_attr->index;
1087792d376bSWei Song 
1088792d376bSWei Song 	return sprintf(buf, "%u\n",
1089792d376bSWei Song 		(data->sf4_reg[index][SF4_TEMP][nr]) * 1000);
1090792d376bSWei Song }
1091792d376bSWei Song 
1092792d376bSWei Song static ssize_t
1093792d376bSWei Song store_sf4_temp(struct device *dev, struct device_attribute *attr,
1094792d376bSWei Song 	  const char *buf, size_t count)
1095792d376bSWei Song {
1096792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1097792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1098792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1099792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1100792d376bSWei Song 	int nr = sensor_attr->nr;
1101792d376bSWei Song 	int index = sensor_attr->index;
1102792d376bSWei Song 	unsigned long val;
1103792d376bSWei Song 
1104792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
1105792d376bSWei Song 		return -EINVAL;
1106792d376bSWei Song 	val /= 1000;
1107792d376bSWei Song 
1108792d376bSWei Song 	mutex_lock(&data->update_lock);
1109792d376bSWei Song 	w83795_write(client, W83795_REG_SF4_TEMP(index, nr), val);
1110792d376bSWei Song 	data->sf4_reg[index][SF4_TEMP][nr] = val;
1111792d376bSWei Song 	mutex_unlock(&data->update_lock);
1112792d376bSWei Song 
1113792d376bSWei Song 	return count;
1114792d376bSWei Song }
1115792d376bSWei Song 
1116792d376bSWei Song 
1117792d376bSWei Song static ssize_t
1118792d376bSWei Song show_temp(struct device *dev, struct device_attribute *attr, char *buf)
1119792d376bSWei Song {
1120792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1121792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1122792d376bSWei Song 	int nr = sensor_attr->nr;
1123792d376bSWei Song 	int index = sensor_attr->index;
1124792d376bSWei Song 	struct w83795_data *data = w83795_update_device(dev);
1125792d376bSWei Song 	long temp = temp_from_reg(data->temp[index][nr] & 0x7f);
1126792d376bSWei Song 
1127792d376bSWei Song 	if (TEMP_READ == nr)
1128792d376bSWei Song 		temp += ((data->temp_read_vrlsb[index] >> VRLSB_SHIFT) & 0x03)
1129792d376bSWei Song 			* 250;
1130792d376bSWei Song 	if (data->temp[index][nr] & 0x80)
1131792d376bSWei Song 		temp = -temp;
1132792d376bSWei Song 	return sprintf(buf, "%ld\n", temp);
1133792d376bSWei Song }
1134792d376bSWei Song 
1135792d376bSWei Song static ssize_t
1136792d376bSWei Song store_temp(struct device *dev, struct device_attribute *attr,
1137792d376bSWei Song 	   const char *buf, size_t count)
1138792d376bSWei Song {
1139792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1140792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1141792d376bSWei Song 	int nr = sensor_attr->nr;
1142792d376bSWei Song 	int index = sensor_attr->index;
1143792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1144792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1145792d376bSWei Song 	long tmp;
1146792d376bSWei Song 
1147792d376bSWei Song 	if (strict_strtol(buf, 10, &tmp) < 0)
1148792d376bSWei Song 		return -EINVAL;
1149792d376bSWei Song 
1150792d376bSWei Song 	mutex_lock(&data->update_lock);
1151792d376bSWei Song 	data->temp[index][nr] = temp_to_reg(tmp, -128, 127);
1152792d376bSWei Song 	w83795_write(client, W83795_REG_TEMP[index][nr], data->temp[index][nr]);
1153792d376bSWei Song 	mutex_unlock(&data->update_lock);
1154792d376bSWei Song 	return count;
1155792d376bSWei Song }
1156792d376bSWei Song 
1157792d376bSWei Song 
1158792d376bSWei Song static ssize_t
1159792d376bSWei Song show_dts_mode(struct device *dev, struct device_attribute *attr, char *buf)
1160792d376bSWei Song {
1161792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1162792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1163792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1164792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1165792d376bSWei Song 	int index = sensor_attr->index;
1166792d376bSWei Song 	u8 tmp;
1167792d376bSWei Song 
1168792d376bSWei Song 	if (data->enable_dts == 0)
1169792d376bSWei Song 		return sprintf(buf, "%d\n", 0);
1170792d376bSWei Song 
1171792d376bSWei Song 	if ((data->has_dts >> index) & 0x01) {
1172792d376bSWei Song 		if (data->enable_dts & 2)
1173792d376bSWei Song 			tmp = 5;
1174792d376bSWei Song 		else
1175792d376bSWei Song 			tmp = 6;
1176792d376bSWei Song 	} else {
1177792d376bSWei Song 		tmp = 0;
1178792d376bSWei Song 	}
1179792d376bSWei Song 
1180792d376bSWei Song 	return sprintf(buf, "%d\n", tmp);
1181792d376bSWei Song }
1182792d376bSWei Song 
1183792d376bSWei Song static ssize_t
1184792d376bSWei Song show_dts(struct device *dev, struct device_attribute *attr, char *buf)
1185792d376bSWei Song {
1186792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1187792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1188792d376bSWei Song 	int index = sensor_attr->index;
1189792d376bSWei Song 	struct w83795_data *data = w83795_update_device(dev);
1190792d376bSWei Song 	long temp = temp_from_reg(data->dts[index] & 0x7f);
1191792d376bSWei Song 
1192792d376bSWei Song 	temp += ((data->dts_read_vrlsb[index] >> VRLSB_SHIFT) & 0x03) * 250;
1193792d376bSWei Song 	if (data->dts[index] & 0x80)
1194792d376bSWei Song 		temp = -temp;
1195792d376bSWei Song 	return sprintf(buf, "%ld\n", temp);
1196792d376bSWei Song }
1197792d376bSWei Song 
1198792d376bSWei Song static ssize_t
1199792d376bSWei Song show_dts_ext(struct device *dev, struct device_attribute *attr, char *buf)
1200792d376bSWei Song {
1201792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1202792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1203792d376bSWei Song 	int nr = sensor_attr->nr;
1204792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1205792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1206792d376bSWei Song 	long temp = temp_from_reg(data->dts_ext[nr] & 0x7f);
1207792d376bSWei Song 
1208792d376bSWei Song 	if (data->dts_ext[nr] & 0x80)
1209792d376bSWei Song 		temp = -temp;
1210792d376bSWei Song 	return sprintf(buf, "%ld\n", temp);
1211792d376bSWei Song }
1212792d376bSWei Song 
1213792d376bSWei Song static ssize_t
1214792d376bSWei Song store_dts_ext(struct device *dev, struct device_attribute *attr,
1215792d376bSWei Song 	   const char *buf, size_t count)
1216792d376bSWei Song {
1217792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1218792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1219792d376bSWei Song 	int nr = sensor_attr->nr;
1220792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1221792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1222792d376bSWei Song 	long tmp;
1223792d376bSWei Song 
1224792d376bSWei Song 	if (strict_strtol(buf, 10, &tmp) < 0)
1225792d376bSWei Song 		return -EINVAL;
1226792d376bSWei Song 
1227792d376bSWei Song 	mutex_lock(&data->update_lock);
1228792d376bSWei Song 	data->dts_ext[nr] = temp_to_reg(tmp, -128, 127);
1229792d376bSWei Song 	w83795_write(client, W83795_REG_DTS_EXT(nr), data->dts_ext[nr]);
1230792d376bSWei Song 	mutex_unlock(&data->update_lock);
1231792d376bSWei Song 	return count;
1232792d376bSWei Song }
1233792d376bSWei Song 
1234792d376bSWei Song 
1235792d376bSWei Song /*
1236792d376bSWei Song 	Type 3:  Thermal diode
1237792d376bSWei Song 	Type 4:  Thermistor
1238792d376bSWei Song 
1239792d376bSWei Song 	Temp5-6, default TR
1240792d376bSWei Song 	Temp1-4, default TD
1241792d376bSWei Song */
1242792d376bSWei Song 
1243792d376bSWei Song static ssize_t
1244792d376bSWei Song show_temp_mode(struct device *dev, struct device_attribute *attr, char *buf)
1245792d376bSWei Song {
1246792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1247792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1248792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1249792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1250792d376bSWei Song 	int index = sensor_attr->index;
1251792d376bSWei Song 	u8 tmp;
1252792d376bSWei Song 
1253792d376bSWei Song 	if (data->has_temp >> index & 0x01) {
1254792d376bSWei Song 		if (data->temp_mode >> index & 0x01)
1255792d376bSWei Song 			tmp = 3;
1256792d376bSWei Song 		else
1257792d376bSWei Song 			tmp = 4;
1258792d376bSWei Song 	} else {
1259792d376bSWei Song 		tmp = 0;
1260792d376bSWei Song 	}
1261792d376bSWei Song 
1262792d376bSWei Song 	return sprintf(buf, "%d\n", tmp);
1263792d376bSWei Song }
1264792d376bSWei Song 
1265792d376bSWei Song static ssize_t
1266792d376bSWei Song store_temp_mode(struct device *dev, struct device_attribute *attr,
1267792d376bSWei Song 		const char *buf, size_t count)
1268792d376bSWei Song {
1269792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1270792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1271792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1272792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1273792d376bSWei Song 	int index = sensor_attr->index;
1274792d376bSWei Song 	unsigned long val;
1275792d376bSWei Song 	u8 tmp;
1276792d376bSWei Song 	u32 mask;
1277792d376bSWei Song 
1278792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
1279792d376bSWei Song 		return -EINVAL;
1280792d376bSWei Song 	if ((val != 4) && (val != 3))
1281792d376bSWei Song 		return -EINVAL;
1282792d376bSWei Song 	if ((index > 3) && (val == 3))
1283792d376bSWei Song 		return -EINVAL;
1284792d376bSWei Song 
1285792d376bSWei Song 	mutex_lock(&data->update_lock);
1286792d376bSWei Song 	if (val == 3) {
1287792d376bSWei Song 		val = TEMP_CTRL_TD;
1288792d376bSWei Song 		data->has_temp |= 1 << index;
1289792d376bSWei Song 		data->temp_mode |= 1 << index;
1290792d376bSWei Song 	} else if (val == 4) {
1291792d376bSWei Song 		val = TEMP_CTRL_TR;
1292792d376bSWei Song 		data->has_temp |= 1 << index;
1293792d376bSWei Song 		tmp = 1 << index;
1294792d376bSWei Song 		data->temp_mode &= ~tmp;
1295792d376bSWei Song 	}
1296792d376bSWei Song 
1297792d376bSWei Song 	if (index > 3)
1298792d376bSWei Song 		tmp = w83795_read(client, W83795_REG_TEMP_CTRL1);
1299792d376bSWei Song 	else
1300792d376bSWei Song 		tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
1301792d376bSWei Song 
1302792d376bSWei Song 	mask = 0x03 << W83795_REG_TEMP_CTRL[index][TEMP_CTRL_SHIFT];
1303792d376bSWei Song 	tmp &= ~mask;
1304792d376bSWei Song 	tmp |= W83795_REG_TEMP_CTRL[index][val];
1305792d376bSWei Song 
1306792d376bSWei Song 	mask = 1 << W83795_REG_TEMP_CTRL[index][TEMP_CTRL_HASIN_SHIFT];
1307792d376bSWei Song 	data->has_in &= ~mask;
1308792d376bSWei Song 
1309792d376bSWei Song 	if (index > 3)
1310792d376bSWei Song 		w83795_write(client, W83795_REG_TEMP_CTRL1, tmp);
1311792d376bSWei Song 	else
1312792d376bSWei Song 		w83795_write(client, W83795_REG_TEMP_CTRL2, tmp);
1313792d376bSWei Song 
1314792d376bSWei Song 	mutex_unlock(&data->update_lock);
1315792d376bSWei Song 	return count;
1316792d376bSWei Song }
1317792d376bSWei Song 
1318792d376bSWei Song 
1319792d376bSWei Song /* show/store VIN */
1320792d376bSWei Song static ssize_t
1321792d376bSWei Song show_in(struct device *dev, struct device_attribute *attr, char *buf)
1322792d376bSWei Song {
1323792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1324792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1325792d376bSWei Song 	int nr = sensor_attr->nr;
1326792d376bSWei Song 	int index = sensor_attr->index;
1327792d376bSWei Song 	struct w83795_data *data = w83795_update_device(dev);
1328792d376bSWei Song 	u16 val = data->in[index][nr];
1329792d376bSWei Song 	u8 lsb_idx;
1330792d376bSWei Song 
1331792d376bSWei Song 	switch (nr) {
1332792d376bSWei Song 	case IN_READ:
1333792d376bSWei Song 		/* calculate this value again by sensors as sensors3.conf */
1334792d376bSWei Song 		if ((index >= 17) &&
1335792d376bSWei Song 		    ((data->has_gain >> (index - 17)) & 1))
1336792d376bSWei Song 			val *= 8;
1337792d376bSWei Song 		break;
1338792d376bSWei Song 	case IN_MAX:
1339792d376bSWei Song 	case IN_LOW:
1340792d376bSWei Song 		lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1341792d376bSWei Song 		val <<= 2;
1342792d376bSWei Song 		val |= (data->in_lsb[lsb_idx][nr] >>
1343792d376bSWei Song 			IN_LSB_SHIFT_IDX[lsb_idx][IN_LSB_SHIFT]) & 0x03;
1344792d376bSWei Song 		if ((index >= 17) &&
1345792d376bSWei Song 		    ((data->has_gain >> (index - 17)) & 1))
1346792d376bSWei Song 			val *= 8;
1347792d376bSWei Song 		break;
1348792d376bSWei Song 	}
1349792d376bSWei Song 	val = in_from_reg(index, val);
1350792d376bSWei Song 
1351792d376bSWei Song 	return sprintf(buf, "%d\n", val);
1352792d376bSWei Song }
1353792d376bSWei Song 
1354792d376bSWei Song static ssize_t
1355792d376bSWei Song store_in(struct device *dev, struct device_attribute *attr,
1356792d376bSWei Song 	 const char *buf, size_t count)
1357792d376bSWei Song {
1358792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1359792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1360792d376bSWei Song 	int nr = sensor_attr->nr;
1361792d376bSWei Song 	int index = sensor_attr->index;
1362792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1363792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1364792d376bSWei Song 	unsigned long val;
1365792d376bSWei Song 	u8 tmp;
1366792d376bSWei Song 	u8 lsb_idx;
1367792d376bSWei Song 
1368792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
1369792d376bSWei Song 		return -EINVAL;
1370792d376bSWei Song 	val = in_to_reg(index, val);
1371792d376bSWei Song 
1372792d376bSWei Song 	if ((index >= 17) &&
1373792d376bSWei Song 	    ((data->has_gain >> (index - 17)) & 1))
1374792d376bSWei Song 		val /= 8;
1375792d376bSWei Song 	val = SENSORS_LIMIT(val, 0, 0x3FF);
1376792d376bSWei Song 	mutex_lock(&data->update_lock);
1377792d376bSWei Song 
1378792d376bSWei Song 	lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1379792d376bSWei Song 	tmp = w83795_read(client, IN_LSB_REG(lsb_idx, nr));
1380792d376bSWei Song 	tmp &= ~(0x03 << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT]);
1381792d376bSWei Song 	tmp |= (val & 0x03) << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT];
1382792d376bSWei Song 	w83795_write(client, IN_LSB_REG(lsb_idx, nr), tmp);
1383792d376bSWei Song 	data->in_lsb[lsb_idx][nr] = tmp;
1384792d376bSWei Song 
1385792d376bSWei Song 	tmp = (val >> 2) & 0xff;
1386792d376bSWei Song 	w83795_write(client, W83795_REG_IN[index][nr], tmp);
1387792d376bSWei Song 	data->in[index][nr] = tmp;
1388792d376bSWei Song 
1389792d376bSWei Song 	mutex_unlock(&data->update_lock);
1390792d376bSWei Song 	return count;
1391792d376bSWei Song }
1392792d376bSWei Song 
1393792d376bSWei Song 
1394792d376bSWei Song static ssize_t
1395792d376bSWei Song show_sf_setup(struct device *dev, struct device_attribute *attr, char *buf)
1396792d376bSWei Song {
1397792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1398792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1399792d376bSWei Song 	int nr = sensor_attr->nr;
1400792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1401792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1402792d376bSWei Song 	u16 val = data->setup_pwm[nr];
1403792d376bSWei Song 
1404792d376bSWei Song 	switch (nr) {
1405792d376bSWei Song 	case SETUP_PWM_UPTIME:
1406792d376bSWei Song 	case SETUP_PWM_DOWNTIME:
1407792d376bSWei Song 		val = time_from_reg(val);
1408792d376bSWei Song 		break;
1409792d376bSWei Song 	}
1410792d376bSWei Song 
1411792d376bSWei Song 	return sprintf(buf, "%d\n", val);
1412792d376bSWei Song }
1413792d376bSWei Song 
1414792d376bSWei Song static ssize_t
1415792d376bSWei Song store_sf_setup(struct device *dev, struct device_attribute *attr,
1416792d376bSWei Song 	 const char *buf, size_t count)
1417792d376bSWei Song {
1418792d376bSWei Song 	struct sensor_device_attribute_2 *sensor_attr =
1419792d376bSWei Song 	    to_sensor_dev_attr_2(attr);
1420792d376bSWei Song 	int nr = sensor_attr->nr;
1421792d376bSWei Song 	struct i2c_client *client = to_i2c_client(dev);
1422792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
1423792d376bSWei Song 	unsigned long val;
1424792d376bSWei Song 
1425792d376bSWei Song 	if (strict_strtoul(buf, 10, &val) < 0)
1426792d376bSWei Song 		return -EINVAL;
1427792d376bSWei Song 
1428792d376bSWei Song 	switch (nr) {
1429792d376bSWei Song 	case SETUP_PWM_DEFAULT:
1430792d376bSWei Song 		val = SENSORS_LIMIT(val, 0, 0xff);
1431792d376bSWei Song 		break;
1432792d376bSWei Song 	case SETUP_PWM_UPTIME:
1433792d376bSWei Song 	case SETUP_PWM_DOWNTIME:
1434792d376bSWei Song 		val = time_to_reg(val);
1435792d376bSWei Song 		if (val == 0)
1436792d376bSWei Song 			return -EINVAL;
1437792d376bSWei Song 		break;
1438792d376bSWei Song 	}
1439792d376bSWei Song 
1440792d376bSWei Song 	mutex_lock(&data->update_lock);
1441792d376bSWei Song 	data->setup_pwm[nr] = val;
1442792d376bSWei Song 	w83795_write(client, W83795_REG_SETUP_PWM(nr), val);
1443792d376bSWei Song 	mutex_unlock(&data->update_lock);
1444792d376bSWei Song 	return count;
1445792d376bSWei Song }
1446792d376bSWei Song 
1447792d376bSWei Song 
1448792d376bSWei Song #define NOT_USED			-1
1449792d376bSWei Song 
145087df0dadSJean Delvare #define SENSOR_ATTR_IN(index) {						\
1451792d376bSWei Song 	SENSOR_ATTR_2(in##index##_input, S_IRUGO, show_in, NULL,	\
1452792d376bSWei Song 		IN_READ, index), \
1453792d376bSWei Song 	SENSOR_ATTR_2(in##index##_max, S_IRUGO | S_IWUSR, show_in,	\
1454792d376bSWei Song 		store_in, IN_MAX, index),				\
1455792d376bSWei Song 	SENSOR_ATTR_2(in##index##_min, S_IRUGO | S_IWUSR, show_in,	\
1456792d376bSWei Song 		store_in, IN_LOW, index),				\
1457792d376bSWei Song 	SENSOR_ATTR_2(in##index##_alarm, S_IRUGO, show_alarm_beep,	\
1458792d376bSWei Song 		NULL, ALARM_STATUS, index + ((index > 14) ? 1 : 0)), \
1459792d376bSWei Song 	SENSOR_ATTR_2(in##index##_beep, S_IWUSR | S_IRUGO,		\
1460792d376bSWei Song 		show_alarm_beep, store_beep, BEEP_ENABLE,		\
146187df0dadSJean Delvare 		index + ((index > 14) ? 1 : 0)) }
1462792d376bSWei Song 
146387df0dadSJean Delvare #define SENSOR_ATTR_FAN(index) {					\
1464792d376bSWei Song 	SENSOR_ATTR_2(fan##index##_input, S_IRUGO, show_fan,		\
1465792d376bSWei Song 		NULL, FAN_INPUT, index - 1), \
1466792d376bSWei Song 	SENSOR_ATTR_2(fan##index##_min, S_IWUSR | S_IRUGO,		\
1467792d376bSWei Song 		show_fan, store_fan_min, FAN_MIN, index - 1),	\
1468792d376bSWei Song 	SENSOR_ATTR_2(fan##index##_alarm, S_IRUGO, show_alarm_beep,	\
1469792d376bSWei Song 		NULL, ALARM_STATUS, index + 31),			\
1470792d376bSWei Song 	SENSOR_ATTR_2(fan##index##_beep, S_IWUSR | S_IRUGO,		\
147187df0dadSJean Delvare 		show_alarm_beep, store_beep, BEEP_ENABLE, index + 31) }
1472792d376bSWei Song 
1473b5f6a90aSJean Delvare #define SENSOR_ATTR_PWM(index) {					\
1474792d376bSWei Song 	SENSOR_ATTR_2(pwm##index, S_IWUSR | S_IRUGO, show_pwm,		\
1475792d376bSWei Song 		store_pwm, PWM_OUTPUT, index - 1),			\
1476792d376bSWei Song 	SENSOR_ATTR_2(pwm##index##_nonstop, S_IWUSR | S_IRUGO,		\
1477792d376bSWei Song 		show_pwm, store_pwm, PWM_NONSTOP, index - 1),		\
1478792d376bSWei Song 	SENSOR_ATTR_2(pwm##index##_start, S_IWUSR | S_IRUGO,		\
1479792d376bSWei Song 		show_pwm, store_pwm, PWM_START, index - 1),		\
1480792d376bSWei Song 	SENSOR_ATTR_2(pwm##index##_stop_time, S_IWUSR | S_IRUGO,	\
1481792d376bSWei Song 		show_pwm, store_pwm, PWM_STOP_TIME, index - 1),	 \
1482792d376bSWei Song 	SENSOR_ATTR_2(fan##index##_div, S_IWUSR | S_IRUGO,	\
1483792d376bSWei Song 		show_pwm, store_pwm, PWM_DIV, index - 1),	 \
1484792d376bSWei Song 	SENSOR_ATTR_2(pwm##index##_enable, S_IWUSR | S_IRUGO,		\
1485b5f6a90aSJean Delvare 		show_pwm_enable, store_pwm_enable, NOT_USED, index - 1) }
1486792d376bSWei Song 
1487792d376bSWei Song #define SENSOR_ATTR_FANIN_TARGET(index)					\
1488792d376bSWei Song 	SENSOR_ATTR_2(speed_cruise##index##_target, S_IWUSR | S_IRUGO, \
1489792d376bSWei Song 		show_fanin, store_fanin, FANIN_TARGET, index - 1)
1490792d376bSWei Song 
149187df0dadSJean Delvare #define SENSOR_ATTR_DTS(index) {					\
1492792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_type, S_IRUGO ,		\
1493792d376bSWei Song 		show_dts_mode, NULL, NOT_USED, index - 7),	\
1494792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_dts,		\
1495792d376bSWei Song 		NULL, NOT_USED, index - 7),				\
1496792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_dts_ext, \
1497792d376bSWei Song 		store_dts_ext, DTS_CRIT, NOT_USED),			\
1498792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR,	\
1499792d376bSWei Song 		show_dts_ext, store_dts_ext, DTS_CRIT_HYST, NOT_USED),	\
1500792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_warn, S_IRUGO | S_IWUSR, show_dts_ext, \
1501792d376bSWei Song 		store_dts_ext, DTS_WARN, NOT_USED),			\
1502792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_warn_hyst, S_IRUGO | S_IWUSR,	\
1503792d376bSWei Song 		show_dts_ext, store_dts_ext, DTS_WARN_HYST, NOT_USED),	\
1504792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO,			\
1505792d376bSWei Song 		show_alarm_beep, NULL, ALARM_STATUS, index + 17),	\
1506792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO,		\
150787df0dadSJean Delvare 		show_alarm_beep, store_beep, BEEP_ENABLE, index + 17) }
1508792d376bSWei Song 
150987df0dadSJean Delvare #define SENSOR_ATTR_TEMP(index) {					\
1510792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_type, S_IRUGO | S_IWUSR,		\
1511792d376bSWei Song 		show_temp_mode, store_temp_mode, NOT_USED, index - 1),	\
1512792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_temp,		\
1513792d376bSWei Song 		NULL, TEMP_READ, index - 1),				\
1514792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_temp,	\
1515792d376bSWei Song 		store_temp, TEMP_CRIT, index - 1),			\
1516792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR,	\
1517792d376bSWei Song 		show_temp, store_temp, TEMP_CRIT_HYST, index - 1),	\
1518792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_warn, S_IRUGO | S_IWUSR, show_temp,	\
1519792d376bSWei Song 		store_temp, TEMP_WARN, index - 1),			\
1520792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_warn_hyst, S_IRUGO | S_IWUSR,	\
1521792d376bSWei Song 		show_temp, store_temp, TEMP_WARN_HYST, index - 1),	\
1522792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO,			\
1523792d376bSWei Song 		show_alarm_beep, NULL, ALARM_STATUS,			\
1524792d376bSWei Song 		index + (index > 4 ? 11 : 17)),				\
1525792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO,		\
1526792d376bSWei Song 		show_alarm_beep, store_beep, BEEP_ENABLE,		\
1527792d376bSWei Song 		index + (index > 4 ? 11 : 17)),				\
1528792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_source_sel, S_IWUSR | S_IRUGO,	\
1529792d376bSWei Song 		show_temp_src, store_temp_src, NOT_USED, index - 1),	\
1530792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_pwm_enable, S_IWUSR | S_IRUGO,	\
1531792d376bSWei Song 		show_temp_pwm_enable, store_temp_pwm_enable,		\
1532792d376bSWei Song 		TEMP_PWM_ENABLE, index - 1),				\
1533792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_channels_pwm, S_IWUSR | S_IRUGO, \
1534792d376bSWei Song 		show_temp_pwm_enable, store_temp_pwm_enable,		\
1535792d376bSWei Song 		TEMP_PWM_FAN_MAP, index - 1),				\
1536792d376bSWei Song 	SENSOR_ATTR_2(thermal_cruise##index, S_IWUSR | S_IRUGO,		\
1537792d376bSWei Song 		show_temp_pwm, store_temp_pwm, TEMP_PWM_TTTI, index - 1), \
1538792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_crit, S_IWUSR | S_IRUGO,		\
1539792d376bSWei Song 		show_temp_pwm, store_temp_pwm, TEMP_PWM_CTFS, index - 1), \
1540792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_crit_hyst, S_IWUSR | S_IRUGO,	\
1541792d376bSWei Song 		show_temp_pwm, store_temp_pwm, TEMP_PWM_HCT, index - 1), \
1542792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_operation_hyst, S_IWUSR | S_IRUGO,	\
1543792d376bSWei Song 		show_temp_pwm, store_temp_pwm, TEMP_PWM_HOT, index - 1), \
1544792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point1_pwm, S_IRUGO | S_IWUSR, \
1545792d376bSWei Song 		show_sf4_pwm, store_sf4_pwm, 0, index - 1),		\
1546792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point2_pwm, S_IRUGO | S_IWUSR, \
1547792d376bSWei Song 		show_sf4_pwm, store_sf4_pwm, 1, index - 1),		\
1548792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point3_pwm, S_IRUGO | S_IWUSR, \
1549792d376bSWei Song 		show_sf4_pwm, store_sf4_pwm, 2, index - 1),		\
1550792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point4_pwm, S_IRUGO | S_IWUSR, \
1551792d376bSWei Song 		show_sf4_pwm, store_sf4_pwm, 3, index - 1),		\
1552792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point5_pwm, S_IRUGO | S_IWUSR, \
1553792d376bSWei Song 		show_sf4_pwm, store_sf4_pwm, 4, index - 1),		\
1554792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point6_pwm, S_IRUGO | S_IWUSR, \
1555792d376bSWei Song 		show_sf4_pwm, store_sf4_pwm, 5, index - 1),		\
1556792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point7_pwm, S_IRUGO | S_IWUSR, \
1557792d376bSWei Song 		show_sf4_pwm, store_sf4_pwm, 6, index - 1),		\
1558792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point1_temp, S_IRUGO | S_IWUSR,\
1559792d376bSWei Song 		show_sf4_temp, store_sf4_temp, 0, index - 1),		\
1560792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point2_temp, S_IRUGO | S_IWUSR,\
1561792d376bSWei Song 		show_sf4_temp, store_sf4_temp, 1, index - 1),		\
1562792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point3_temp, S_IRUGO | S_IWUSR,\
1563792d376bSWei Song 		show_sf4_temp, store_sf4_temp, 2, index - 1),		\
1564792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point4_temp, S_IRUGO | S_IWUSR,\
1565792d376bSWei Song 		show_sf4_temp, store_sf4_temp, 3, index - 1),		\
1566792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point5_temp, S_IRUGO | S_IWUSR,\
1567792d376bSWei Song 		show_sf4_temp, store_sf4_temp, 4, index - 1),		\
1568792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point6_temp, S_IRUGO | S_IWUSR,\
1569792d376bSWei Song 		show_sf4_temp, store_sf4_temp, 5, index - 1),		\
1570792d376bSWei Song 	SENSOR_ATTR_2(temp##index##_auto_point7_temp, S_IRUGO | S_IWUSR,\
157187df0dadSJean Delvare 		show_sf4_temp, store_sf4_temp, 6, index - 1) }
1572792d376bSWei Song 
1573792d376bSWei Song 
157487df0dadSJean Delvare static struct sensor_device_attribute_2 w83795_in[][5] = {
1575792d376bSWei Song 	SENSOR_ATTR_IN(0),
1576792d376bSWei Song 	SENSOR_ATTR_IN(1),
1577792d376bSWei Song 	SENSOR_ATTR_IN(2),
1578792d376bSWei Song 	SENSOR_ATTR_IN(3),
1579792d376bSWei Song 	SENSOR_ATTR_IN(4),
1580792d376bSWei Song 	SENSOR_ATTR_IN(5),
1581792d376bSWei Song 	SENSOR_ATTR_IN(6),
1582792d376bSWei Song 	SENSOR_ATTR_IN(7),
1583792d376bSWei Song 	SENSOR_ATTR_IN(8),
1584792d376bSWei Song 	SENSOR_ATTR_IN(9),
1585792d376bSWei Song 	SENSOR_ATTR_IN(10),
1586792d376bSWei Song 	SENSOR_ATTR_IN(11),
1587792d376bSWei Song 	SENSOR_ATTR_IN(12),
1588792d376bSWei Song 	SENSOR_ATTR_IN(13),
1589792d376bSWei Song 	SENSOR_ATTR_IN(14),
1590792d376bSWei Song 	SENSOR_ATTR_IN(15),
1591792d376bSWei Song 	SENSOR_ATTR_IN(16),
1592792d376bSWei Song 	SENSOR_ATTR_IN(17),
1593792d376bSWei Song 	SENSOR_ATTR_IN(18),
1594792d376bSWei Song 	SENSOR_ATTR_IN(19),
1595792d376bSWei Song 	SENSOR_ATTR_IN(20),
1596792d376bSWei Song };
1597792d376bSWei Song 
159887df0dadSJean Delvare static struct sensor_device_attribute_2 w83795_fan[][4] = {
1599792d376bSWei Song 	SENSOR_ATTR_FAN(1),
1600792d376bSWei Song 	SENSOR_ATTR_FAN(2),
1601792d376bSWei Song 	SENSOR_ATTR_FAN(3),
1602792d376bSWei Song 	SENSOR_ATTR_FAN(4),
1603792d376bSWei Song 	SENSOR_ATTR_FAN(5),
1604792d376bSWei Song 	SENSOR_ATTR_FAN(6),
1605792d376bSWei Song 	SENSOR_ATTR_FAN(7),
1606792d376bSWei Song 	SENSOR_ATTR_FAN(8),
1607792d376bSWei Song 	SENSOR_ATTR_FAN(9),
1608792d376bSWei Song 	SENSOR_ATTR_FAN(10),
1609792d376bSWei Song 	SENSOR_ATTR_FAN(11),
1610792d376bSWei Song 	SENSOR_ATTR_FAN(12),
1611792d376bSWei Song 	SENSOR_ATTR_FAN(13),
1612792d376bSWei Song 	SENSOR_ATTR_FAN(14),
1613792d376bSWei Song };
1614792d376bSWei Song 
161587df0dadSJean Delvare static struct sensor_device_attribute_2 w83795_temp[][29] = {
1616792d376bSWei Song 	SENSOR_ATTR_TEMP(1),
1617792d376bSWei Song 	SENSOR_ATTR_TEMP(2),
1618792d376bSWei Song 	SENSOR_ATTR_TEMP(3),
1619792d376bSWei Song 	SENSOR_ATTR_TEMP(4),
1620792d376bSWei Song 	SENSOR_ATTR_TEMP(5),
1621792d376bSWei Song 	SENSOR_ATTR_TEMP(6),
1622792d376bSWei Song };
1623792d376bSWei Song 
162487df0dadSJean Delvare static struct sensor_device_attribute_2 w83795_dts[][8] = {
1625792d376bSWei Song 	SENSOR_ATTR_DTS(7),
1626792d376bSWei Song 	SENSOR_ATTR_DTS(8),
1627792d376bSWei Song 	SENSOR_ATTR_DTS(9),
1628792d376bSWei Song 	SENSOR_ATTR_DTS(10),
1629792d376bSWei Song 	SENSOR_ATTR_DTS(11),
1630792d376bSWei Song 	SENSOR_ATTR_DTS(12),
1631792d376bSWei Song 	SENSOR_ATTR_DTS(13),
1632792d376bSWei Song 	SENSOR_ATTR_DTS(14),
1633792d376bSWei Song };
1634792d376bSWei Song 
1635792d376bSWei Song static struct sensor_device_attribute_2 w83795_static[] = {
1636792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(1),
1637792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(2),
1638792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(3),
1639792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(4),
1640792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(5),
1641792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(6),
1642792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(7),
1643792d376bSWei Song 	SENSOR_ATTR_FANIN_TARGET(8),
1644792d376bSWei Song };
1645792d376bSWei Song 
1646b5f6a90aSJean Delvare static struct sensor_device_attribute_2 w83795_pwm[][6] = {
1647b5f6a90aSJean Delvare 	SENSOR_ATTR_PWM(1),
1648b5f6a90aSJean Delvare 	SENSOR_ATTR_PWM(2),
1649792d376bSWei Song 	SENSOR_ATTR_PWM(3),
1650792d376bSWei Song 	SENSOR_ATTR_PWM(4),
1651792d376bSWei Song 	SENSOR_ATTR_PWM(5),
1652792d376bSWei Song 	SENSOR_ATTR_PWM(6),
1653792d376bSWei Song 	SENSOR_ATTR_PWM(7),
1654792d376bSWei Song 	SENSOR_ATTR_PWM(8),
1655792d376bSWei Song };
1656792d376bSWei Song 
1657792d376bSWei Song static struct sensor_device_attribute_2 sda_single_files[] = {
1658792d376bSWei Song 	SENSOR_ATTR_2(chassis, S_IWUSR | S_IRUGO, show_alarm_beep,
1659792d376bSWei Song 		      store_chassis_clear, ALARM_STATUS, 46),
1660792d376bSWei Song 	SENSOR_ATTR_2(beep_enable, S_IWUSR | S_IRUGO, show_beep_enable,
1661792d376bSWei Song 		      store_beep_enable, NOT_USED, NOT_USED),
1662792d376bSWei Song 	SENSOR_ATTR_2(speed_cruise_tolerance, S_IWUSR | S_IRUGO, show_fanin,
1663792d376bSWei Song 		store_fanin, FANIN_TOL, NOT_USED),
1664792d376bSWei Song 	SENSOR_ATTR_2(pwm_default, S_IWUSR | S_IRUGO, show_sf_setup,
1665792d376bSWei Song 		      store_sf_setup, SETUP_PWM_DEFAULT, NOT_USED),
1666792d376bSWei Song 	SENSOR_ATTR_2(pwm_uptime, S_IWUSR | S_IRUGO, show_sf_setup,
1667792d376bSWei Song 		      store_sf_setup, SETUP_PWM_UPTIME, NOT_USED),
1668792d376bSWei Song 	SENSOR_ATTR_2(pwm_downtime, S_IWUSR | S_IRUGO, show_sf_setup,
1669792d376bSWei Song 		      store_sf_setup, SETUP_PWM_DOWNTIME, NOT_USED),
1670792d376bSWei Song };
1671792d376bSWei Song 
1672792d376bSWei Song /*
1673792d376bSWei Song  * Driver interface
1674792d376bSWei Song  */
1675792d376bSWei Song 
1676792d376bSWei Song static void w83795_init_client(struct i2c_client *client)
1677792d376bSWei Song {
1678792d376bSWei Song 	if (reset)
1679792d376bSWei Song 		w83795_write(client, W83795_REG_CONFIG, 0x80);
1680792d376bSWei Song 
1681792d376bSWei Song 	/* Start monitoring */
1682792d376bSWei Song 	w83795_write(client, W83795_REG_CONFIG,
1683792d376bSWei Song 		     w83795_read(client, W83795_REG_CONFIG) | 0x01);
1684792d376bSWei Song }
1685792d376bSWei Song 
16862be381deSJean Delvare static int w83795_get_device_id(struct i2c_client *client)
16872be381deSJean Delvare {
16882be381deSJean Delvare 	int device_id;
16892be381deSJean Delvare 
16902be381deSJean Delvare 	device_id = i2c_smbus_read_byte_data(client, W83795_REG_DEVICEID);
16912be381deSJean Delvare 
16922be381deSJean Delvare 	/* Special case for rev. A chips; can't be checked first because later
16932be381deSJean Delvare 	   revisions emulate this for compatibility */
16942be381deSJean Delvare 	if (device_id < 0 || (device_id & 0xf0) != 0x50) {
16952be381deSJean Delvare 		int alt_id;
16962be381deSJean Delvare 
16972be381deSJean Delvare 		alt_id = i2c_smbus_read_byte_data(client,
16982be381deSJean Delvare 						  W83795_REG_DEVICEID_A);
16992be381deSJean Delvare 		if (alt_id == 0x50)
17002be381deSJean Delvare 			device_id = alt_id;
17012be381deSJean Delvare 	}
17022be381deSJean Delvare 
17032be381deSJean Delvare 	return device_id;
17042be381deSJean Delvare }
17052be381deSJean Delvare 
1706792d376bSWei Song /* Return 0 if detection is successful, -ENODEV otherwise */
1707792d376bSWei Song static int w83795_detect(struct i2c_client *client,
1708792d376bSWei Song 			 struct i2c_board_info *info)
1709792d376bSWei Song {
17102be381deSJean Delvare 	int bank, vendor_id, device_id, expected, i2c_addr, config;
1711792d376bSWei Song 	struct i2c_adapter *adapter = client->adapter;
1712792d376bSWei Song 	unsigned short address = client->addr;
1713093d1a47SJean Delvare 	const char *chip_name;
1714792d376bSWei Song 
1715792d376bSWei Song 	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1716792d376bSWei Song 		return -ENODEV;
1717792d376bSWei Song 	bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
17182be381deSJean Delvare 	if (bank < 0 || (bank & 0x7c)) {
17192be381deSJean Delvare 		dev_dbg(&adapter->dev,
17202be381deSJean Delvare 			"w83795: Detection failed at addr 0x%02hx, check %s\n",
17212be381deSJean Delvare 			address, "bank");
17222be381deSJean Delvare 		return -ENODEV;
17232be381deSJean Delvare 	}
1724792d376bSWei Song 
1725792d376bSWei Song 	/* Check Nuvoton vendor ID */
17262be381deSJean Delvare 	vendor_id = i2c_smbus_read_byte_data(client, W83795_REG_VENDORID);
17272be381deSJean Delvare 	expected = bank & 0x80 ? 0x5c : 0xa3;
17282be381deSJean Delvare 	if (vendor_id != expected) {
17292be381deSJean Delvare 		dev_dbg(&adapter->dev,
17302be381deSJean Delvare 			"w83795: Detection failed at addr 0x%02hx, check %s\n",
17312be381deSJean Delvare 			address, "vendor id");
17322be381deSJean Delvare 		return -ENODEV;
17332be381deSJean Delvare 	}
17342be381deSJean Delvare 
17352be381deSJean Delvare 	/* Check device ID */
17362be381deSJean Delvare 	device_id = w83795_get_device_id(client) |
17372be381deSJean Delvare 		    (i2c_smbus_read_byte_data(client, W83795_REG_CHIPID) << 8);
17382be381deSJean Delvare 	if ((device_id >> 4) != 0x795) {
17392be381deSJean Delvare 		dev_dbg(&adapter->dev,
17402be381deSJean Delvare 			"w83795: Detection failed at addr 0x%02hx, check %s\n",
17412be381deSJean Delvare 			address, "device id\n");
1742792d376bSWei Song 		return -ENODEV;
1743792d376bSWei Song 	}
1744792d376bSWei Song 
1745792d376bSWei Song 	/* If Nuvoton chip, address of chip and W83795_REG_I2C_ADDR
1746792d376bSWei Song 	   should match */
17472be381deSJean Delvare 	if ((bank & 0x07) == 0) {
17482be381deSJean Delvare 		i2c_addr = i2c_smbus_read_byte_data(client,
17492be381deSJean Delvare 						    W83795_REG_I2C_ADDR);
17502be381deSJean Delvare 		if ((i2c_addr & 0x7f) != address) {
17512be381deSJean Delvare 			dev_dbg(&adapter->dev,
17522be381deSJean Delvare 				"w83795: Detection failed at addr 0x%02hx, "
17532be381deSJean Delvare 				"check %s\n", address, "i2c addr");
1754792d376bSWei Song 			return -ENODEV;
1755792d376bSWei Song 		}
1756792d376bSWei Song 	}
1757792d376bSWei Song 
1758093d1a47SJean Delvare 	/* Check 795 chip type: 795G or 795ADG
1759093d1a47SJean Delvare 	   Usually we don't write to chips during detection, but here we don't
1760093d1a47SJean Delvare 	   quite have the choice; hopefully it's OK, we are about to return
1761093d1a47SJean Delvare 	   success anyway */
1762093d1a47SJean Delvare 	if ((bank & 0x07) != 0)
1763093d1a47SJean Delvare 		i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL,
1764093d1a47SJean Delvare 					  bank & ~0x07);
17652be381deSJean Delvare 	config = i2c_smbus_read_byte_data(client, W83795_REG_CONFIG);
17662be381deSJean Delvare 	if (config & W83795_REG_CONFIG_CONFIG48)
1767093d1a47SJean Delvare 		chip_name = "w83795adg";
17682be381deSJean Delvare 	else
1769093d1a47SJean Delvare 		chip_name = "w83795g";
1770792d376bSWei Song 
1771093d1a47SJean Delvare 	strlcpy(info->type, chip_name, I2C_NAME_SIZE);
17722be381deSJean Delvare 	dev_info(&adapter->dev, "Found %s rev. %c at 0x%02hx\n", chip_name,
17732be381deSJean Delvare 		 'A' + (device_id & 0xf), address);
1774792d376bSWei Song 
1775792d376bSWei Song 	return 0;
1776792d376bSWei Song }
1777792d376bSWei Song 
17786f3dcde9SJean Delvare static int w83795_handle_files(struct device *dev, int (*fn)(struct device *,
17796f3dcde9SJean Delvare 			       const struct device_attribute *))
1780892514a6SJean Delvare {
1781892514a6SJean Delvare 	struct w83795_data *data = dev_get_drvdata(dev);
178287df0dadSJean Delvare 	int err, i, j;
1783892514a6SJean Delvare 
1784892514a6SJean Delvare 	for (i = 0; i < ARRAY_SIZE(w83795_in); i++) {
178587df0dadSJean Delvare 		if (!(data->has_in & (1 << i)))
1786892514a6SJean Delvare 			continue;
178787df0dadSJean Delvare 		for (j = 0; j < ARRAY_SIZE(w83795_in[0]); j++) {
178887df0dadSJean Delvare 			err = fn(dev, &w83795_in[i][j].dev_attr);
1789892514a6SJean Delvare 			if (err)
1790892514a6SJean Delvare 				return err;
1791892514a6SJean Delvare 		}
179287df0dadSJean Delvare 	}
1793892514a6SJean Delvare 
1794892514a6SJean Delvare 	for (i = 0; i < ARRAY_SIZE(w83795_fan); i++) {
179587df0dadSJean Delvare 		if (!(data->has_fan & (1 << i)))
1796892514a6SJean Delvare 			continue;
179787df0dadSJean Delvare 		for (j = 0; j < ARRAY_SIZE(w83795_fan[0]); j++) {
179887df0dadSJean Delvare 			err = fn(dev, &w83795_fan[i][j].dev_attr);
1799892514a6SJean Delvare 			if (err)
1800892514a6SJean Delvare 				return err;
1801892514a6SJean Delvare 		}
180287df0dadSJean Delvare 	}
1803892514a6SJean Delvare 
1804892514a6SJean Delvare 	for (i = 0; i < ARRAY_SIZE(sda_single_files); i++) {
18056f3dcde9SJean Delvare 		err = fn(dev, &sda_single_files[i].dev_attr);
1806892514a6SJean Delvare 		if (err)
1807892514a6SJean Delvare 			return err;
1808892514a6SJean Delvare 	}
1809892514a6SJean Delvare 
1810b5f6a90aSJean Delvare 	for (i = 0; i < data->has_pwm; i++) {
1811b5f6a90aSJean Delvare 		for (j = 0; j < ARRAY_SIZE(w83795_pwm[0]); j++) {
1812b5f6a90aSJean Delvare 			err = fn(dev, &w83795_pwm[i][j].dev_attr);
1813892514a6SJean Delvare 			if (err)
1814892514a6SJean Delvare 				return err;
1815892514a6SJean Delvare 		}
1816892514a6SJean Delvare 	}
1817892514a6SJean Delvare 
1818892514a6SJean Delvare 	for (i = 0; i < ARRAY_SIZE(w83795_temp); i++) {
181987df0dadSJean Delvare 		if (!(data->has_temp & (1 << i)))
1820892514a6SJean Delvare 			continue;
182187df0dadSJean Delvare 		for (j = 0; j < ARRAY_SIZE(w83795_temp[0]); j++) {
182287df0dadSJean Delvare 			err = fn(dev, &w83795_temp[i][j].dev_attr);
1823892514a6SJean Delvare 			if (err)
1824892514a6SJean Delvare 				return err;
1825892514a6SJean Delvare 		}
182687df0dadSJean Delvare 	}
1827892514a6SJean Delvare 
1828892514a6SJean Delvare 	if (data->enable_dts != 0) {
1829892514a6SJean Delvare 		for (i = 0; i < ARRAY_SIZE(w83795_dts); i++) {
183087df0dadSJean Delvare 			if (!(data->has_dts & (1 << i)))
1831892514a6SJean Delvare 				continue;
183287df0dadSJean Delvare 			for (j = 0; j < ARRAY_SIZE(w83795_dts[0]); j++) {
183387df0dadSJean Delvare 				err = fn(dev, &w83795_dts[i][j].dev_attr);
1834892514a6SJean Delvare 				if (err)
1835892514a6SJean Delvare 					return err;
1836892514a6SJean Delvare 			}
1837892514a6SJean Delvare 		}
183887df0dadSJean Delvare 	}
1839892514a6SJean Delvare 
1840892514a6SJean Delvare 	for (i = 0; i < ARRAY_SIZE(w83795_static); i++) {
18416f3dcde9SJean Delvare 		err = fn(dev, &w83795_static[i].dev_attr);
1842892514a6SJean Delvare 		if (err)
1843892514a6SJean Delvare 			return err;
1844892514a6SJean Delvare 	}
1845892514a6SJean Delvare 
1846892514a6SJean Delvare 	return 0;
1847892514a6SJean Delvare }
1848892514a6SJean Delvare 
18496f3dcde9SJean Delvare /* We need a wrapper that fits in w83795_handle_files */
18506f3dcde9SJean Delvare static int device_remove_file_wrapper(struct device *dev,
18516f3dcde9SJean Delvare 				      const struct device_attribute *attr)
18522fa09878SJean Delvare {
18536f3dcde9SJean Delvare 	device_remove_file(dev, attr);
18546f3dcde9SJean Delvare 	return 0;
18552fa09878SJean Delvare }
18562fa09878SJean Delvare 
1857792d376bSWei Song static int w83795_probe(struct i2c_client *client,
1858792d376bSWei Song 			const struct i2c_device_id *id)
1859792d376bSWei Song {
1860792d376bSWei Song 	int i;
1861792d376bSWei Song 	u8 tmp;
1862792d376bSWei Song 	struct device *dev = &client->dev;
1863792d376bSWei Song 	struct w83795_data *data;
1864792d376bSWei Song 	int err = 0;
1865792d376bSWei Song 
1866792d376bSWei Song 	data = kzalloc(sizeof(struct w83795_data), GFP_KERNEL);
1867792d376bSWei Song 	if (!data) {
1868792d376bSWei Song 		err = -ENOMEM;
1869792d376bSWei Song 		goto exit;
1870792d376bSWei Song 	}
1871792d376bSWei Song 
1872792d376bSWei Song 	i2c_set_clientdata(client, data);
1873093d1a47SJean Delvare 	data->chip_type = id->driver_data;
1874792d376bSWei Song 	data->bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
1875792d376bSWei Song 	mutex_init(&data->update_lock);
1876792d376bSWei Song 
1877792d376bSWei Song 	/* Initialize the chip */
1878792d376bSWei Song 	w83795_init_client(client);
1879792d376bSWei Song 
1880792d376bSWei Song 	data->has_in = w83795_read(client, W83795_REG_VOLT_CTRL1);
1881792d376bSWei Song 	data->has_in |= w83795_read(client, W83795_REG_VOLT_CTRL2) << 8;
1882792d376bSWei Song 	/* VSEN11-9 not for 795adg */
1883792d376bSWei Song 	if (data->chip_type == w83795adg)
1884792d376bSWei Song 		data->has_in &= 0xf8ff;
1885792d376bSWei Song 	data->has_fan = w83795_read(client, W83795_REG_FANIN_CTRL1);
1886792d376bSWei Song 	data->has_fan |= w83795_read(client, W83795_REG_FANIN_CTRL2) << 8;
1887792d376bSWei Song 
1888792d376bSWei Song 	/* VDSEN12-17 and TR1-6, TD1-4 use same register */
1889792d376bSWei Song 	tmp = w83795_read(client, W83795_REG_TEMP_CTRL1);
1890792d376bSWei Song 	if (tmp & 0x20)
1891792d376bSWei Song 		data->enable_dts = 1;
1892792d376bSWei Song 	else
1893792d376bSWei Song 		data->enable_dts = 0;
1894792d376bSWei Song 	data->has_temp = 0;
1895792d376bSWei Song 	data->temp_mode = 0;
1896792d376bSWei Song 	if (tmp & 0x08) {
1897792d376bSWei Song 		if (tmp & 0x04)
1898792d376bSWei Song 			data->has_temp |= 0x20;
1899792d376bSWei Song 		else
1900792d376bSWei Song 			data->has_in |= 0x10000;
1901792d376bSWei Song 	}
1902792d376bSWei Song 	if (tmp & 0x02) {
1903792d376bSWei Song 		if (tmp & 0x01)
1904792d376bSWei Song 			data->has_temp |= 0x10;
1905792d376bSWei Song 		else
1906792d376bSWei Song 			data->has_in |= 0x8000;
1907792d376bSWei Song 	}
1908792d376bSWei Song 	tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
1909792d376bSWei Song 	if (tmp & 0x40) {
1910792d376bSWei Song 		data->has_temp |= 0x08;
1911792d376bSWei Song 		if (!(tmp & 0x80))
1912792d376bSWei Song 			data->temp_mode |= 0x08;
1913792d376bSWei Song 	} else if (tmp & 0x80) {
1914792d376bSWei Song 		data->has_in |= 0x100000;
1915792d376bSWei Song 	}
1916792d376bSWei Song 	if (tmp & 0x10) {
1917792d376bSWei Song 		data->has_temp |= 0x04;
1918792d376bSWei Song 		if (!(tmp & 0x20))
1919792d376bSWei Song 			data->temp_mode |= 0x04;
1920792d376bSWei Song 	} else if (tmp & 0x20) {
1921792d376bSWei Song 		data->has_in |= 0x80000;
1922792d376bSWei Song 	}
1923792d376bSWei Song 	if (tmp & 0x04) {
1924792d376bSWei Song 		data->has_temp |= 0x02;
1925792d376bSWei Song 		if (!(tmp & 0x08))
1926792d376bSWei Song 			data->temp_mode |= 0x02;
1927792d376bSWei Song 	} else if (tmp & 0x08) {
1928792d376bSWei Song 		data->has_in |= 0x40000;
1929792d376bSWei Song 	}
1930792d376bSWei Song 	if (tmp & 0x01) {
1931792d376bSWei Song 		data->has_temp |= 0x01;
1932792d376bSWei Song 		if (!(tmp & 0x02))
1933792d376bSWei Song 			data->temp_mode |= 0x01;
1934792d376bSWei Song 	} else if (tmp & 0x02) {
1935792d376bSWei Song 		data->has_in |= 0x20000;
1936792d376bSWei Song 	}
1937792d376bSWei Song 
1938792d376bSWei Song 	/* Check DTS enable status */
1939792d376bSWei Song 	if (data->enable_dts == 0) {
1940792d376bSWei Song 		data->has_dts = 0;
1941792d376bSWei Song 	} else {
1942792d376bSWei Song 		if (1 & w83795_read(client, W83795_REG_DTSC))
1943792d376bSWei Song 			data->enable_dts |= 2;
1944792d376bSWei Song 		data->has_dts = w83795_read(client, W83795_REG_DTSE);
1945792d376bSWei Song 	}
1946792d376bSWei Song 
1947792d376bSWei Song 	/* First update the voltages measured value and limits */
1948792d376bSWei Song 	for (i = 0; i < ARRAY_SIZE(data->in); i++) {
1949792d376bSWei Song 		if (!(data->has_in & (1 << i)))
1950792d376bSWei Song 			continue;
1951792d376bSWei Song 		data->in[i][IN_MAX] =
1952792d376bSWei Song 			w83795_read(client, W83795_REG_IN[i][IN_MAX]);
1953792d376bSWei Song 		data->in[i][IN_LOW] =
1954792d376bSWei Song 			w83795_read(client, W83795_REG_IN[i][IN_LOW]);
1955792d376bSWei Song 		tmp = w83795_read(client, W83795_REG_IN[i][IN_READ]) << 2;
1956792d376bSWei Song 		tmp |= (w83795_read(client, W83795_REG_VRLSB)
1957792d376bSWei Song 			>> VRLSB_SHIFT) & 0x03;
1958792d376bSWei Song 		data->in[i][IN_READ] = tmp;
1959792d376bSWei Song 	}
1960792d376bSWei Song 	for (i = 0; i < IN_LSB_REG_NUM; i++) {
1961792d376bSWei Song 		data->in_lsb[i][IN_MAX] =
1962792d376bSWei Song 			w83795_read(client, IN_LSB_REG(i, IN_MAX));
1963792d376bSWei Song 		data->in_lsb[i][IN_LOW] =
1964792d376bSWei Song 			w83795_read(client, IN_LSB_REG(i, IN_LOW));
1965792d376bSWei Song 	}
1966792d376bSWei Song 	data->has_gain = w83795_read(client, W83795_REG_VMIGB_CTRL) & 0x0f;
1967792d376bSWei Song 
1968792d376bSWei Song 	/* First update fan and limits */
1969792d376bSWei Song 	for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
1970792d376bSWei Song 		if (!(data->has_fan & (1 << i)))
1971792d376bSWei Song 			continue;
1972792d376bSWei Song 		data->fan_min[i] =
1973792d376bSWei Song 			w83795_read(client, W83795_REG_FAN_MIN_HL(i)) << 4;
1974792d376bSWei Song 		data->fan_min[i] |=
1975792d376bSWei Song 		  (w83795_read(client, W83795_REG_FAN_MIN_LSB(i) >>
1976792d376bSWei Song 			W83795_REG_FAN_MIN_LSB_SHIFT(i))) & 0x0F;
1977792d376bSWei Song 		data->fan[i] = w83795_read(client, W83795_REG_FAN(i)) << 4;
1978792d376bSWei Song 		data->fan[i] |=
1979792d376bSWei Song 		  (w83795_read(client, W83795_REG_VRLSB >> 4)) & 0x0F;
1980792d376bSWei Song 	}
1981792d376bSWei Song 
1982792d376bSWei Song 	/* temperature and limits */
1983792d376bSWei Song 	for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
1984792d376bSWei Song 		if (!(data->has_temp & (1 << i)))
1985792d376bSWei Song 			continue;
1986792d376bSWei Song 		data->temp[i][TEMP_CRIT] =
1987792d376bSWei Song 			w83795_read(client, W83795_REG_TEMP[i][TEMP_CRIT]);
1988792d376bSWei Song 		data->temp[i][TEMP_CRIT_HYST] =
1989792d376bSWei Song 			w83795_read(client, W83795_REG_TEMP[i][TEMP_CRIT_HYST]);
1990792d376bSWei Song 		data->temp[i][TEMP_WARN] =
1991792d376bSWei Song 			w83795_read(client, W83795_REG_TEMP[i][TEMP_WARN]);
1992792d376bSWei Song 		data->temp[i][TEMP_WARN_HYST] =
1993792d376bSWei Song 			w83795_read(client, W83795_REG_TEMP[i][TEMP_WARN_HYST]);
1994792d376bSWei Song 		data->temp[i][TEMP_READ] =
1995792d376bSWei Song 			w83795_read(client, W83795_REG_TEMP[i][TEMP_READ]);
1996792d376bSWei Song 		data->temp_read_vrlsb[i] =
1997792d376bSWei Song 			w83795_read(client, W83795_REG_VRLSB);
1998792d376bSWei Song 	}
1999792d376bSWei Song 
2000792d376bSWei Song 	/* dts temperature and limits */
2001792d376bSWei Song 	if (data->enable_dts != 0) {
2002792d376bSWei Song 		data->dts_ext[DTS_CRIT] =
2003792d376bSWei Song 			w83795_read(client, W83795_REG_DTS_EXT(DTS_CRIT));
2004792d376bSWei Song 		data->dts_ext[DTS_CRIT_HYST] =
2005792d376bSWei Song 			w83795_read(client, W83795_REG_DTS_EXT(DTS_CRIT_HYST));
2006792d376bSWei Song 		data->dts_ext[DTS_WARN] =
2007792d376bSWei Song 			w83795_read(client, W83795_REG_DTS_EXT(DTS_WARN));
2008792d376bSWei Song 		data->dts_ext[DTS_WARN_HYST] =
2009792d376bSWei Song 			w83795_read(client, W83795_REG_DTS_EXT(DTS_WARN_HYST));
2010792d376bSWei Song 		for (i = 0; i < ARRAY_SIZE(data->dts); i++) {
2011792d376bSWei Song 			if (!(data->has_dts & (1 << i)))
2012792d376bSWei Song 				continue;
2013792d376bSWei Song 			data->dts[i] = w83795_read(client, W83795_REG_DTS(i));
2014792d376bSWei Song 			data->dts_read_vrlsb[i] =
2015792d376bSWei Song 				w83795_read(client, W83795_REG_VRLSB);
2016792d376bSWei Song 		}
2017792d376bSWei Song 	}
2018792d376bSWei Song 
2019792d376bSWei Song 	/* First update temp source selction */
2020792d376bSWei Song 	for (i = 0; i < 3; i++)
2021792d376bSWei Song 		data->temp_src[i] = w83795_read(client, W83795_REG_TSS(i));
2022792d376bSWei Song 
2023792d376bSWei Song 	/* pwm and smart fan */
2024792d376bSWei Song 	if (data->chip_type == w83795g)
2025792d376bSWei Song 		data->has_pwm = 8;
2026792d376bSWei Song 	else
2027792d376bSWei Song 		data->has_pwm = 2;
2028792d376bSWei Song 	data->pwm_fcms[0] = w83795_read(client, W83795_REG_FCMS1);
2029792d376bSWei Song 	data->pwm_fcms[1] = w83795_read(client, W83795_REG_FCMS2);
2030792d376bSWei Song 	/* w83795adg only support pwm2-0 */
2031792d376bSWei Song 	for (i = 0; i < W83795_REG_TEMP_NUM; i++)
2032792d376bSWei Song 		data->pwm_tfmr[i] = w83795_read(client, W83795_REG_TFMR(i));
2033792d376bSWei Song 	data->pwm_fomc = w83795_read(client, W83795_REG_FOMC);
2034792d376bSWei Song 	for (i = 0; i < data->has_pwm; i++) {
2035792d376bSWei Song 		for (tmp = 0; tmp < 5; tmp++) {
2036792d376bSWei Song 			data->pwm[i][tmp] =
2037792d376bSWei Song 				w83795_read(client, W83795_REG_PWM(i, tmp));
2038792d376bSWei Song 		}
2039792d376bSWei Song 	}
2040792d376bSWei Song 	for (i = 0; i < 8; i++) {
2041792d376bSWei Song 		data->target_speed[i] =
2042792d376bSWei Song 			w83795_read(client, W83795_REG_FTSH(i)) << 4;
2043792d376bSWei Song 		data->target_speed[i] |=
2044792d376bSWei Song 			w83795_read(client, W83795_REG_FTSL(i)) >> 4;
2045792d376bSWei Song 	}
2046792d376bSWei Song 	data->tol_speed = w83795_read(client, W83795_REG_TFTS) & 0x3f;
2047792d376bSWei Song 
2048792d376bSWei Song 	for (i = 0; i < W83795_REG_TEMP_NUM; i++) {
2049792d376bSWei Song 		data->pwm_temp[i][TEMP_PWM_TTTI] =
2050792d376bSWei Song 			w83795_read(client, W83795_REG_TTTI(i)) & 0x7f;
2051792d376bSWei Song 		data->pwm_temp[i][TEMP_PWM_CTFS] =
2052792d376bSWei Song 			w83795_read(client, W83795_REG_CTFS(i));
2053792d376bSWei Song 		tmp = w83795_read(client, W83795_REG_HT(i));
2054792d376bSWei Song 		data->pwm_temp[i][TEMP_PWM_HCT] = (tmp >> 4) & 0x0f;
2055792d376bSWei Song 		data->pwm_temp[i][TEMP_PWM_HOT] = tmp & 0x0f;
2056792d376bSWei Song 	}
2057792d376bSWei Song 	for (i = 0; i < W83795_REG_TEMP_NUM; i++) {
2058792d376bSWei Song 		for (tmp = 0; tmp < 7; tmp++) {
2059792d376bSWei Song 			data->sf4_reg[i][SF4_TEMP][tmp] =
2060792d376bSWei Song 				w83795_read(client,
2061792d376bSWei Song 					    W83795_REG_SF4_TEMP(i, tmp));
2062792d376bSWei Song 			data->sf4_reg[i][SF4_PWM][tmp] =
2063792d376bSWei Song 				w83795_read(client, W83795_REG_SF4_PWM(i, tmp));
2064792d376bSWei Song 		}
2065792d376bSWei Song 	}
2066792d376bSWei Song 
2067792d376bSWei Song 	/* Setup PWM Register */
2068792d376bSWei Song 	for (i = 0; i < 3; i++) {
2069792d376bSWei Song 		data->setup_pwm[i] =
2070792d376bSWei Song 			w83795_read(client, W83795_REG_SETUP_PWM(i));
2071792d376bSWei Song 	}
2072792d376bSWei Song 
2073792d376bSWei Song 	/* alarm and beep */
2074792d376bSWei Song 	for (i = 0; i < ALARM_BEEP_REG_NUM; i++) {
2075792d376bSWei Song 		data->alarms[i] = w83795_read(client, W83795_REG_ALARM(i));
2076792d376bSWei Song 		data->beeps[i] = w83795_read(client, W83795_REG_BEEP(i));
2077792d376bSWei Song 	}
2078792d376bSWei Song 	data->beep_enable =
2079792d376bSWei Song 		(w83795_read(client, W83795_REG_BEEP(5)) >> 7) & 0x01;
2080792d376bSWei Song 
20816f3dcde9SJean Delvare 	err = w83795_handle_files(dev, device_create_file);
2082792d376bSWei Song 	if (err)
2083792d376bSWei Song 		goto exit_remove;
2084792d376bSWei Song 
2085792d376bSWei Song 	data->hwmon_dev = hwmon_device_register(dev);
2086792d376bSWei Song 	if (IS_ERR(data->hwmon_dev)) {
2087792d376bSWei Song 		err = PTR_ERR(data->hwmon_dev);
2088792d376bSWei Song 		goto exit_remove;
2089792d376bSWei Song 	}
2090792d376bSWei Song 
2091792d376bSWei Song 	return 0;
2092792d376bSWei Song 
2093792d376bSWei Song exit_remove:
20946f3dcde9SJean Delvare 	w83795_handle_files(dev, device_remove_file_wrapper);
2095792d376bSWei Song 	kfree(data);
2096792d376bSWei Song exit:
2097792d376bSWei Song 	return err;
2098792d376bSWei Song }
2099792d376bSWei Song 
2100792d376bSWei Song static int w83795_remove(struct i2c_client *client)
2101792d376bSWei Song {
2102792d376bSWei Song 	struct w83795_data *data = i2c_get_clientdata(client);
2103792d376bSWei Song 
2104792d376bSWei Song 	hwmon_device_unregister(data->hwmon_dev);
21056f3dcde9SJean Delvare 	w83795_handle_files(&client->dev, device_remove_file_wrapper);
2106792d376bSWei Song 	kfree(data);
2107792d376bSWei Song 
2108792d376bSWei Song 	return 0;
2109792d376bSWei Song }
2110792d376bSWei Song 
2111792d376bSWei Song 
2112792d376bSWei Song static const struct i2c_device_id w83795_id[] = {
2113093d1a47SJean Delvare 	{ "w83795g", w83795g },
2114093d1a47SJean Delvare 	{ "w83795adg", w83795adg },
2115792d376bSWei Song 	{ }
2116792d376bSWei Song };
2117792d376bSWei Song MODULE_DEVICE_TABLE(i2c, w83795_id);
2118792d376bSWei Song 
2119792d376bSWei Song static struct i2c_driver w83795_driver = {
2120792d376bSWei Song 	.driver = {
2121792d376bSWei Song 		   .name = "w83795",
2122792d376bSWei Song 	},
2123792d376bSWei Song 	.probe		= w83795_probe,
2124792d376bSWei Song 	.remove		= w83795_remove,
2125792d376bSWei Song 	.id_table	= w83795_id,
2126792d376bSWei Song 
2127792d376bSWei Song 	.class		= I2C_CLASS_HWMON,
2128792d376bSWei Song 	.detect		= w83795_detect,
2129792d376bSWei Song 	.address_list	= normal_i2c,
2130792d376bSWei Song };
2131792d376bSWei Song 
2132792d376bSWei Song static int __init sensors_w83795_init(void)
2133792d376bSWei Song {
2134792d376bSWei Song 	return i2c_add_driver(&w83795_driver);
2135792d376bSWei Song }
2136792d376bSWei Song 
2137792d376bSWei Song static void __exit sensors_w83795_exit(void)
2138792d376bSWei Song {
2139792d376bSWei Song 	i2c_del_driver(&w83795_driver);
2140792d376bSWei Song }
2141792d376bSWei Song 
2142792d376bSWei Song MODULE_AUTHOR("Wei Song");
2143315bacfdSJean Delvare MODULE_DESCRIPTION("W83795G/ADG hardware monitoring driver");
2144792d376bSWei Song MODULE_LICENSE("GPL");
2145792d376bSWei Song 
2146792d376bSWei Song module_init(sensors_w83795_init);
2147792d376bSWei Song module_exit(sensors_w83795_exit);
2148