| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |   adm1031.c - Part of lm_sensors, Linux kernel modules for hardware | 
 | 3 |   monitoring | 
 | 4 |   Based on lm75.c and lm85.c | 
 | 5 |   Supports adm1030 / adm1031 | 
 | 6 |   Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org> | 
 | 7 |   Reworked by Jean Delvare <khali@linux-fr.org> | 
 | 8 |    | 
 | 9 |   This program is free software; you can redistribute it and/or modify | 
 | 10 |   it under the terms of the GNU General Public License as published by | 
 | 11 |   the Free Software Foundation; either version 2 of the License, or | 
 | 12 |   (at your option) any later version. | 
 | 13 |  | 
 | 14 |   This program is distributed in the hope that it will be useful, | 
 | 15 |   but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 16 |   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 17 |   GNU General Public License for more details. | 
 | 18 |  | 
 | 19 |   You should have received a copy of the GNU General Public License | 
 | 20 |   along with this program; if not, write to the Free Software | 
 | 21 |   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
 | 22 | */ | 
 | 23 |  | 
 | 24 | #include <linux/module.h> | 
 | 25 | #include <linux/init.h> | 
 | 26 | #include <linux/slab.h> | 
 | 27 | #include <linux/jiffies.h> | 
 | 28 | #include <linux/i2c.h> | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 29 | #include <linux/hwmon.h> | 
 | 30 | #include <linux/err.h> | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 31 | #include <linux/mutex.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 |  | 
 | 33 | /* Following macros takes channel parameter starting from 0 to 2 */ | 
 | 34 | #define ADM1031_REG_FAN_SPEED(nr)	(0x08 + (nr)) | 
 | 35 | #define ADM1031_REG_FAN_DIV(nr)		(0x20  + (nr)) | 
 | 36 | #define ADM1031_REG_PWM			(0x22) | 
 | 37 | #define ADM1031_REG_FAN_MIN(nr)		(0x10 + (nr)) | 
 | 38 |  | 
 | 39 | #define ADM1031_REG_TEMP_MAX(nr)	(0x14  + 4*(nr)) | 
 | 40 | #define ADM1031_REG_TEMP_MIN(nr)	(0x15  + 4*(nr)) | 
 | 41 | #define ADM1031_REG_TEMP_CRIT(nr)	(0x16  + 4*(nr)) | 
 | 42 |  | 
 | 43 | #define ADM1031_REG_TEMP(nr)		(0xa + (nr)) | 
 | 44 | #define ADM1031_REG_AUTO_TEMP(nr)	(0x24 + (nr)) | 
 | 45 |  | 
 | 46 | #define ADM1031_REG_STATUS(nr)		(0x2 + (nr)) | 
 | 47 |  | 
 | 48 | #define ADM1031_REG_CONF1		0x0 | 
 | 49 | #define ADM1031_REG_CONF2		0x1 | 
 | 50 | #define ADM1031_REG_EXT_TEMP		0x6 | 
 | 51 |  | 
 | 52 | #define ADM1031_CONF1_MONITOR_ENABLE	0x01	/* Monitoring enable */ | 
 | 53 | #define ADM1031_CONF1_PWM_INVERT	0x08	/* PWM Invert */ | 
 | 54 | #define ADM1031_CONF1_AUTO_MODE		0x80	/* Auto FAN */ | 
 | 55 |  | 
 | 56 | #define ADM1031_CONF2_PWM1_ENABLE	0x01 | 
 | 57 | #define ADM1031_CONF2_PWM2_ENABLE	0x02 | 
 | 58 | #define ADM1031_CONF2_TACH1_ENABLE	0x04 | 
 | 59 | #define ADM1031_CONF2_TACH2_ENABLE	0x08 | 
 | 60 | #define ADM1031_CONF2_TEMP_ENABLE(chan)	(0x10 << (chan)) | 
 | 61 |  | 
 | 62 | /* Addresses to scan */ | 
 | 63 | static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 |  | 
 | 65 | /* Insmod parameters */ | 
