| xj | b04a402 | 2021-11-25 15:01:52 +0800 | [diff] [blame] | 1 | /* | 
 | 2 |  * adm9240.c	Part of lm_sensors, Linux kernel modules for hardware | 
 | 3 |  *		monitoring | 
 | 4 |  * | 
 | 5 |  * Copyright (C) 1999	Frodo Looijaard <frodol@dds.nl> | 
 | 6 |  *			Philip Edelbrock <phil@netroedge.com> | 
 | 7 |  * Copyright (C) 2003	Michiel Rook <michiel@grendelproject.nl> | 
 | 8 |  * Copyright (C) 2005	Grant Coady <gcoady.lk@gmail.com> with valuable | 
 | 9 |  *				guidance from Jean Delvare | 
 | 10 |  * | 
 | 11 |  * Driver supports	Analog Devices		ADM9240 | 
 | 12 |  *			Dallas Semiconductor	DS1780 | 
 | 13 |  *			National Semiconductor	LM81 | 
 | 14 |  * | 
 | 15 |  * ADM9240 is the reference, DS1780 and LM81 are register compatibles | 
 | 16 |  * | 
 | 17 |  * Voltage	Six inputs are scaled by chip, VID also reported | 
 | 18 |  * Temperature	Chip temperature to 0.5'C, maximum and max_hysteris | 
 | 19 |  * Fans		2 fans, low speed alarm, automatic fan clock divider | 
 | 20 |  * Alarms	16-bit map of active alarms | 
 | 21 |  * Analog Out	0..1250 mV output | 
 | 22 |  * | 
 | 23 |  * Chassis Intrusion: clear CI latch with 'echo 0 > intrusion0_alarm' | 
 | 24 |  * | 
 | 25 |  * Test hardware: Intel SE440BX-2 desktop motherboard --Grant | 
 | 26 |  * | 
 | 27 |  * LM81 extended temp reading not implemented | 
 | 28 |  * | 
 | 29 |  * This program is free software; you can redistribute it and/or modify | 
 | 30 |  * it under the terms of the GNU General Public License as published by | 
 | 31 |  * the Free Software Foundation; either version 2 of the License, or | 
 | 32 |  * (at your option) any later version. | 
 | 33 |  * | 
 | 34 |  * This program is distributed in the hope that it will be useful, | 
 | 35 |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 36 |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 37 |  * GNU General Public License for more details. | 
 | 38 |  * | 
 | 39 |  * You should have received a copy of the GNU General Public License | 
 | 40 |  * along with this program; if not, write to the Free Software | 
 | 41 |  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
 | 42 |  */ | 
 | 43 |  | 
 | 44 | #include <linux/init.h> | 
 | 45 | #include <linux/module.h> | 
 | 46 | #include <linux/slab.h> | 
 | 47 | #include <linux/i2c.h> | 
 | 48 | #include <linux/hwmon-sysfs.h> | 
 | 49 | #include <linux/hwmon.h> | 
 | 50 | #include <linux/hwmon-vid.h> | 
 | 51 | #include <linux/err.h> | 
 | 52 | #include <linux/mutex.h> | 
 | 53 | #include <linux/jiffies.h> | 
 | 54 |  | 
 | 55 | /* Addresses to scan */ | 
 | 56 | static const unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, 0x2f, | 
 | 57 | 					I2C_CLIENT_END }; | 
 | 58 |  | 
 | 59 | enum chips { adm9240, ds1780, lm81 }; | 
 | 60 |  | 
 | 61 | /* ADM9240 registers */ | 
 | 62 | #define ADM9240_REG_MAN_ID		0x3e | 
 | 63 | #define ADM9240_REG_DIE_REV		0x3f | 
 | 64 | #define ADM9240_REG_CONFIG		0x40 | 
 | 65 |  | 
 | 66 | #define ADM9240_REG_IN(nr)		(0x20 + (nr))   /* 0..5 */ | 
 | 67 | #define ADM9240_REG_IN_MAX(nr)		(0x2b + (nr) * 2) | 
 | 68 | #define ADM9240_REG_IN_MIN(nr)		(0x2c + (nr) * 2) | 
 | 69 | #define ADM9240_REG_FAN(nr)		(0x28 + (nr))   /* 0..1 */ | 
 | 70 | #define ADM9240_REG_FAN_MIN(nr)		(0x3b + (nr)) | 
 | 71 | #define ADM9240_REG_INT(nr)		(0x41 + (nr)) | 
 | 72 | #define ADM9240_REG_INT_MASK(nr)	(0x43 + (nr)) | 
 | 73 | #define ADM9240_REG_TEMP		0x27 | 
 | 74 | #define ADM9240_REG_TEMP_MAX(nr)	(0x39 + (nr)) /* 0, 1 = high, hyst */ | 
 | 75 | #define ADM9240_REG_ANALOG_OUT		0x19 | 
 | 76 | #define ADM9240_REG_CHASSIS_CLEAR	0x46 | 
 | 77 | #define ADM9240_REG_VID_FAN_DIV		0x47 | 
 | 78 | #define ADM9240_REG_I2C_ADDR		0x48 | 
 | 79 | #define ADM9240_REG_VID4		0x49 | 
 | 80 | #define ADM9240_REG_TEMP_CONF		0x4b | 
 | 81 |  | 
 | 82 | /* generalised scaling with integer rounding */ | 
 | 83 | static inline int SCALE(long val, int mul, int div) | 
 | 84 | { | 
 | 85 | 	if (val < 0) | 
 | 86 | 		return (val * mul - div / 2) / div; | 
 | 87 | 	else | 
 | 88 | 		return (val * mul + div / 2) / div; | 
 | 89 | } | 
 | 90 |  | 
 | 91 | /* adm9240 internally scales voltage measurements */ | 
 | 92 | static const u16 nom_mv[] = { 2500, 2700, 3300, 5000, 12000, 2700 }; | 
 | 93 |  | 
 | 94 | static inline unsigned int IN_FROM_REG(u8 reg, int n) | 
 | 95 | { | 
 | 96 | 	return SCALE(reg, nom_mv[n], 192); | 
 | 97 | } | 
 | 98 |  | 
 | 99 | static inline u8 IN_TO_REG(unsigned long val, int n) | 
 | 100 | { | 
 | 101 | 	val = clamp_val(val, 0, nom_mv[n] * 255 / 192); | 
 | 102 | 	return SCALE(val, 192, nom_mv[n]); | 
 | 103 | } | 
 | 104 |  | 
 | 105 | /* temperature range: -40..125, 127 disables temperature alarm */ | 
 | 106 | static inline s8 TEMP_TO_REG(long val) | 
 | 107 | { | 
 | 108 | 	val = clamp_val(val, -40000, 127000); | 
 | 109 | 	return SCALE(val, 1, 1000); | 
 | 110 | } | 
 | 111 |  | 
 | 112 | /* two fans, each with low fan speed limit */ | 
 | 113 | static inline unsigned int FAN_FROM_REG(u8 reg, u8 div) | 
 | 114 | { | 
 | 115 | 	if (!reg) /* error */ | 
 | 116 | 		return -1; | 
 | 117 |  | 
 | 118 | 	if (reg == 255) | 
 | 119 | 		return 0; | 
 | 120 |  | 
 | 121 | 	return SCALE(1350000, 1, reg * div); | 
 | 122 | } | 
 | 123 |  | 
 | 124 | /* analog out 0..1250mV */ | 
 | 125 | static inline u8 AOUT_TO_REG(unsigned long val) | 
 | 126 | { | 
 | 127 | 	val = clamp_val(val, 0, 1250); | 
 | 128 | 	return SCALE(val, 255, 1250); | 
 | 129 | } | 
 | 130 |  | 
 | 131 | static inline unsigned int AOUT_FROM_REG(u8 reg) | 
 | 132 | { | 
 | 133 | 	return SCALE(reg, 1250, 255); | 
 | 134 | } | 
 | 135 |  | 
 | 136 | /* per client data */ | 
 | 137 | struct adm9240_data { | 
 | 138 | 	struct i2c_client *client; | 
 | 139 | 	struct mutex update_lock; | 
 | 140 | 	char valid; | 
 | 141 | 	unsigned long last_updated_measure; | 
 | 142 | 	unsigned long last_updated_config; | 
 | 143 |  | 
 | 144 | 	u8 in[6];		/* ro	in0_input */ | 
 | 145 | 	u8 in_max[6];		/* rw	in0_max */ | 
 | 146 | 	u8 in_min[6];		/* rw	in0_min */ | 
 | 147 | 	u8 fan[2];		/* ro	fan1_input */ | 
 | 148 | 	u8 fan_min[2];		/* rw	fan1_min */ | 
 | 149 | 	u8 fan_div[2];		/* rw	fan1_div, read-only accessor */ | 
 | 150 | 	s16 temp;		/* ro	temp1_input, 9-bit sign-extended */ | 
 | 151 | 	s8 temp_max[2];		/* rw	0 -> temp_max, 1 -> temp_max_hyst */ | 
 | 152 | 	u16 alarms;		/* ro	alarms */ | 
 | 153 | 	u8 aout;		/* rw	aout_output */ | 
 | 154 | 	u8 vid;			/* ro	vid */ | 
 | 155 | 	u8 vrm;			/* --	vrm set on startup, no accessor */ | 
 | 156 | }; | 
 | 157 |  | 
 | 158 | /* write new fan div, callers must hold data->update_lock */ | 
 | 159 | static void adm9240_write_fan_div(struct i2c_client *client, int nr, | 
 | 160 | 		u8 fan_div) | 
 | 161 | { | 
 | 162 | 	u8 reg, old, shift = (nr + 2) * 2; | 
 | 163 |  | 
 | 164 | 	reg = i2c_smbus_read_byte_data(client, ADM9240_REG_VID_FAN_DIV); | 
 | 165 | 	old = (reg >> shift) & 3; | 
 | 166 | 	reg &= ~(3 << shift); | 
 | 167 | 	reg |= (fan_div << shift); | 
 | 168 | 	i2c_smbus_write_byte_data(client, ADM9240_REG_VID_FAN_DIV, reg); | 
 | 169 | 	dev_dbg(&client->dev, | 
 | 170 | 		"fan%d clock divider changed from %u to %u\n", | 
 | 171 | 		nr + 1, 1 << old, 1 << fan_div); | 
 | 172 | } | 
 | 173 |  | 
 | 174 | static struct adm9240_data *adm9240_update_device(struct device *dev) | 
 | 175 | { | 
 | 176 | 	struct adm9240_data *data = dev_get_drvdata(dev); | 
 | 177 | 	struct i2c_client *client = data->client; | 
 | 178 | 	int i; | 
 | 179 |  | 
 | 180 | 	mutex_lock(&data->update_lock); | 
 | 181 |  | 
 | 182 | 	/* minimum measurement cycle: 1.75 seconds */ | 
 | 183 | 	if (time_after(jiffies, data->last_updated_measure + (HZ * 7 / 4)) | 
 | 184 | 			|| !data->valid) { | 
 | 185 |  | 
 | 186 | 		for (i = 0; i < 6; i++) { /* read voltages */ | 
 | 187 | 			data->in[i] = i2c_smbus_read_byte_data(client, | 
 | 188 | 					ADM9240_REG_IN(i)); | 
 | 189 | 		} | 
 | 190 | 		data->alarms = i2c_smbus_read_byte_data(client, | 
 | 191 | 					ADM9240_REG_INT(0)) | | 
 | 192 | 					i2c_smbus_read_byte_data(client, | 
 | 193 | 					ADM9240_REG_INT(1)) << 8; | 
 | 194 |  | 
 | 195 | 		/* | 
 | 196 | 		 * read temperature: assume temperature changes less than | 
 | 197 | 		 * 0.5'C per two measurement cycles thus ignore possible | 
 | 198 | 		 * but unlikely aliasing error on lsb reading. --Grant | 
 | 199 | 		 */ | 
 | 200 | 		data->temp = (i2c_smbus_read_byte_data(client, | 
 | 201 | 					ADM9240_REG_TEMP) << 8) | | 
 | 202 | 					i2c_smbus_read_byte_data(client, | 
 | 203 | 					ADM9240_REG_TEMP_CONF); | 
 | 204 |  | 
 | 205 | 		for (i = 0; i < 2; i++) { /* read fans */ | 
 | 206 | 			data->fan[i] = i2c_smbus_read_byte_data(client, | 
 | 207 | 					ADM9240_REG_FAN(i)); | 
 | 208 |  | 
 | 209 | 			/* adjust fan clock divider on overflow */ | 
 | 210 | 			if (data->valid && data->fan[i] == 255 && | 
 | 211 | 					data->fan_div[i] < 3) { | 
 | 212 |  | 
 | 213 | 				adm9240_write_fan_div(client, i, | 
 | 214 | 						++data->fan_div[i]); | 
 | 215 |  | 
 | 216 | 				/* adjust fan_min if active, but not to 0 */ | 
 | 217 | 				if (data->fan_min[i] < 255 && | 
 | 218 | 						data->fan_min[i] >= 2) | 
 | 219 | 					data->fan_min[i] /= 2; | 
 | 220 | 			} | 
 | 221 | 		} | 
 | 222 | 		data->last_updated_measure = jiffies; | 
 | 223 | 	} | 
 | 224 |  | 
 | 225 | 	/* minimum config reading cycle: 300 seconds */ | 
 | 226 | 	if (time_after(jiffies, data->last_updated_config + (HZ * 300)) | 
 | 227 | 			|| !data->valid) { | 
 | 228 |  | 
 | 229 | 		for (i = 0; i < 6; i++) { | 
 | 230 | 			data->in_min[i] = i2c_smbus_read_byte_data(client, | 
 | 231 | 					ADM9240_REG_IN_MIN(i)); | 
 | 232 | 			data->in_max[i] = i2c_smbus_read_byte_data(client, | 
 | 233 | 					ADM9240_REG_IN_MAX(i)); | 
 | 234 | 		} | 
 | 235 | 		for (i = 0; i < 2; i++) { | 
 | 236 | 			data->fan_min[i] = i2c_smbus_read_byte_data(client, | 
 | 237 | 					ADM9240_REG_FAN_MIN(i)); | 
 | 238 | 		} | 
 | 239 | 		data->temp_max[0] = i2c_smbus_read_byte_data(client, | 
 | 240 | 				ADM9240_REG_TEMP_MAX(0)); | 
 | 241 | 		data->temp_max[1] = i2c_smbus_read_byte_data(client, | 
 | 242 | 				ADM9240_REG_TEMP_MAX(1)); | 
 | 243 |  | 
 | 244 | 		/* read fan divs and 5-bit VID */ | 
 | 245 | 		i = i2c_smbus_read_byte_data(client, ADM9240_REG_VID_FAN_DIV); | 
 | 246 | 		data->fan_div[0] = (i >> 4) & 3; | 
 | 247 | 		data->fan_div[1] = (i >> 6) & 3; | 
 | 248 | 		data->vid = i & 0x0f; | 
 | 249 | 		data->vid |= (i2c_smbus_read_byte_data(client, | 
 | 250 | 					ADM9240_REG_VID4) & 1) << 4; | 
 | 251 | 		/* read analog out */ | 
 | 252 | 		data->aout = i2c_smbus_read_byte_data(client, | 
 | 253 | 				ADM9240_REG_ANALOG_OUT); | 
 | 254 |  | 
 | 255 | 		data->last_updated_config = jiffies; | 
 | 256 | 		data->valid = 1; | 
 | 257 | 	} | 
 | 258 | 	mutex_unlock(&data->update_lock); | 
 | 259 | 	return data; | 
 | 260 | } | 
 | 261 |  | 
 | 262 | /*** sysfs accessors ***/ | 
 | 263 |  | 
 | 264 | /* temperature */ | 
 | 265 | static ssize_t temp1_input_show(struct device *dev, | 
 | 266 | 				struct device_attribute *dummy, char *buf) | 
 | 267 | { | 
 | 268 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 269 | 	return sprintf(buf, "%d\n", data->temp / 128 * 500); /* 9-bit value */ | 
 | 270 | } | 
 | 271 |  | 
 | 272 | static ssize_t show_max(struct device *dev, struct device_attribute *devattr, | 
 | 273 | 		char *buf) | 
 | 274 | { | 
 | 275 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 276 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 277 | 	return sprintf(buf, "%d\n", data->temp_max[attr->index] * 1000); | 
 | 278 | } | 
 | 279 |  | 
 | 280 | static ssize_t set_max(struct device *dev, struct device_attribute *devattr, | 
 | 281 | 		const char *buf, size_t count) | 
 | 282 | { | 
 | 283 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 284 | 	struct adm9240_data *data = dev_get_drvdata(dev); | 
 | 285 | 	struct i2c_client *client = data->client; | 
 | 286 | 	long val; | 
 | 287 | 	int err; | 
 | 288 |  | 
 | 289 | 	err = kstrtol(buf, 10, &val); | 
 | 290 | 	if (err) | 
 | 291 | 		return err; | 
 | 292 |  | 
 | 293 | 	mutex_lock(&data->update_lock); | 
 | 294 | 	data->temp_max[attr->index] = TEMP_TO_REG(val); | 
 | 295 | 	i2c_smbus_write_byte_data(client, ADM9240_REG_TEMP_MAX(attr->index), | 
 | 296 | 			data->temp_max[attr->index]); | 
 | 297 | 	mutex_unlock(&data->update_lock); | 
 | 298 | 	return count; | 
 | 299 | } | 
 | 300 |  | 
 | 301 | static DEVICE_ATTR_RO(temp1_input); | 
 | 302 | static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, | 
 | 303 | 		show_max, set_max, 0); | 
 | 304 | static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO, | 
 | 305 | 		show_max, set_max, 1); | 
 | 306 |  | 
 | 307 | /* voltage */ | 
 | 308 | static ssize_t show_in(struct device *dev, struct device_attribute *devattr, | 
 | 309 | 		char *buf) | 
 | 310 | { | 
 | 311 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 312 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 313 | 	return sprintf(buf, "%d\n", IN_FROM_REG(data->in[attr->index], | 
 | 314 | 				attr->index)); | 
 | 315 | } | 
 | 316 |  | 
 | 317 | static ssize_t show_in_min(struct device *dev, | 
 | 318 | 		struct device_attribute *devattr, char *buf) | 
 | 319 | { | 
 | 320 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 321 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 322 | 	return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[attr->index], | 
 | 323 | 				attr->index)); | 
 | 324 | } | 
 | 325 |  | 
 | 326 | static ssize_t show_in_max(struct device *dev, | 
 | 327 | 		struct device_attribute *devattr, char *buf) | 
 | 328 | { | 
 | 329 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 330 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 331 | 	return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[attr->index], | 
 | 332 | 				attr->index)); | 
 | 333 | } | 
 | 334 |  | 
 | 335 | static ssize_t set_in_min(struct device *dev, | 
 | 336 | 		struct device_attribute *devattr, | 
 | 337 | 		const char *buf, size_t count) | 
 | 338 | { | 
 | 339 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 340 | 	struct adm9240_data *data = dev_get_drvdata(dev); | 
 | 341 | 	struct i2c_client *client = data->client; | 
 | 342 | 	unsigned long val; | 
 | 343 | 	int err; | 
 | 344 |  | 
 | 345 | 	err = kstrtoul(buf, 10, &val); | 
 | 346 | 	if (err) | 
 | 347 | 		return err; | 
 | 348 |  | 
 | 349 | 	mutex_lock(&data->update_lock); | 
 | 350 | 	data->in_min[attr->index] = IN_TO_REG(val, attr->index); | 
 | 351 | 	i2c_smbus_write_byte_data(client, ADM9240_REG_IN_MIN(attr->index), | 
 | 352 | 			data->in_min[attr->index]); | 
 | 353 | 	mutex_unlock(&data->update_lock); | 
 | 354 | 	return count; | 
 | 355 | } | 
 | 356 |  | 
 | 357 | static ssize_t set_in_max(struct device *dev, | 
 | 358 | 		struct device_attribute *devattr, | 
 | 359 | 		const char *buf, size_t count) | 
 | 360 | { | 
 | 361 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 362 | 	struct adm9240_data *data = dev_get_drvdata(dev); | 
 | 363 | 	struct i2c_client *client = data->client; | 
 | 364 | 	unsigned long val; | 
 | 365 | 	int err; | 
 | 366 |  | 
 | 367 | 	err = kstrtoul(buf, 10, &val); | 
 | 368 | 	if (err) | 
 | 369 | 		return err; | 
 | 370 |  | 
 | 371 | 	mutex_lock(&data->update_lock); | 
 | 372 | 	data->in_max[attr->index] = IN_TO_REG(val, attr->index); | 
 | 373 | 	i2c_smbus_write_byte_data(client, ADM9240_REG_IN_MAX(attr->index), | 
 | 374 | 			data->in_max[attr->index]); | 
 | 375 | 	mutex_unlock(&data->update_lock); | 
 | 376 | 	return count; | 
 | 377 | } | 
 | 378 |  | 
 | 379 | #define vin(nr)							\ | 
 | 380 | static SENSOR_DEVICE_ATTR(in##nr##_input, S_IRUGO,		\ | 
 | 381 | 		show_in, NULL, nr);				\ | 
 | 382 | static SENSOR_DEVICE_ATTR(in##nr##_min, S_IRUGO | S_IWUSR,	\ | 
 | 383 | 		show_in_min, set_in_min, nr);			\ | 
 | 384 | static SENSOR_DEVICE_ATTR(in##nr##_max, S_IRUGO | S_IWUSR,	\ | 
 | 385 | 		show_in_max, set_in_max, nr); | 
 | 386 |  | 
 | 387 | vin(0); | 
 | 388 | vin(1); | 
 | 389 | vin(2); | 
 | 390 | vin(3); | 
 | 391 | vin(4); | 
 | 392 | vin(5); | 
 | 393 |  | 
 | 394 | /* fans */ | 
 | 395 | static ssize_t show_fan(struct device *dev, | 
 | 396 | 		struct device_attribute *devattr, char *buf) | 
 | 397 | { | 
 | 398 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 399 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 400 | 	return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[attr->index], | 
 | 401 | 				1 << data->fan_div[attr->index])); | 
 | 402 | } | 
 | 403 |  | 
 | 404 | static ssize_t show_fan_min(struct device *dev, | 
 | 405 | 		struct device_attribute *devattr, char *buf) | 
 | 406 | { | 
 | 407 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 408 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 409 | 	return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[attr->index], | 
 | 410 | 				1 << data->fan_div[attr->index])); | 
 | 411 | } | 
 | 412 |  | 
 | 413 | static ssize_t show_fan_div(struct device *dev, | 
 | 414 | 		struct device_attribute *devattr, char *buf) | 
 | 415 | { | 
 | 416 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 417 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 418 | 	return sprintf(buf, "%d\n", 1 << data->fan_div[attr->index]); | 
 | 419 | } | 
 | 420 |  | 
 | 421 | /* | 
 | 422 |  * set fan speed low limit: | 
 | 423 |  * | 
 | 424 |  * - value is zero: disable fan speed low limit alarm | 
 | 425 |  * | 
 | 426 |  * - value is below fan speed measurement range: enable fan speed low | 
 | 427 |  *   limit alarm to be asserted while fan speed too slow to measure | 
 | 428 |  * | 
 | 429 |  * - otherwise: select fan clock divider to suit fan speed low limit, | 
 | 430 |  *   measurement code may adjust registers to ensure fan speed reading | 
 | 431 |  */ | 
 | 432 | static ssize_t set_fan_min(struct device *dev, | 
 | 433 | 		struct device_attribute *devattr, | 
 | 434 | 		const char *buf, size_t count) | 
 | 435 | { | 
 | 436 | 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 
 | 437 | 	struct adm9240_data *data = dev_get_drvdata(dev); | 
 | 438 | 	struct i2c_client *client = data->client; | 
 | 439 | 	int nr = attr->index; | 
 | 440 | 	u8 new_div; | 
 | 441 | 	unsigned long val; | 
 | 442 | 	int err; | 
 | 443 |  | 
 | 444 | 	err = kstrtoul(buf, 10, &val); | 
 | 445 | 	if (err) | 
 | 446 | 		return err; | 
 | 447 |  | 
 | 448 | 	mutex_lock(&data->update_lock); | 
 | 449 |  | 
 | 450 | 	if (!val) { | 
 | 451 | 		data->fan_min[nr] = 255; | 
 | 452 | 		new_div = data->fan_div[nr]; | 
 | 453 |  | 
 | 454 | 		dev_dbg(&client->dev, "fan%u low limit set disabled\n", | 
 | 455 | 				nr + 1); | 
 | 456 |  | 
 | 457 | 	} else if (val < 1350000 / (8 * 254)) { | 
 | 458 | 		new_div = 3; | 
 | 459 | 		data->fan_min[nr] = 254; | 
 | 460 |  | 
 | 461 | 		dev_dbg(&client->dev, "fan%u low limit set minimum %u\n", | 
 | 462 | 				nr + 1, FAN_FROM_REG(254, 1 << new_div)); | 
 | 463 |  | 
 | 464 | 	} else { | 
 | 465 | 		unsigned int new_min = 1350000 / val; | 
 | 466 |  | 
 | 467 | 		new_div = 0; | 
 | 468 | 		while (new_min > 192 && new_div < 3) { | 
 | 469 | 			new_div++; | 
 | 470 | 			new_min /= 2; | 
 | 471 | 		} | 
 | 472 | 		if (!new_min) /* keep > 0 */ | 
 | 473 | 			new_min++; | 
 | 474 |  | 
 | 475 | 		data->fan_min[nr] = new_min; | 
 | 476 |  | 
 | 477 | 		dev_dbg(&client->dev, "fan%u low limit set fan speed %u\n", | 
 | 478 | 				nr + 1, FAN_FROM_REG(new_min, 1 << new_div)); | 
 | 479 | 	} | 
 | 480 |  | 
 | 481 | 	if (new_div != data->fan_div[nr]) { | 
 | 482 | 		data->fan_div[nr] = new_div; | 
 | 483 | 		adm9240_write_fan_div(client, nr, new_div); | 
 | 484 | 	} | 
 | 485 | 	i2c_smbus_write_byte_data(client, ADM9240_REG_FAN_MIN(nr), | 
 | 486 | 			data->fan_min[nr]); | 
 | 487 |  | 
 | 488 | 	mutex_unlock(&data->update_lock); | 
 | 489 | 	return count; | 
 | 490 | } | 
 | 491 |  | 
 | 492 | #define fan(nr)							\ | 
 | 493 | static SENSOR_DEVICE_ATTR(fan##nr##_input, S_IRUGO,		\ | 
 | 494 | 		show_fan, NULL, nr - 1);			\ | 
 | 495 | static SENSOR_DEVICE_ATTR(fan##nr##_div, S_IRUGO,		\ | 
 | 496 | 		show_fan_div, NULL, nr - 1);			\ | 
 | 497 | static SENSOR_DEVICE_ATTR(fan##nr##_min, S_IRUGO | S_IWUSR,	\ | 
 | 498 | 		show_fan_min, set_fan_min, nr - 1); | 
 | 499 |  | 
 | 500 | fan(1); | 
 | 501 | fan(2); | 
 | 502 |  | 
 | 503 | /* alarms */ | 
 | 504 | static ssize_t alarms_show(struct device *dev, | 
 | 505 | 		struct device_attribute *attr, char *buf) | 
 | 506 | { | 
 | 507 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 508 | 	return sprintf(buf, "%u\n", data->alarms); | 
 | 509 | } | 
 | 510 | static DEVICE_ATTR_RO(alarms); | 
 | 511 |  | 
 | 512 | static ssize_t show_alarm(struct device *dev, | 
 | 513 | 		struct device_attribute *attr, char *buf) | 
 | 514 | { | 
 | 515 | 	int bitnr = to_sensor_dev_attr(attr)->index; | 
 | 516 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 517 | 	return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | 
 | 518 | } | 
 | 519 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0); | 
 | 520 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1); | 
 | 521 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2); | 
 | 522 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3); | 
 | 523 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8); | 
 | 524 | static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9); | 
 | 525 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4); | 
 | 526 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6); | 
 | 527 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7); | 
 | 528 |  | 
 | 529 | /* vid */ | 
 | 530 | static ssize_t cpu0_vid_show(struct device *dev, | 
 | 531 | 			     struct device_attribute *attr, char *buf) | 
 | 532 | { | 
 | 533 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 534 | 	return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm)); | 
 | 535 | } | 
 | 536 | static DEVICE_ATTR_RO(cpu0_vid); | 
 | 537 |  | 
 | 538 | /* analog output */ | 
 | 539 | static ssize_t aout_output_show(struct device *dev, | 
 | 540 | 				struct device_attribute *attr, char *buf) | 
 | 541 | { | 
 | 542 | 	struct adm9240_data *data = adm9240_update_device(dev); | 
 | 543 | 	return sprintf(buf, "%d\n", AOUT_FROM_REG(data->aout)); | 
 | 544 | } | 
 | 545 |  | 
 | 546 | static ssize_t aout_output_store(struct device *dev, | 
 | 547 | 				 struct device_attribute *attr, | 
 | 548 | 				 const char *buf, size_t count) | 
 | 549 | { | 
 | 550 | 	struct adm9240_data *data = dev_get_drvdata(dev); | 
 | 551 | 	struct i2c_client *client = data->client; | 
 | 552 | 	long val; | 
 | 553 | 	int err; | 
 | 554 |  | 
 | 555 | 	err = kstrtol(buf, 10, &val); | 
 | 556 | 	if (err) | 
 | 557 | 		return err; | 
 | 558 |  | 
 | 559 | 	mutex_lock(&data->update_lock); | 
 | 560 | 	data->aout = AOUT_TO_REG(val); | 
 | 561 | 	i2c_smbus_write_byte_data(client, ADM9240_REG_ANALOG_OUT, data->aout); | 
 | 562 | 	mutex_unlock(&data->update_lock); | 
 | 563 | 	return count; | 
 | 564 | } | 
 | 565 | static DEVICE_ATTR_RW(aout_output); | 
 | 566 |  | 
 | 567 | static ssize_t chassis_clear(struct device *dev, | 
 | 568 | 		struct device_attribute *attr, | 
 | 569 | 		const char *buf, size_t count) | 
 | 570 | { | 
 | 571 | 	struct adm9240_data *data = dev_get_drvdata(dev); | 
 | 572 | 	struct i2c_client *client = data->client; | 
 | 573 | 	unsigned long val; | 
 | 574 |  | 
 | 575 | 	if (kstrtoul(buf, 10, &val) || val != 0) | 
 | 576 | 		return -EINVAL; | 
 | 577 |  | 
 | 578 | 	mutex_lock(&data->update_lock); | 
 | 579 | 	i2c_smbus_write_byte_data(client, ADM9240_REG_CHASSIS_CLEAR, 0x80); | 
 | 580 | 	data->valid = 0;		/* Force cache refresh */ | 
 | 581 | 	mutex_unlock(&data->update_lock); | 
 | 582 | 	dev_dbg(&client->dev, "chassis intrusion latch cleared\n"); | 
 | 583 |  | 
 | 584 | 	return count; | 
 | 585 | } | 
 | 586 | static SENSOR_DEVICE_ATTR(intrusion0_alarm, S_IRUGO | S_IWUSR, show_alarm, | 
 | 587 | 		chassis_clear, 12); | 
 | 588 |  | 
 | 589 | static struct attribute *adm9240_attrs[] = { | 
 | 590 | 	&sensor_dev_attr_in0_input.dev_attr.attr, | 
 | 591 | 	&sensor_dev_attr_in0_min.dev_attr.attr, | 
 | 592 | 	&sensor_dev_attr_in0_max.dev_attr.attr, | 
 | 593 | 	&sensor_dev_attr_in0_alarm.dev_attr.attr, | 
 | 594 | 	&sensor_dev_attr_in1_input.dev_attr.attr, | 
 | 595 | 	&sensor_dev_attr_in1_min.dev_attr.attr, | 
 | 596 | 	&sensor_dev_attr_in1_max.dev_attr.attr, | 
 | 597 | 	&sensor_dev_attr_in1_alarm.dev_attr.attr, | 
 | 598 | 	&sensor_dev_attr_in2_input.dev_attr.attr, | 
 | 599 | 	&sensor_dev_attr_in2_min.dev_attr.attr, | 
 | 600 | 	&sensor_dev_attr_in2_max.dev_attr.attr, | 
 | 601 | 	&sensor_dev_attr_in2_alarm.dev_attr.attr, | 
 | 602 | 	&sensor_dev_attr_in3_input.dev_attr.attr, | 
 | 603 | 	&sensor_dev_attr_in3_min.dev_attr.attr, | 
 | 604 | 	&sensor_dev_attr_in3_max.dev_attr.attr, | 
 | 605 | 	&sensor_dev_attr_in3_alarm.dev_attr.attr, | 
 | 606 | 	&sensor_dev_attr_in4_input.dev_attr.attr, | 
 | 607 | 	&sensor_dev_attr_in4_min.dev_attr.attr, | 
 | 608 | 	&sensor_dev_attr_in4_max.dev_attr.attr, | 
 | 609 | 	&sensor_dev_attr_in4_alarm.dev_attr.attr, | 
 | 610 | 	&sensor_dev_attr_in5_input.dev_attr.attr, | 
 | 611 | 	&sensor_dev_attr_in5_min.dev_attr.attr, | 
 | 612 | 	&sensor_dev_attr_in5_max.dev_attr.attr, | 
 | 613 | 	&sensor_dev_attr_in5_alarm.dev_attr.attr, | 
 | 614 | 	&dev_attr_temp1_input.attr, | 
 | 615 | 	&sensor_dev_attr_temp1_max.dev_attr.attr, | 
 | 616 | 	&sensor_dev_attr_temp1_max_hyst.dev_attr.attr, | 
 | 617 | 	&sensor_dev_attr_temp1_alarm.dev_attr.attr, | 
 | 618 | 	&sensor_dev_attr_fan1_input.dev_attr.attr, | 
 | 619 | 	&sensor_dev_attr_fan1_div.dev_attr.attr, | 
 | 620 | 	&sensor_dev_attr_fan1_min.dev_attr.attr, | 
 | 621 | 	&sensor_dev_attr_fan1_alarm.dev_attr.attr, | 
 | 622 | 	&sensor_dev_attr_fan2_input.dev_attr.attr, | 
 | 623 | 	&sensor_dev_attr_fan2_div.dev_attr.attr, | 
 | 624 | 	&sensor_dev_attr_fan2_min.dev_attr.attr, | 
 | 625 | 	&sensor_dev_attr_fan2_alarm.dev_attr.attr, | 
 | 626 | 	&dev_attr_alarms.attr, | 
 | 627 | 	&dev_attr_aout_output.attr, | 
 | 628 | 	&sensor_dev_attr_intrusion0_alarm.dev_attr.attr, | 
 | 629 | 	&dev_attr_cpu0_vid.attr, | 
 | 630 | 	NULL | 
 | 631 | }; | 
 | 632 |  | 
 | 633 | ATTRIBUTE_GROUPS(adm9240); | 
 | 634 |  | 
 | 635 |  | 
 | 636 | /*** sensor chip detect and driver install ***/ | 
 | 637 |  | 
 | 638 | /* Return 0 if detection is successful, -ENODEV otherwise */ | 
 | 639 | static int adm9240_detect(struct i2c_client *new_client, | 
 | 640 | 			  struct i2c_board_info *info) | 
 | 641 | { | 
 | 642 | 	struct i2c_adapter *adapter = new_client->adapter; | 
 | 643 | 	const char *name = ""; | 
 | 644 | 	int address = new_client->addr; | 
 | 645 | 	u8 man_id, die_rev; | 
 | 646 |  | 
 | 647 | 	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) | 
 | 648 | 		return -ENODEV; | 
 | 649 |  | 
 | 650 | 	/* verify chip: reg address should match i2c address */ | 
 | 651 | 	if (i2c_smbus_read_byte_data(new_client, ADM9240_REG_I2C_ADDR) | 
 | 652 | 			!= address) { | 
 | 653 | 		dev_err(&adapter->dev, "detect fail: address match, 0x%02x\n", | 
 | 654 | 			address); | 
 | 655 | 		return -ENODEV; | 
 | 656 | 	} | 
 | 657 |  | 
 | 658 | 	/* check known chip manufacturer */ | 
 | 659 | 	man_id = i2c_smbus_read_byte_data(new_client, ADM9240_REG_MAN_ID); | 
 | 660 | 	if (man_id == 0x23) { | 
 | 661 | 		name = "adm9240"; | 
 | 662 | 	} else if (man_id == 0xda) { | 
 | 663 | 		name = "ds1780"; | 
 | 664 | 	} else if (man_id == 0x01) { | 
 | 665 | 		name = "lm81"; | 
 | 666 | 	} else { | 
 | 667 | 		dev_err(&adapter->dev, "detect fail: unknown manuf, 0x%02x\n", | 
 | 668 | 			man_id); | 
 | 669 | 		return -ENODEV; | 
 | 670 | 	} | 
 | 671 |  | 
 | 672 | 	/* successful detect, print chip info */ | 
 | 673 | 	die_rev = i2c_smbus_read_byte_data(new_client, ADM9240_REG_DIE_REV); | 
 | 674 | 	dev_info(&adapter->dev, "found %s revision %u\n", | 
 | 675 | 		 man_id == 0x23 ? "ADM9240" : | 
 | 676 | 		 man_id == 0xda ? "DS1780" : "LM81", die_rev); | 
 | 677 |  | 
 | 678 | 	strlcpy(info->type, name, I2C_NAME_SIZE); | 
 | 679 |  | 
 | 680 | 	return 0; | 
 | 681 | } | 
 | 682 |  | 
 | 683 | static void adm9240_init_client(struct i2c_client *client) | 
 | 684 | { | 
 | 685 | 	struct adm9240_data *data = i2c_get_clientdata(client); | 
 | 686 | 	u8 conf = i2c_smbus_read_byte_data(client, ADM9240_REG_CONFIG); | 
 | 687 | 	u8 mode = i2c_smbus_read_byte_data(client, ADM9240_REG_TEMP_CONF) & 3; | 
 | 688 |  | 
 | 689 | 	data->vrm = vid_which_vrm(); /* need this to report vid as mV */ | 
 | 690 |  | 
 | 691 | 	dev_info(&client->dev, "Using VRM: %d.%d\n", data->vrm / 10, | 
 | 692 | 			data->vrm % 10); | 
 | 693 |  | 
 | 694 | 	if (conf & 1) { /* measurement cycle running: report state */ | 
 | 695 |  | 
 | 696 | 		dev_info(&client->dev, "status: config 0x%02x mode %u\n", | 
 | 697 | 				conf, mode); | 
 | 698 |  | 
 | 699 | 	} else { /* cold start: open limits before starting chip */ | 
 | 700 | 		int i; | 
 | 701 |  | 
 | 702 | 		for (i = 0; i < 6; i++) { | 
 | 703 | 			i2c_smbus_write_byte_data(client, | 
 | 704 | 					ADM9240_REG_IN_MIN(i), 0); | 
 | 705 | 			i2c_smbus_write_byte_data(client, | 
 | 706 | 					ADM9240_REG_IN_MAX(i), 255); | 
 | 707 | 		} | 
 | 708 | 		i2c_smbus_write_byte_data(client, | 
 | 709 | 				ADM9240_REG_FAN_MIN(0), 255); | 
 | 710 | 		i2c_smbus_write_byte_data(client, | 
 | 711 | 				ADM9240_REG_FAN_MIN(1), 255); | 
 | 712 | 		i2c_smbus_write_byte_data(client, | 
 | 713 | 				ADM9240_REG_TEMP_MAX(0), 127); | 
 | 714 | 		i2c_smbus_write_byte_data(client, | 
 | 715 | 				ADM9240_REG_TEMP_MAX(1), 127); | 
 | 716 |  | 
 | 717 | 		/* start measurement cycle */ | 
 | 718 | 		i2c_smbus_write_byte_data(client, ADM9240_REG_CONFIG, 1); | 
 | 719 |  | 
 | 720 | 		dev_info(&client->dev, | 
 | 721 | 			 "cold start: config was 0x%02x mode %u\n", conf, mode); | 
 | 722 | 	} | 
 | 723 | } | 
 | 724 |  | 
 | 725 | static int adm9240_probe(struct i2c_client *new_client, | 
 | 726 | 			 const struct i2c_device_id *id) | 
 | 727 | { | 
 | 728 | 	struct device *dev = &new_client->dev; | 
 | 729 | 	struct device *hwmon_dev; | 
 | 730 | 	struct adm9240_data *data; | 
 | 731 |  | 
 | 732 | 	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); | 
 | 733 | 	if (!data) | 
 | 734 | 		return -ENOMEM; | 
 | 735 |  | 
 | 736 | 	i2c_set_clientdata(new_client, data); | 
 | 737 | 	data->client = new_client; | 
 | 738 | 	mutex_init(&data->update_lock); | 
 | 739 |  | 
 | 740 | 	adm9240_init_client(new_client); | 
 | 741 |  | 
 | 742 | 	hwmon_dev = devm_hwmon_device_register_with_groups(dev, | 
 | 743 | 							   new_client->name, | 
 | 744 | 							   data, | 
 | 745 | 							   adm9240_groups); | 
 | 746 | 	return PTR_ERR_OR_ZERO(hwmon_dev); | 
 | 747 | } | 
 | 748 |  | 
 | 749 | static const struct i2c_device_id adm9240_id[] = { | 
 | 750 | 	{ "adm9240", adm9240 }, | 
 | 751 | 	{ "ds1780", ds1780 }, | 
 | 752 | 	{ "lm81", lm81 }, | 
 | 753 | 	{ } | 
 | 754 | }; | 
 | 755 | MODULE_DEVICE_TABLE(i2c, adm9240_id); | 
 | 756 |  | 
 | 757 | static struct i2c_driver adm9240_driver = { | 
 | 758 | 	.class		= I2C_CLASS_HWMON, | 
 | 759 | 	.driver = { | 
 | 760 | 		.name	= "adm9240", | 
 | 761 | 	}, | 
 | 762 | 	.probe		= adm9240_probe, | 
 | 763 | 	.id_table	= adm9240_id, | 
 | 764 | 	.detect		= adm9240_detect, | 
 | 765 | 	.address_list	= normal_i2c, | 
 | 766 | }; | 
 | 767 |  | 
 | 768 | module_i2c_driver(adm9240_driver); | 
 | 769 |  | 
 | 770 | MODULE_AUTHOR("Michiel Rook <michiel@grendelproject.nl>, " | 
 | 771 | 		"Grant Coady <gcoady.lk@gmail.com> and others"); | 
 | 772 | MODULE_DESCRIPTION("ADM9240/DS1780/LM81 driver"); | 
 | 773 | MODULE_LICENSE("GPL"); |