| Jean Delvare | f4b5026 | 2005-07-31 21:49:03 +0200 | [diff] [blame] | 66 | I2C_CLIENT_INSMOD_2(adm1030, adm1031); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 |  | 
 | 68 | typedef u8 auto_chan_table_t[8][2]; | 
 | 69 |  | 
 | 70 | /* Each client has this additional data */ | 
 | 71 | struct adm1031_data { | 
 | 72 | 	struct i2c_client client; | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 73 | 	struct class_device *class_dev; | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 74 | 	struct mutex update_lock; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | 	int chip_type; | 
 | 76 | 	char valid;		/* !=0 if following fields are valid */ | 
 | 77 | 	unsigned long last_updated;	/* In jiffies */ | 
 | 78 | 	/* The chan_select_table contains the possible configurations for | 
 | 79 | 	 * auto fan control. | 
 | 80 | 	 */ | 
 | 81 | 	auto_chan_table_t *chan_select_table; | 
 | 82 | 	u16 alarm; | 
 | 83 | 	u8 conf1; | 
 | 84 | 	u8 conf2; | 
 | 85 | 	u8 fan[2]; | 
 | 86 | 	u8 fan_div[2]; | 
 | 87 | 	u8 fan_min[2]; | 
 | 88 | 	u8 pwm[2]; | 
 | 89 | 	u8 old_pwm[2]; | 
 | 90 | 	s8 temp[3]; | 
 | 91 | 	u8 ext_temp[3]; | 
 | 92 | 	u8 auto_temp[3]; | 
 | 93 | 	u8 auto_temp_min[3]; | 
 | 94 | 	u8 auto_temp_off[3]; | 
 | 95 | 	u8 auto_temp_max[3]; | 
 | 96 | 	s8 temp_min[3]; | 
 | 97 | 	s8 temp_max[3]; | 
 | 98 | 	s8 temp_crit[3]; | 
 | 99 | }; | 
 | 100 |  | 
 | 101 | static int adm1031_attach_adapter(struct i2c_adapter *adapter); | 
 | 102 | static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind); | 
 | 103 | static void adm1031_init_client(struct i2c_client *client); | 
 | 104 | static int adm1031_detach_client(struct i2c_client *client); | 
 | 105 | static struct adm1031_data *adm1031_update_device(struct device *dev); | 
 | 106 |  | 
 | 107 | /* This is the driver that will be inserted */ | 
 | 108 | static struct i2c_driver adm1031_driver = { | 
| Laurent Riffard | cdaf793 | 2005-11-26 20:37:41 +0100 | [diff] [blame] | 109 | 	.driver = { | 
| Laurent Riffard | cdaf793 | 2005-11-26 20:37:41 +0100 | [diff] [blame] | 110 | 		.name = "adm1031", | 
 | 111 | 	}, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | 	.attach_adapter = adm1031_attach_adapter, | 
 | 113 | 	.detach_client = adm1031_detach_client, | 
 | 114 | }; | 
 | 115 |  | 
 | 116 | static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg) | 
 | 117 | { | 
 | 118 | 	return i2c_smbus_read_byte_data(client, reg); | 
 | 119 | } | 
 | 120 |  | 
 | 121 | static inline int | 
 | 122 | adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value) | 
 | 123 | { | 
 | 124 | 	return i2c_smbus_write_byte_data(client, reg, value); | 
 | 125 | } | 
 | 126 |  | 
 | 127 |  | 
 | 128 | #define TEMP_TO_REG(val)		(((val) < 0 ? ((val - 500) / 1000) : \ | 
 | 129 | 					((val + 500) / 1000))) | 
 | 130 |  | 
 | 131 | #define TEMP_FROM_REG(val)		((val) * 1000) | 
 | 132 |  | 
 | 133 | #define TEMP_FROM_REG_EXT(val, ext)	(TEMP_FROM_REG(val) + (ext) * 125) | 
 | 134 |  | 
 | 135 | #define FAN_FROM_REG(reg, div)		((reg) ? (11250 * 60) / ((reg) * (div)) : 0) | 
 | 136 |  | 
 | 137 | static int FAN_TO_REG(int reg, int div) | 
 | 138 | { | 
 | 139 | 	int tmp; | 
 | 140 | 	tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div); | 
 | 141 | 	return tmp > 255 ? 255 : tmp; | 
 | 142 | } | 
 | 143 |  | 
 | 144 | #define FAN_DIV_FROM_REG(reg)		(1<<(((reg)&0xc0)>>6)) | 
 | 145 |  | 
 | 146 | #define PWM_TO_REG(val)			(SENSORS_LIMIT((val), 0, 255) >> 4) | 
 | 147 | #define PWM_FROM_REG(val)		((val) << 4) | 
 | 148 |  | 
 | 149 | #define FAN_CHAN_FROM_REG(reg)		(((reg) >> 5) & 7) | 
 | 150 | #define FAN_CHAN_TO_REG(val, reg)	\ | 
 | 151 | 	(((reg) & 0x1F) | (((val) << 5) & 0xe0)) | 
 | 152 |  | 
 | 153 | #define AUTO_TEMP_MIN_TO_REG(val, reg)	\ | 
 | 154 | 	((((val)/500) & 0xf8)|((reg) & 0x7)) | 
 | 155 | #define AUTO_TEMP_RANGE_FROM_REG(reg)	(5000 * (1<< ((reg)&0x7))) | 
 | 156 | #define AUTO_TEMP_MIN_FROM_REG(reg)	(1000 * ((((reg) >> 3) & 0x1f) << 2)) | 
 | 157 |  | 
 | 158 | #define AUTO_TEMP_MIN_FROM_REG_DEG(reg)	((((reg) >> 3) & 0x1f) << 2) | 
 | 159 |  | 
 | 160 | #define AUTO_TEMP_OFF_FROM_REG(reg)		\ | 
 | 161 | 	(AUTO_TEMP_MIN_FROM_REG(reg) - 5000) | 
 | 162 |  | 
 | 163 | #define AUTO_TEMP_MAX_FROM_REG(reg)		\ | 
 | 164 | 	(AUTO_TEMP_RANGE_FROM_REG(reg) +	\ | 
 | 165 | 	AUTO_TEMP_MIN_FROM_REG(reg)) | 
 | 166 |  | 
 | 167 | static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm) | 
 | 168 | { | 
 | 169 | 	int ret; | 
 | 170 | 	int range = val - AUTO_TEMP_MIN_FROM_REG(reg); | 
 | 171 |  | 
 | 172 | 	range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm); | 
 | 173 | 	ret = ((reg & 0xf8) | | 
 | 174 | 	       (range < 10000 ? 0 : | 
 | 175 | 		range < 20000 ? 1 : | 
 | 176 | 		range < 40000 ? 2 : range < 80000 ? 3 : 4)); | 
 | 177 | 	return ret; | 
 | 178 | } | 
 | 179 |  | 
 | 180 | /* FAN auto control */ | 
 | 181 | #define GET_FAN_AUTO_BITFIELD(data, idx)	\ | 
 | 182 | 	(*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2] | 
 | 183 |  | 
 | 184 | /* The tables below contains the possible values for the auto fan  | 
 | 185 |  * control bitfields. the index in the table is the register value. | 
 | 186 |  * MSb is the auto fan control enable bit, so the four first entries | 
 | 187 |  * in the table disables auto fan control when both bitfields are zero. | 
 | 188 |  */ | 
 | 189 | static auto_chan_table_t auto_channel_select_table_adm1031 = { | 
 | 190 | 	{0, 0}, {0, 0}, {0, 0}, {0, 0}, | 
 | 191 | 	{2 /*0b010 */ , 4 /*0b100 */ }, | 
 | 192 | 	{2 /*0b010 */ , 2 /*0b010 */ }, | 
 | 193 | 	{4 /*0b100 */ , 4 /*0b100 */ }, | 
 | 194 | 	{7 /*0b111 */ , 7 /*0b111 */ }, | 
 | 195 | }; | 
 | 196 |  | 
 | 197 | static auto_chan_table_t auto_channel_select_table_adm1030 = { | 
 | 198 | 	{0, 0}, {0, 0}, {0, 0}, {0, 0}, | 
 | 199 | 	{2 /*0b10 */		, 0}, | 
 | 200 | 	{0xff /*invalid */	, 0}, | 
 | 201 | 	{0xff /*invalid */	, 0}, | 
 | 202 | 	{3 /*0b11 */		, 0}, | 
 | 203 | }; | 
 | 204 |  | 
 | 205 | /* That function checks if a bitfield is valid and returns the other bitfield | 
 | 206 |  * nearest match if no exact match where found. | 
 | 207 |  */ | 
 | 208 | static int | 
 | 209 | get_fan_auto_nearest(struct adm1031_data *data, | 
 | 210 | 		     int chan, u8 val, u8 reg, u8 * new_reg) | 
 | 211 | { | 
 | 212 | 	int i; | 
 | 213 | 	int first_match = -1, exact_match = -1; | 
 | 214 | 	u8 other_reg_val = | 
 | 215 | 	    (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1]; | 
 | 216 |  | 
 | 217 | 	if (val == 0) { | 
 | 218 | 		*new_reg = 0; | 
 | 219 | 		return 0; | 
 | 220 | 	} | 
 | 221 |  | 
 | 222 | 	for (i = 0; i < 8; i++) { | 
 | 223 | 		if ((val == (*data->chan_select_table)[i][chan]) && | 
 | 224 | 		    ((*data->chan_select_table)[i][chan ? 0 : 1] == | 
 | 225 | 		     other_reg_val)) { | 
 | 226 | 			/* We found an exact match */ | 
 | 227 | 			exact_match = i; | 
 | 228 | 			break; | 
 | 229 | 		} else if (val == (*data->chan_select_table)[i][chan] && | 
 | 230 | 			   first_match == -1) { | 
 | 231 | 			/* Save the first match in case of an exact match has not been | 
 | 232 | 			 * found  | 
 | 233 | 			 */ | 
 | 234 | 			first_match = i; | 
 | 235 | 		} | 
 | 236 | 	} | 
 | 237 |  | 
 | 238 | 	if (exact_match >= 0) { | 
 | 239 | 		*new_reg = exact_match; | 
 | 240 | 	} else if (first_match >= 0) { | 
 | 241 | 		*new_reg = first_match; | 
 | 242 | 	} else { | 
 | 243 | 		return -EINVAL; | 
 | 244 | 	} | 
 | 245 | 	return 0; | 
 | 246 | } | 
 | 247 |  | 
 | 248 | static ssize_t show_fan_auto_channel(struct device *dev, char *buf, int nr) | 
 | 249 | { | 
 | 250 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 251 | 	return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr)); | 
 | 252 | } | 
 | 253 |  | 
 | 254 | static ssize_t | 
 | 255 | set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr) | 
 | 256 | { | 
 | 257 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 258 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 259 | 	int val = simple_strtol(buf, NULL, 10); | 
 | 260 | 	u8 reg; | 
 | 261 | 	int ret; | 
 | 262 | 	u8 old_fan_mode; | 
 | 263 |  | 
 | 264 | 	old_fan_mode = data->conf1; | 
 | 265 |  | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 266 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 267 | 	 | 
 | 268 | 	if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, ®))) { | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 269 | 		mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 270 | 		return ret; | 
 | 271 | 	} | 
 | 272 | 	if (((data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1)) & ADM1031_CONF1_AUTO_MODE) ^  | 
 | 273 | 	    (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) { | 
 | 274 | 		if (data->conf1 & ADM1031_CONF1_AUTO_MODE){ | 
 | 275 | 			/* Switch to Auto Fan Mode  | 
 | 276 | 			 * Save PWM registers  | 
 | 277 | 			 * Set PWM registers to 33% Both */ | 
 | 278 | 			data->old_pwm[0] = data->pwm[0]; | 
 | 279 | 			data->old_pwm[1] = data->pwm[1]; | 
 | 280 | 			adm1031_write_value(client, ADM1031_REG_PWM, 0x55); | 
 | 281 | 		} else { | 
 | 282 | 			/* Switch to Manual Mode */ | 
 | 283 | 			data->pwm[0] = data->old_pwm[0]; | 
 | 284 | 			data->pwm[1] = data->old_pwm[1]; | 
 | 285 | 			/* Restore PWM registers */ | 
 | 286 | 			adm1031_write_value(client, ADM1031_REG_PWM,  | 
 | 287 | 					    data->pwm[0] | (data->pwm[1] << 4)); | 
 | 288 | 		} | 
 | 289 | 	} | 
 | 290 | 	data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1); | 
 | 291 | 	adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 292 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 293 | 	return count; | 
 | 294 | } | 
 | 295 |  | 
 | 296 | #define fan_auto_channel_offset(offset)						\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 297 | static ssize_t show_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 298 | {										\ | 
 | 299 | 	return show_fan_auto_channel(dev, buf, offset - 1);			\ | 
 | 300 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 301 | static ssize_t set_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr,		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 302 | 	const char *buf, size_t count)						\ | 
 | 303 | {										\ | 
 | 304 | 	return set_fan_auto_channel(dev, buf, count, offset - 1);		\ | 
 | 305 | }										\ | 
 | 306 | static DEVICE_ATTR(auto_fan##offset##_channel, S_IRUGO | S_IWUSR,		\ | 
 | 307 | 		   show_fan_auto_channel_##offset,				\ | 
 | 308 | 		   set_fan_auto_channel_##offset) | 
 | 309 |  | 
 | 310 | fan_auto_channel_offset(1); | 
 | 311 | fan_auto_channel_offset(2); | 
 | 312 |  | 
 | 313 | /* Auto Temps */ | 
 | 314 | static ssize_t show_auto_temp_off(struct device *dev, char *buf, int nr) | 
 | 315 | { | 
 | 316 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 317 | 	return sprintf(buf, "%d\n",  | 
 | 318 | 		       AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr])); | 
 | 319 | } | 
 | 320 | static ssize_t show_auto_temp_min(struct device *dev, char *buf, int nr) | 
 | 321 | { | 
 | 322 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 323 | 	return sprintf(buf, "%d\n", | 
 | 324 | 		       AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr])); | 
 | 325 | } | 
 | 326 | static ssize_t | 
 | 327 | set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr) | 
 | 328 | { | 
 | 329 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 330 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 331 | 	int val = simple_strtol(buf, NULL, 10); | 
 | 332 |  | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 333 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 334 | 	data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]); | 
 | 335 | 	adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr), | 
 | 336 | 			    data->auto_temp[nr]); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 337 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 338 | 	return count; | 
 | 339 | } | 
 | 340 | static ssize_t show_auto_temp_max(struct device *dev, char *buf, int nr) | 
 | 341 | { | 
 | 342 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 343 | 	return sprintf(buf, "%d\n", | 
 | 344 | 		       AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr])); | 
 | 345 | } | 
 | 346 | static ssize_t | 
 | 347 | set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr) | 
 | 348 | { | 
 | 349 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 350 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 351 | 	int val = simple_strtol(buf, NULL, 10); | 
 | 352 |  | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 353 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | 	data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]); | 
 | 355 | 	adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr), | 
 | 356 | 			    data->temp_max[nr]); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 357 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 358 | 	return count; | 
 | 359 | } | 
 | 360 |  | 
 | 361 | #define auto_temp_reg(offset)							\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 362 | static ssize_t show_auto_temp_##offset##_off (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | {										\ | 
 | 364 | 	return show_auto_temp_off(dev, buf, offset - 1);			\ | 
 | 365 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 366 | static ssize_t show_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | {										\ | 
 | 368 | 	return show_auto_temp_min(dev, buf, offset - 1);			\ | 
 | 369 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 370 | static ssize_t show_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 371 | {										\ | 
 | 372 | 	return show_auto_temp_max(dev, buf, offset - 1);			\ | 
 | 373 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 374 | static ssize_t set_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr,		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | 					     const char *buf, size_t count)	\ | 
 | 376 | {										\ | 
 | 377 | 	return set_auto_temp_min(dev, buf, count, offset - 1);		\ | 
 | 378 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 379 | static ssize_t set_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr,		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 380 | 					     const char *buf, size_t count)	\ | 
 | 381 | {										\ | 
 | 382 | 	return set_auto_temp_max(dev, buf, count, offset - 1);		\ | 
 | 383 | }										\ | 
 | 384 | static DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO,				\ | 
 | 385 | 		   show_auto_temp_##offset##_off, NULL);			\ | 
 | 386 | static DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR,			\ | 
 | 387 | 		   show_auto_temp_##offset##_min, set_auto_temp_##offset##_min);\ | 
 | 388 | static DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR,			\ | 
 | 389 | 		   show_auto_temp_##offset##_max, set_auto_temp_##offset##_max) | 
 | 390 |  | 
 | 391 | auto_temp_reg(1); | 
 | 392 | auto_temp_reg(2); | 
 | 393 | auto_temp_reg(3); | 
 | 394 |  | 
 | 395 | /* pwm */ | 
 | 396 | static ssize_t show_pwm(struct device *dev, char *buf, int nr) | 
 | 397 | { | 
 | 398 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 399 | 	return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr])); | 
 | 400 | } | 
 | 401 | static ssize_t | 
 | 402 | set_pwm(struct device *dev, const char *buf, size_t count, int nr) | 
 | 403 | { | 
 | 404 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 405 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 406 | 	int val = simple_strtol(buf, NULL, 10); | 
 | 407 | 	int reg; | 
 | 408 |  | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 409 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 410 | 	if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) &&  | 
 | 411 | 	    (((val>>4) & 0xf) != 5)) { | 
 | 412 | 		/* In automatic mode, the only PWM accepted is 33% */ | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 413 | 		mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 414 | 		return -EINVAL; | 
 | 415 | 	} | 
 | 416 | 	data->pwm[nr] = PWM_TO_REG(val); | 
 | 417 | 	reg = adm1031_read_value(client, ADM1031_REG_PWM); | 
 | 418 | 	adm1031_write_value(client, ADM1031_REG_PWM, | 
 | 419 | 			    nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf) | 
 | 420 | 			    : (data->pwm[nr] & 0xf) | (reg & 0xf0)); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 421 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 422 | 	return count; | 
 | 423 | } | 
 | 424 |  | 
 | 425 | #define pwm_reg(offset)							\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 426 | static ssize_t show_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 427 | {									\ | 
 | 428 | 	return show_pwm(dev, buf, offset - 1);			\ | 
 | 429 | }									\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 430 | static ssize_t set_pwm_##offset (struct device *dev, struct device_attribute *attr,			\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | 				 const char *buf, size_t count)		\ | 
 | 432 | {									\ | 
 | 433 | 	return set_pwm(dev, buf, count, offset - 1);		\ | 
 | 434 | }									\ | 
 | 435 | static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR,			\ | 
 | 436 | 		   show_pwm_##offset, set_pwm_##offset) | 
 | 437 |  | 
 | 438 | pwm_reg(1); | 
 | 439 | pwm_reg(2); | 
 | 440 |  | 
 | 441 | /* Fans */ | 
 | 442 |  | 
 | 443 | /* | 
 | 444 |  * That function checks the cases where the fan reading is not | 
| Steven Cole | 44bbe87 | 2005-05-03 18:21:25 -0600 | [diff] [blame] | 445 |  * relevant.  It is used to provide 0 as fan reading when the fan is | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 446 |  * not supposed to run | 
 | 447 |  */ | 
 | 448 | static int trust_fan_readings(struct adm1031_data *data, int chan) | 
 | 449 | { | 
 | 450 | 	int res = 0; | 
 | 451 |  | 
 | 452 | 	if (data->conf1 & ADM1031_CONF1_AUTO_MODE) { | 
 | 453 | 		switch (data->conf1 & 0x60) { | 
 | 454 | 		case 0x00:	/* remote temp1 controls fan1 remote temp2 controls fan2 */ | 
 | 455 | 			res = data->temp[chan+1] >= | 
 | 456 | 			      AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]); | 
 | 457 | 			break; | 
 | 458 | 		case 0x20:	/* remote temp1 controls both fans */ | 
 | 459 | 			res = | 
 | 460 | 			    data->temp[1] >= | 
 | 461 | 			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]); | 
 | 462 | 			break; | 
 | 463 | 		case 0x40:	/* remote temp2 controls both fans */ | 
 | 464 | 			res = | 
 | 465 | 			    data->temp[2] >= | 
 | 466 | 			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]); | 
 | 467 | 			break; | 
 | 468 | 		case 0x60:	/* max controls both fans */ | 
 | 469 | 			res = | 
 | 470 | 			    data->temp[0] >= | 
 | 471 | 			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0]) | 
 | 472 | 			    || data->temp[1] >= | 
 | 473 | 			    AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]) | 
 | 474 | 			    || (data->chip_type == adm1031  | 
 | 475 | 				&& data->temp[2] >= | 
 | 476 | 				AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2])); | 
 | 477 | 			break; | 
 | 478 | 		} | 
 | 479 | 	} else { | 
 | 480 | 		res = data->pwm[chan] > 0; | 
 | 481 | 	} | 
 | 482 | 	return res; | 
 | 483 | } | 
 | 484 |  | 
 | 485 |  | 
 | 486 | static ssize_t show_fan(struct device *dev, char *buf, int nr) | 
 | 487 | { | 
 | 488 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 489 | 	int value; | 
 | 490 |  | 
 | 491 | 	value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr], | 
 | 492 | 				 FAN_DIV_FROM_REG(data->fan_div[nr])) : 0; | 
 | 493 | 	return sprintf(buf, "%d\n", value); | 
 | 494 | } | 
 | 495 |  | 
 | 496 | static ssize_t show_fan_div(struct device *dev, char *buf, int nr) | 
 | 497 | { | 
 | 498 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 499 | 	return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr])); | 
 | 500 | } | 
 | 501 | static ssize_t show_fan_min(struct device *dev, char *buf, int nr) | 
 | 502 | { | 
 | 503 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 504 | 	return sprintf(buf, "%d\n", | 
 | 505 | 		       FAN_FROM_REG(data->fan_min[nr], | 
 | 506 | 				    FAN_DIV_FROM_REG(data->fan_div[nr]))); | 
 | 507 | } | 
 | 508 | static ssize_t | 
 | 509 | set_fan_min(struct device *dev, const char *buf, size_t count, int nr) | 
 | 510 | { | 
 | 511 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 512 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 513 | 	int val = simple_strtol(buf, NULL, 10); | 
 | 514 |  | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 515 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 516 | 	if (val) { | 
 | 517 | 		data->fan_min[nr] =  | 
 | 518 | 			FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr])); | 
 | 519 | 	} else { | 
 | 520 | 		data->fan_min[nr] = 0xff; | 
 | 521 | 	} | 
 | 522 | 	adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), data->fan_min[nr]); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 523 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 524 | 	return count; | 
 | 525 | } | 
 | 526 | static ssize_t | 
 | 527 | set_fan_div(struct device *dev, const char *buf, size_t count, int nr) | 
 | 528 | { | 
 | 529 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 530 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 531 | 	int val = simple_strtol(buf, NULL, 10); | 
 | 532 | 	u8 tmp; | 
 | 533 | 	int old_div; | 
 | 534 | 	int new_min; | 
 | 535 |  | 
 | 536 | 	tmp = val == 8 ? 0xc0 : | 
 | 537 | 	      val == 4 ? 0x80 : | 
 | 538 | 	      val == 2 ? 0x40 :	 | 
 | 539 | 	      val == 1 ? 0x00 :   | 
 | 540 | 	      0xff; | 
 | 541 | 	if (tmp == 0xff) | 
 | 542 | 		return -EINVAL; | 
 | 543 | 	 | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 544 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 545 | 	old_div = FAN_DIV_FROM_REG(data->fan_div[nr]); | 
 | 546 | 	data->fan_div[nr] = (tmp & 0xC0) | (0x3f & data->fan_div[nr]); | 
 | 547 | 	new_min = data->fan_min[nr] * old_div /  | 
 | 548 | 		FAN_DIV_FROM_REG(data->fan_div[nr]); | 
 | 549 | 	data->fan_min[nr] = new_min > 0xff ? 0xff : new_min; | 
 | 550 | 	data->fan[nr] = data->fan[nr] * old_div /  | 
 | 551 | 		FAN_DIV_FROM_REG(data->fan_div[nr]); | 
 | 552 |  | 
 | 553 | 	adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr),  | 
 | 554 | 			    data->fan_div[nr]); | 
 | 555 | 	adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr),  | 
 | 556 | 			    data->fan_min[nr]); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 557 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | 	return count; | 
 | 559 | } | 
 | 560 |  | 
 | 561 | #define fan_offset(offset)						\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 562 | static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 563 | {									\ | 
 | 564 | 	return show_fan(dev, buf, offset - 1);			\ | 
 | 565 | }									\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 566 | static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 567 | {									\ | 
 | 568 | 	return show_fan_min(dev, buf, offset - 1);			\ | 
 | 569 | }									\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 570 | static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 571 | {									\ | 
 | 572 | 	return show_fan_div(dev, buf, offset - 1);			\ | 
 | 573 | }									\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 574 | static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr,		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 575 | 	const char *buf, size_t count)					\ | 
 | 576 | {									\ | 
 | 577 | 	return set_fan_min(dev, buf, count, offset - 1);		\ | 
 | 578 | }									\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 579 | static ssize_t set_fan_##offset##_div (struct device *dev, struct device_attribute *attr,		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 580 | 	const char *buf, size_t count)					\ | 
 | 581 | {									\ | 
 | 582 | 	return set_fan_div(dev, buf, count, offset - 1);		\ | 
 | 583 | }									\ | 
 | 584 | static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset,	\ | 
 | 585 | 		   NULL);						\ | 
 | 586 | static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,		\ | 
 | 587 | 		   show_fan_##offset##_min, set_fan_##offset##_min);	\ | 
 | 588 | static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,		\ | 
 | 589 | 		   show_fan_##offset##_div, set_fan_##offset##_div);	\ | 
 | 590 | static DEVICE_ATTR(auto_fan##offset##_min_pwm, S_IRUGO | S_IWUSR,	\ | 
 | 591 | 		   show_pwm_##offset, set_pwm_##offset) | 
 | 592 |  | 
 | 593 | fan_offset(1); | 
 | 594 | fan_offset(2); | 
 | 595 |  | 
 | 596 |  | 
 | 597 | /* Temps */ | 
 | 598 | static ssize_t show_temp(struct device *dev, char *buf, int nr) | 
 | 599 | { | 
 | 600 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 601 | 	int ext; | 
 | 602 | 	ext = nr == 0 ? | 
 | 603 | 	    ((data->ext_temp[nr] >> 6) & 0x3) * 2 : | 
 | 604 | 	    (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7)); | 
 | 605 | 	return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext)); | 
 | 606 | } | 
 | 607 | static ssize_t show_temp_min(struct device *dev, char *buf, int nr) | 
 | 608 | { | 
 | 609 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 610 | 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr])); | 
 | 611 | } | 
 | 612 | static ssize_t show_temp_max(struct device *dev, char *buf, int nr) | 
 | 613 | { | 
 | 614 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 615 | 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr])); | 
 | 616 | } | 
 | 617 | static ssize_t show_temp_crit(struct device *dev, char *buf, int nr) | 
 | 618 | { | 
 | 619 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 620 | 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr])); | 
 | 621 | } | 
 | 622 | static ssize_t | 
 | 623 | set_temp_min(struct device *dev, const char *buf, size_t count, int nr) | 
 | 624 | { | 
 | 625 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 626 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 627 | 	int val; | 
 | 628 |  | 
 | 629 | 	val = simple_strtol(buf, NULL, 10); | 
 | 630 | 	val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 631 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 632 | 	data->temp_min[nr] = TEMP_TO_REG(val); | 
 | 633 | 	adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr), | 
 | 634 | 			    data->temp_min[nr]); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 635 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 636 | 	return count; | 
 | 637 | } | 
 | 638 | static ssize_t | 
 | 639 | set_temp_max(struct device *dev, const char *buf, size_t count, int nr) | 
 | 640 | { | 
 | 641 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 642 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 643 | 	int val; | 
 | 644 |  | 
 | 645 | 	val = simple_strtol(buf, NULL, 10); | 
 | 646 | 	val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 647 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 648 | 	data->temp_max[nr] = TEMP_TO_REG(val); | 
 | 649 | 	adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr), | 
 | 650 | 			    data->temp_max[nr]); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 651 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 652 | 	return count; | 
 | 653 | } | 
 | 654 | static ssize_t | 
 | 655 | set_temp_crit(struct device *dev, const char *buf, size_t count, int nr) | 
 | 656 | { | 
 | 657 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 658 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 659 | 	int val; | 
 | 660 |  | 
 | 661 | 	val = simple_strtol(buf, NULL, 10); | 
 | 662 | 	val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 663 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 664 | 	data->temp_crit[nr] = TEMP_TO_REG(val); | 
 | 665 | 	adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr), | 
 | 666 | 			    data->temp_crit[nr]); | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 667 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 668 | 	return count; | 
 | 669 | } | 
 | 670 |  | 
 | 671 | #define temp_reg(offset)							\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 672 | static ssize_t show_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf)		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 673 | {										\ | 
 | 674 | 	return show_temp(dev, buf, offset - 1);				\ | 
 | 675 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 676 | static ssize_t show_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 677 | {										\ | 
 | 678 | 	return show_temp_min(dev, buf, offset - 1);				\ | 
 | 679 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 680 | static ssize_t show_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)		\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 681 | {										\ | 
 | 682 | 	return show_temp_max(dev, buf, offset - 1);				\ | 
 | 683 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 684 | static ssize_t show_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, char *buf)	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 685 | {										\ | 
 | 686 | 	return show_temp_crit(dev, buf, offset - 1);			\ | 
 | 687 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 688 | static ssize_t set_temp_##offset##_min (struct device *dev, struct device_attribute *attr,			\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 689 | 					const char *buf, size_t count)		\ | 
 | 690 | {										\ | 
 | 691 | 	return set_temp_min(dev, buf, count, offset - 1);			\ | 
 | 692 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 693 | static ssize_t set_temp_##offset##_max (struct device *dev, struct device_attribute *attr,			\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 694 | 					const char *buf, size_t count)		\ | 
 | 695 | {										\ | 
 | 696 | 	return set_temp_max(dev, buf, count, offset - 1);			\ | 
 | 697 | }										\ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 698 | static ssize_t set_temp_##offset##_crit (struct device *dev, struct device_attribute *attr,			\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 699 | 					 const char *buf, size_t count)		\ | 
 | 700 | {										\ | 
 | 701 | 	return set_temp_crit(dev, buf, count, offset - 1);			\ | 
 | 702 | }										\ | 
 | 703 | static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp_##offset,		\ | 
 | 704 | 		   NULL);							\ | 
 | 705 | static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR,			\ | 
 | 706 | 		   show_temp_##offset##_min, set_temp_##offset##_min);		\ | 
 | 707 | static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,			\ | 
 | 708 | 		   show_temp_##offset##_max, set_temp_##offset##_max);		\ | 
 | 709 | static DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR,			\ | 
 | 710 | 		   show_temp_##offset##_crit, set_temp_##offset##_crit) | 
 | 711 |  | 
 | 712 | temp_reg(1); | 
 | 713 | temp_reg(2); | 
 | 714 | temp_reg(3); | 
 | 715 |  | 
 | 716 | /* Alarms */ | 
| Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 717 | static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | { | 
 | 719 | 	struct adm1031_data *data = adm1031_update_device(dev); | 
 | 720 | 	return sprintf(buf, "%d\n", data->alarm); | 
 | 721 | } | 
 | 722 |  | 
 | 723 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 
 | 724 |  | 
 | 725 |  | 
 | 726 | static int adm1031_attach_adapter(struct i2c_adapter *adapter) | 
 | 727 | { | 
 | 728 | 	if (!(adapter->class & I2C_CLASS_HWMON)) | 
 | 729 | 		return 0; | 
| Jean Delvare | 2ed2dc3 | 2005-07-31 21:42:02 +0200 | [diff] [blame] | 730 | 	return i2c_probe(adapter, &addr_data, adm1031_detect); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 731 | } | 
 | 732 |  | 
| Jean Delvare | 2ed2dc3 | 2005-07-31 21:42:02 +0200 | [diff] [blame] | 733 | /* This function is called by i2c_probe */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 734 | static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind) | 
 | 735 | { | 
 | 736 | 	struct i2c_client *new_client; | 
 | 737 | 	struct adm1031_data *data; | 
 | 738 | 	int err = 0; | 
 | 739 | 	const char *name = ""; | 
 | 740 |  | 
 | 741 | 	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) | 
 | 742 | 		goto exit; | 
 | 743 |  | 
| Deepak Saxena | ba9c2e8 | 2005-10-17 23:08:32 +0200 | [diff] [blame] | 744 | 	if (!(data = kzalloc(sizeof(struct adm1031_data), GFP_KERNEL))) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 745 | 		err = -ENOMEM; | 
 | 746 | 		goto exit; | 
 | 747 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 748 |  | 
 | 749 | 	new_client = &data->client; | 
 | 750 | 	i2c_set_clientdata(new_client, data); | 
 | 751 | 	new_client->addr = address; | 
 | 752 | 	new_client->adapter = adapter; | 
 | 753 | 	new_client->driver = &adm1031_driver; | 
 | 754 | 	new_client->flags = 0; | 
 | 755 |  | 
 | 756 | 	if (kind < 0) { | 
 | 757 | 		int id, co; | 
 | 758 | 		id = i2c_smbus_read_byte_data(new_client, 0x3d); | 
 | 759 | 		co = i2c_smbus_read_byte_data(new_client, 0x3e); | 
 | 760 |  | 
 | 761 | 		if (!((id == 0x31 || id == 0x30) && co == 0x41)) | 
 | 762 | 			goto exit_free; | 
 | 763 | 		kind = (id == 0x30) ? adm1030 : adm1031; | 
 | 764 | 	} | 
 | 765 |  | 
 | 766 | 	if (kind <= 0) | 
 | 767 | 		kind = adm1031; | 
 | 768 |  | 
 | 769 | 	/* Given the detected chip type, set the chip name and the | 
 | 770 | 	 * auto fan control helper table. */ | 
 | 771 | 	if (kind == adm1030) { | 
 | 772 | 		name = "adm1030"; | 
 | 773 | 		data->chan_select_table = &auto_channel_select_table_adm1030; | 
 | 774 | 	} else if (kind == adm1031) { | 
 | 775 | 		name = "adm1031"; | 
 | 776 | 		data->chan_select_table = &auto_channel_select_table_adm1031; | 
 | 777 | 	} | 
 | 778 | 	data->chip_type = kind; | 
 | 779 |  | 
 | 780 | 	strlcpy(new_client->name, name, I2C_NAME_SIZE); | 
 | 781 | 	data->valid = 0; | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 782 | 	mutex_init(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 783 |  | 
 | 784 | 	/* Tell the I2C layer a new client has arrived */ | 
 | 785 | 	if ((err = i2c_attach_client(new_client))) | 
 | 786 | 		goto exit_free; | 
 | 787 |  | 
 | 788 | 	/* Initialize the ADM1031 chip */ | 
 | 789 | 	adm1031_init_client(new_client); | 
 | 790 |  | 
 | 791 | 	/* Register sysfs hooks */ | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 792 | 	data->class_dev = hwmon_device_register(&new_client->dev); | 
 | 793 | 	if (IS_ERR(data->class_dev)) { | 
 | 794 | 		err = PTR_ERR(data->class_dev); | 
 | 795 | 		goto exit_detach; | 
 | 796 | 	} | 
 | 797 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 798 | 	device_create_file(&new_client->dev, &dev_attr_fan1_input); | 
 | 799 | 	device_create_file(&new_client->dev, &dev_attr_fan1_div); | 
 | 800 | 	device_create_file(&new_client->dev, &dev_attr_fan1_min); | 
 | 801 | 	device_create_file(&new_client->dev, &dev_attr_pwm1); | 
 | 802 | 	device_create_file(&new_client->dev, &dev_attr_auto_fan1_channel); | 
 | 803 | 	device_create_file(&new_client->dev, &dev_attr_temp1_input); | 
 | 804 | 	device_create_file(&new_client->dev, &dev_attr_temp1_min); | 
 | 805 | 	device_create_file(&new_client->dev, &dev_attr_temp1_max); | 
 | 806 | 	device_create_file(&new_client->dev, &dev_attr_temp1_crit); | 
 | 807 | 	device_create_file(&new_client->dev, &dev_attr_temp2_input); | 
 | 808 | 	device_create_file(&new_client->dev, &dev_attr_temp2_min); | 
 | 809 | 	device_create_file(&new_client->dev, &dev_attr_temp2_max); | 
 | 810 | 	device_create_file(&new_client->dev, &dev_attr_temp2_crit); | 
 | 811 |  | 
 | 812 | 	device_create_file(&new_client->dev, &dev_attr_auto_temp1_off); | 
 | 813 | 	device_create_file(&new_client->dev, &dev_attr_auto_temp1_min); | 
 | 814 | 	device_create_file(&new_client->dev, &dev_attr_auto_temp1_max); | 
 | 815 |  | 
 | 816 | 	device_create_file(&new_client->dev, &dev_attr_auto_temp2_off); | 
 | 817 | 	device_create_file(&new_client->dev, &dev_attr_auto_temp2_min); | 
 | 818 | 	device_create_file(&new_client->dev, &dev_attr_auto_temp2_max); | 
 | 819 |  | 
 | 820 | 	device_create_file(&new_client->dev, &dev_attr_auto_fan1_min_pwm); | 
 | 821 |  | 
 | 822 | 	device_create_file(&new_client->dev, &dev_attr_alarms); | 
 | 823 |  | 
 | 824 | 	if (kind == adm1031) { | 
 | 825 | 		device_create_file(&new_client->dev, &dev_attr_fan2_input); | 
 | 826 | 		device_create_file(&new_client->dev, &dev_attr_fan2_div); | 
 | 827 | 		device_create_file(&new_client->dev, &dev_attr_fan2_min); | 
 | 828 | 		device_create_file(&new_client->dev, &dev_attr_pwm2); | 
 | 829 | 		device_create_file(&new_client->dev, | 
 | 830 | 				   &dev_attr_auto_fan2_channel); | 
 | 831 | 		device_create_file(&new_client->dev, &dev_attr_temp3_input); | 
 | 832 | 		device_create_file(&new_client->dev, &dev_attr_temp3_min); | 
 | 833 | 		device_create_file(&new_client->dev, &dev_attr_temp3_max); | 
 | 834 | 		device_create_file(&new_client->dev, &dev_attr_temp3_crit); | 
 | 835 | 		device_create_file(&new_client->dev, &dev_attr_auto_temp3_off); | 
 | 836 | 		device_create_file(&new_client->dev, &dev_attr_auto_temp3_min); | 
 | 837 | 		device_create_file(&new_client->dev, &dev_attr_auto_temp3_max); | 
 | 838 | 		device_create_file(&new_client->dev, &dev_attr_auto_fan2_min_pwm); | 
 | 839 | 	} | 
 | 840 |  | 
 | 841 | 	return 0; | 
 | 842 |  | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 843 | exit_detach: | 
 | 844 | 	i2c_detach_client(new_client); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 845 | exit_free: | 
| Alexey Dobriyan | 1f57ff8 | 2005-08-26 01:49:14 +0400 | [diff] [blame] | 846 | 	kfree(data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 847 | exit: | 
 | 848 | 	return err; | 
 | 849 | } | 
 | 850 |  | 
 | 851 | static int adm1031_detach_client(struct i2c_client *client) | 
 | 852 | { | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 853 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 854 | 	int ret; | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 855 |  | 
 | 856 | 	hwmon_device_unregister(data->class_dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 857 | 	if ((ret = i2c_detach_client(client)) != 0) { | 
 | 858 | 		return ret; | 
 | 859 | 	} | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 860 | 	kfree(data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 861 | 	return 0; | 
 | 862 | } | 
 | 863 |  | 
 | 864 | static void adm1031_init_client(struct i2c_client *client) | 
 | 865 | { | 
 | 866 | 	unsigned int read_val; | 
 | 867 | 	unsigned int mask; | 
 | 868 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 869 |  | 
 | 870 | 	mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE); | 
 | 871 | 	if (data->chip_type == adm1031) { | 
 | 872 | 		mask |= (ADM1031_CONF2_PWM2_ENABLE | | 
 | 873 | 			ADM1031_CONF2_TACH2_ENABLE); | 
 | 874 | 	}  | 
 | 875 | 	/* Initialize the ADM1031 chip (enables fan speed reading ) */ | 
 | 876 | 	read_val = adm1031_read_value(client, ADM1031_REG_CONF2); | 
 | 877 | 	if ((read_val | mask) != read_val) { | 
 | 878 | 	    adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask); | 
 | 879 | 	} | 
 | 880 |  | 
 | 881 | 	read_val = adm1031_read_value(client, ADM1031_REG_CONF1); | 
 | 882 | 	if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) { | 
 | 883 | 	    adm1031_write_value(client, ADM1031_REG_CONF1, read_val | | 
 | 884 | 				ADM1031_CONF1_MONITOR_ENABLE); | 
 | 885 | 	} | 
 | 886 |  | 
 | 887 | } | 
 | 888 |  | 
 | 889 | static struct adm1031_data *adm1031_update_device(struct device *dev) | 
 | 890 | { | 
 | 891 | 	struct i2c_client *client = to_i2c_client(dev); | 
 | 892 | 	struct adm1031_data *data = i2c_get_clientdata(client); | 
 | 893 | 	int chan; | 
 | 894 |  | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 895 | 	mutex_lock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 896 |  | 
 | 897 | 	if (time_after(jiffies, data->last_updated + HZ + HZ / 2) | 
 | 898 | 	    || !data->valid) { | 
 | 899 |  | 
 | 900 | 		dev_dbg(&client->dev, "Starting adm1031 update\n"); | 
 | 901 | 		for (chan = 0; | 
 | 902 | 		     chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) { | 
 | 903 | 			u8 oldh, newh; | 
 | 904 |  | 
 | 905 | 			oldh = | 
 | 906 | 			    adm1031_read_value(client, ADM1031_REG_TEMP(chan)); | 
 | 907 | 			data->ext_temp[chan] = | 
 | 908 | 			    adm1031_read_value(client, ADM1031_REG_EXT_TEMP); | 
 | 909 | 			newh = | 
 | 910 | 			    adm1031_read_value(client, ADM1031_REG_TEMP(chan)); | 
 | 911 | 			if (newh != oldh) { | 
 | 912 | 				data->ext_temp[chan] = | 
 | 913 | 				    adm1031_read_value(client, | 
 | 914 | 						       ADM1031_REG_EXT_TEMP); | 
 | 915 | #ifdef DEBUG | 
 | 916 | 				oldh = | 
 | 917 | 				    adm1031_read_value(client, | 
 | 918 | 						       ADM1031_REG_TEMP(chan)); | 
 | 919 |  | 
 | 920 | 				/* oldh is actually newer */ | 
 | 921 | 				if (newh != oldh) | 
 | 922 | 					dev_warn(&client->dev, | 
 | 923 | 						 "Remote temperature may be " | 
 | 924 | 						 "wrong.\n"); | 
 | 925 | #endif | 
 | 926 | 			} | 
 | 927 | 			data->temp[chan] = newh; | 
 | 928 |  | 
 | 929 | 			data->temp_min[chan] = | 
 | 930 | 			    adm1031_read_value(client, | 
 | 931 | 					       ADM1031_REG_TEMP_MIN(chan)); | 
 | 932 | 			data->temp_max[chan] = | 
 | 933 | 			    adm1031_read_value(client, | 
 | 934 | 					       ADM1031_REG_TEMP_MAX(chan)); | 
 | 935 | 			data->temp_crit[chan] = | 
 | 936 | 			    adm1031_read_value(client, | 
 | 937 | 					       ADM1031_REG_TEMP_CRIT(chan)); | 
 | 938 | 			data->auto_temp[chan] = | 
 | 939 | 			    adm1031_read_value(client, | 
 | 940 | 					       ADM1031_REG_AUTO_TEMP(chan)); | 
 | 941 |  | 
 | 942 | 		} | 
 | 943 |  | 
 | 944 | 		data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1); | 
 | 945 | 		data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2); | 
 | 946 |  | 
 | 947 | 		data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0)) | 
 | 948 | 			     | (adm1031_read_value(client, ADM1031_REG_STATUS(1)) | 
 | 949 | 				<< 8); | 
 | 950 | 		if (data->chip_type == adm1030) { | 
 | 951 | 			data->alarm &= 0xc0ff; | 
 | 952 | 		} | 
 | 953 | 		 | 
 | 954 | 		for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) { | 
 | 955 | 			data->fan_div[chan] = | 
 | 956 | 			    adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan)); | 
 | 957 | 			data->fan_min[chan] = | 
 | 958 | 			    adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan)); | 
 | 959 | 			data->fan[chan] = | 
 | 960 | 			    adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan)); | 
 | 961 | 			data->pwm[chan] = | 
 | 962 | 			    0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >>  | 
 | 963 | 				   (4*chan)); | 
 | 964 | 		} | 
 | 965 | 		data->last_updated = jiffies; | 
 | 966 | 		data->valid = 1; | 
 | 967 | 	} | 
 | 968 |  | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 969 | 	mutex_unlock(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 970 |  | 
 | 971 | 	return data; | 
 | 972 | } | 
 | 973 |  | 
 | 974 | static int __init sensors_adm1031_init(void) | 
 | 975 | { | 
 | 976 | 	return i2c_add_driver(&adm1031_driver); | 
 | 977 | } | 
 | 978 |  | 
 | 979 | static void __exit sensors_adm1031_exit(void) | 
 | 980 | { | 
 | 981 | 	i2c_del_driver(&adm1031_driver); | 
 | 982 | } | 
 | 983 |  | 
 | 984 | MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>"); | 
 | 985 | MODULE_DESCRIPTION("ADM1031/ADM1030 driver"); | 
 | 986 | MODULE_LICENSE("GPL"); | 
 | 987 |  | 
 | 988 | module_init(sensors_adm1031_init); | 
 | 989 | module_exit(sensors_adm1031_exit); |