1 /* 2 * lm80.c - From lm_sensors, Linux kernel modules for hardware 3 * monitoring 4 * Copyright (C) 1998, 1999 Frodo Looijaard <frodol@dds.nl> 5 * and Philip Edelbrock <phil@netroedge.com> 6 * 7 * Ported to Linux 2.6 by Tiago Sousa <mirage@kaotik.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> 29 #include <linux/hwmon.h> 30 #include <linux/err.h> 31 #include <linux/mutex.h> 32 33 /* Addresses to scan */ 34 static unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 35 0x2d, 0x2e, 0x2f, I2C_CLIENT_END }; 36 37 /* Insmod parameters */ 38 I2C_CLIENT_INSMOD_1(lm80); 39 40 /* Many LM80 constants specified below */ 41 42 /* The LM80 registers */ 43 #define LM80_REG_IN_MAX(nr) (0x2a + (nr) * 2) 44 #define LM80_REG_IN_MIN(nr) (0x2b + (nr) * 2) 45 #define LM80_REG_IN(nr) (0x20 + (nr)) 46 47 #define LM80_REG_FAN1 0x28 48 #define LM80_REG_FAN2 0x29 49 #define LM80_REG_FAN_MIN(nr) (0x3b + (nr)) 50 51 #define LM80_REG_TEMP 0x27 52 #define LM80_REG_TEMP_HOT_MAX 0x38 53 #define LM80_REG_TEMP_HOT_HYST 0x39 54 #define LM80_REG_TEMP_OS_MAX 0x3a 55 #define LM80_REG_TEMP_OS_HYST 0x3b 56 57 #define LM80_REG_CONFIG 0x00 58 #define LM80_REG_ALARM1 0x01 59 #define LM80_REG_ALARM2 0x02 60 #define LM80_REG_MASK1 0x03 61 #define LM80_REG_MASK2 0x04 62 #define LM80_REG_FANDIV 0x05 63 #define LM80_REG_RES 0x06 64 65 66 /* Conversions. Rounding and limit checking is only done on the TO_REG 67 variants. Note that you should be a bit careful with which arguments 68 these macros are called: arguments may be evaluated more than once. 69 Fixing this is just not worth it. */ 70 71 #define IN_TO_REG(val) (SENSORS_LIMIT(((val)+5)/10,0,255)) 72 #define IN_FROM_REG(val) ((val)*10) 73 74 static inline unsigned char FAN_TO_REG(unsigned rpm, unsigned div) 75 { 76 if (rpm == 0) 77 return 255; 78 rpm = SENSORS_LIMIT(rpm, 1, 1000000); 79 return SENSORS_LIMIT((1350000 + rpm*div / 2) / (rpm*div), 1, 254); 80 } 81 82 #define FAN_FROM_REG(val,div) ((val)==0?-1:\ 83 (val)==255?0:1350000/((div)*(val))) 84 85 static inline long TEMP_FROM_REG(u16 temp) 86 { 87 long res; 88 89 temp >>= 4; 90 if (temp < 0x0800) 91 res = 625 * (long) temp; 92 else 93 res = ((long) temp - 0x01000) * 625; 94 95 return res / 10; 96 } 97 98 #define TEMP_LIMIT_FROM_REG(val) (((val)>0x80?(val)-0x100:(val))*1000) 99 100 #define TEMP_LIMIT_TO_REG(val) SENSORS_LIMIT((val)<0?\ 101 ((val)-500)/1000:((val)+500)/1000,0,255) 102 103 #define DIV_FROM_REG(val) (1 << (val)) 104 105 /* 106 * Client data (each client gets its own) 107 */ 108 109 struct lm80_data { 110 struct i2c_client client; 111 struct class_device *class_dev; 112 struct mutex update_lock; 113 char valid; /* !=0 if following fields are valid */ 114 unsigned long last_updated; /* In jiffies */ 115 116 u8 in[7]; /* Register value */ 117 u8 in_max[7]; /* Register value */ 118 u8 in_min[7]; /* Register value */ 119 u8 fan[2]; /* Register value */ 120 u8 fan_min[2]; /* Register value */ 121 u8 fan_div[2]; /* Register encoding, shifted right */ 122 u16 temp; /* Register values, shifted right */ 123 u8 temp_hot_max; /* Register value */ 124 u8 temp_hot_hyst; /* Register value */ 125 u8 temp_os_max; /* Register value */ 126 u8 temp_os_hyst; /* Register value */ 127 u16 alarms; /* Register encoding, combined */ 128 }; 129 130 /* 131 * Functions declaration 132 */ 133 134 static int lm80_attach_adapter(struct i2c_adapter *adapter); 135 static int lm80_detect(struct i2c_adapter *adapter, int address, int kind); 136 static void lm80_init_client(struct i2c_client *client); 137 static int lm80_detach_client(struct i2c_client *client); 138 static struct lm80_data *lm80_update_device(struct device *dev); 139 static int lm80_read_value(struct i2c_client *client, u8 reg); 140 static int lm80_write_value(struct i2c_client *client, u8 reg, u8 value); 141 142 /* 143 * Driver data (common to all clients) 144 */ 145 146 static struct i2c_driver lm80_driver = { 147 .driver = { 148 .name = "lm80", 149 }, 150 .id = I2C_DRIVERID_LM80, 151 .attach_adapter = lm80_attach_adapter, 152 .detach_client = lm80_detach_client, 153 }; 154 155 /* 156 * Sysfs stuff 157 */ 158 159 #define show_in(suffix, value) \ 160 static ssize_t show_in_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ 161 { \ 162 struct lm80_data *data = lm80_update_device(dev); \ 163 return sprintf(buf, "%d\n", IN_FROM_REG(data->value)); \ 164 } 165 show_in(min0, in_min[0]); 166 show_in(min1, in_min[1]); 167 show_in(min2, in_min[2]); 168 show_in(min3, in_min[3]); 169 show_in(min4, in_min[4]); 170 show_in(min5, in_min[5]); 171 show_in(min6, in_min[6]); 172 show_in(max0, in_max[0]); 173 show_in(max1, in_max[1]); 174 show_in(max2, in_max[2]); 175 show_in(max3, in_max[3]); 176 show_in(max4, in_max[4]); 177 show_in(max5, in_max[5]); 178 show_in(max6, in_max[6]); 179 show_in(input0, in[0]); 180 show_in(input1, in[1]); 181 show_in(input2, in[2]); 182 show_in(input3, in[3]); 183 show_in(input4, in[4]); 184 show_in(input5, in[5]); 185 show_in(input6, in[6]); 186 187 #define set_in(suffix, value, reg) \ 188 static ssize_t set_in_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ 189 size_t count) \ 190 { \ 191 struct i2c_client *client = to_i2c_client(dev); \ 192 struct lm80_data *data = i2c_get_clientdata(client); \ 193 long val = simple_strtol(buf, NULL, 10); \ 194 \ 195 mutex_lock(&data->update_lock);\ 196 data->value = IN_TO_REG(val); \ 197 lm80_write_value(client, reg, data->value); \ 198 mutex_unlock(&data->update_lock);\ 199 return count; \ 200 } 201 set_in(min0, in_min[0], LM80_REG_IN_MIN(0)); 202 set_in(min1, in_min[1], LM80_REG_IN_MIN(1)); 203 set_in(min2, in_min[2], LM80_REG_IN_MIN(2)); 204 set_in(min3, in_min[3], LM80_REG_IN_MIN(3)); 205 set_in(min4, in_min[4], LM80_REG_IN_MIN(4)); 206 set_in(min5, in_min[5], LM80_REG_IN_MIN(5)); 207 set_in(min6, in_min[6], LM80_REG_IN_MIN(6)); 208 set_in(max0, in_max[0], LM80_REG_IN_MAX(0)); 209 set_in(max1, in_max[1], LM80_REG_IN_MAX(1)); 210 set_in(max2, in_max[2], LM80_REG_IN_MAX(2)); 211 set_in(max3, in_max[3], LM80_REG_IN_MAX(3)); 212 set_in(max4, in_max[4], LM80_REG_IN_MAX(4)); 213 set_in(max5, in_max[5], LM80_REG_IN_MAX(5)); 214 set_in(max6, in_max[6], LM80_REG_IN_MAX(6)); 215 216 #define show_fan(suffix, value, div) \ 217 static ssize_t show_fan_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ 218 { \ 219 struct lm80_data *data = lm80_update_device(dev); \ 220 return sprintf(buf, "%d\n", FAN_FROM_REG(data->value, \ 221 DIV_FROM_REG(data->div))); \ 222 } 223 show_fan(min1, fan_min[0], fan_div[0]); 224 show_fan(min2, fan_min[1], fan_div[1]); 225 show_fan(input1, fan[0], fan_div[0]); 226 show_fan(input2, fan[1], fan_div[1]); 227 228 #define show_fan_div(suffix, value) \ 229 static ssize_t show_fan_div##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ 230 { \ 231 struct lm80_data *data = lm80_update_device(dev); \ 232 return sprintf(buf, "%d\n", DIV_FROM_REG(data->value)); \ 233 } 234 show_fan_div(1, fan_div[0]); 235 show_fan_div(2, fan_div[1]); 236 237 #define set_fan(suffix, value, reg, div) \ 238 static ssize_t set_fan_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ 239 size_t count) \ 240 { \ 241 struct i2c_client *client = to_i2c_client(dev); \ 242 struct lm80_data *data = i2c_get_clientdata(client); \ 243 long val = simple_strtoul(buf, NULL, 10); \ 244 \ 245 mutex_lock(&data->update_lock);\ 246 data->value = FAN_TO_REG(val, DIV_FROM_REG(data->div)); \ 247 lm80_write_value(client, reg, data->value); \ 248 mutex_unlock(&data->update_lock);\ 249 return count; \ 250 } 251 set_fan(min1, fan_min[0], LM80_REG_FAN_MIN(1), fan_div[0]); 252 set_fan(min2, fan_min[1], LM80_REG_FAN_MIN(2), fan_div[1]); 253 254 /* Note: we save and restore the fan minimum here, because its value is 255 determined in part by the fan divisor. This follows the principle of 256 least surprise; the user doesn't expect the fan minimum to change just 257 because the divisor changed. */ 258 static ssize_t set_fan_div(struct device *dev, const char *buf, 259 size_t count, int nr) 260 { 261 struct i2c_client *client = to_i2c_client(dev); 262 struct lm80_data *data = i2c_get_clientdata(client); 263 unsigned long min, val = simple_strtoul(buf, NULL, 10); 264 u8 reg; 265 266 /* Save fan_min */ 267 mutex_lock(&data->update_lock); 268 min = FAN_FROM_REG(data->fan_min[nr], 269 DIV_FROM_REG(data->fan_div[nr])); 270 271 switch (val) { 272 case 1: data->fan_div[nr] = 0; break; 273 case 2: data->fan_div[nr] = 1; break; 274 case 4: data->fan_div[nr] = 2; break; 275 case 8: data->fan_div[nr] = 3; break; 276 default: 277 dev_err(&client->dev, "fan_div value %ld not " 278 "supported. Choose one of 1, 2, 4 or 8!\n", val); 279 mutex_unlock(&data->update_lock); 280 return -EINVAL; 281 } 282 283 reg = (lm80_read_value(client, LM80_REG_FANDIV) & ~(3 << (2 * (nr + 1)))) 284 | (data->fan_div[nr] << (2 * (nr + 1))); 285 lm80_write_value(client, LM80_REG_FANDIV, reg); 286 287 /* Restore fan_min */ 288 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr])); 289 lm80_write_value(client, LM80_REG_FAN_MIN(nr + 1), data->fan_min[nr]); 290 mutex_unlock(&data->update_lock); 291 292 return count; 293 } 294 295 #define set_fan_div(number) \ 296 static ssize_t set_fan_div##number(struct device *dev, struct device_attribute *attr, const char *buf, \ 297 size_t count) \ 298 { \ 299 return set_fan_div(dev, buf, count, number - 1); \ 300 } 301 set_fan_div(1); 302 set_fan_div(2); 303 304 static ssize_t show_temp_input1(struct device *dev, struct device_attribute *attr, char *buf) 305 { 306 struct lm80_data *data = lm80_update_device(dev); 307 return sprintf(buf, "%ld\n", TEMP_FROM_REG(data->temp)); 308 } 309 310 #define show_temp(suffix, value) \ 311 static ssize_t show_temp_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ 312 { \ 313 struct lm80_data *data = lm80_update_device(dev); \ 314 return sprintf(buf, "%d\n", TEMP_LIMIT_FROM_REG(data->value)); \ 315 } 316 show_temp(hot_max, temp_hot_max); 317 show_temp(hot_hyst, temp_hot_hyst); 318 show_temp(os_max, temp_os_max); 319 show_temp(os_hyst, temp_os_hyst); 320 321 #define set_temp(suffix, value, reg) \ 322 static ssize_t set_temp_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ 323 size_t count) \ 324 { \ 325 struct i2c_client *client = to_i2c_client(dev); \ 326 struct lm80_data *data = i2c_get_clientdata(client); \ 327 long val = simple_strtoul(buf, NULL, 10); \ 328 \ 329 mutex_lock(&data->update_lock); \ 330 data->value = TEMP_LIMIT_TO_REG(val); \ 331 lm80_write_value(client, reg, data->value); \ 332 mutex_unlock(&data->update_lock); \ 333 return count; \ 334 } 335 set_temp(hot_max, temp_hot_max, LM80_REG_TEMP_HOT_MAX); 336 set_temp(hot_hyst, temp_hot_hyst, LM80_REG_TEMP_HOT_HYST); 337 set_temp(os_max, temp_os_max, LM80_REG_TEMP_OS_MAX); 338 set_temp(os_hyst, temp_os_hyst, LM80_REG_TEMP_OS_HYST); 339 340 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) 341 { 342 struct lm80_data *data = lm80_update_device(dev); 343 return sprintf(buf, "%u\n", data->alarms); 344 } 345 346 static DEVICE_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min0, set_in_min0); 347 static DEVICE_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min1, set_in_min1); 348 static DEVICE_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min2, set_in_min2); 349 static DEVICE_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min3, set_in_min3); 350 static DEVICE_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min4, set_in_min4); 351 static DEVICE_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min5, set_in_min5); 352 static DEVICE_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min6, set_in_min6); 353 static DEVICE_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max0, set_in_max0); 354 static DEVICE_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max1, set_in_max1); 355 static DEVICE_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max2, set_in_max2); 356 static DEVICE_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max3, set_in_max3); 357 static DEVICE_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max4, set_in_max4); 358 static DEVICE_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max5, set_in_max5); 359 static DEVICE_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max6, set_in_max6); 360 static DEVICE_ATTR(in0_input, S_IRUGO, show_in_input0, NULL); 361 static DEVICE_ATTR(in1_input, S_IRUGO, show_in_input1, NULL); 362 static DEVICE_ATTR(in2_input, S_IRUGO, show_in_input2, NULL); 363 static DEVICE_ATTR(in3_input, S_IRUGO, show_in_input3, NULL); 364 static DEVICE_ATTR(in4_input, S_IRUGO, show_in_input4, NULL); 365 static DEVICE_ATTR(in5_input, S_IRUGO, show_in_input5, NULL); 366 static DEVICE_ATTR(in6_input, S_IRUGO, show_in_input6, NULL); 367 static DEVICE_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min1, 368 set_fan_min1); 369 static DEVICE_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min2, 370 set_fan_min2); 371 static DEVICE_ATTR(fan1_input, S_IRUGO, show_fan_input1, NULL); 372 static DEVICE_ATTR(fan2_input, S_IRUGO, show_fan_input2, NULL); 373 static DEVICE_ATTR(fan1_div, S_IWUSR | S_IRUGO, show_fan_div1, set_fan_div1); 374 static DEVICE_ATTR(fan2_div, S_IWUSR | S_IRUGO, show_fan_div2, set_fan_div2); 375 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp_input1, NULL); 376 static DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_hot_max, 377 set_temp_hot_max); 378 static DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO, show_temp_hot_hyst, 379 set_temp_hot_hyst); 380 static DEVICE_ATTR(temp1_crit, S_IWUSR | S_IRUGO, show_temp_os_max, 381 set_temp_os_max); 382 static DEVICE_ATTR(temp1_crit_hyst, S_IWUSR | S_IRUGO, show_temp_os_hyst, 383 set_temp_os_hyst); 384 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); 385 386 /* 387 * Real code 388 */ 389 390 static int lm80_attach_adapter(struct i2c_adapter *adapter) 391 { 392 if (!(adapter->class & I2C_CLASS_HWMON)) 393 return 0; 394 return i2c_probe(adapter, &addr_data, lm80_detect); 395 } 396 397 static int lm80_detect(struct i2c_adapter *adapter, int address, int kind) 398 { 399 int i, cur; 400 struct i2c_client *new_client; 401 struct lm80_data *data; 402 int err = 0; 403 const char *name; 404 405 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 406 goto exit; 407 408 /* OK. For now, we presume we have a valid client. We now create the 409 client structure, even though we cannot fill it completely yet. 410 But it allows us to access lm80_{read,write}_value. */ 411 if (!(data = kzalloc(sizeof(struct lm80_data), GFP_KERNEL))) { 412 err = -ENOMEM; 413 goto exit; 414 } 415 416 new_client = &data->client; 417 i2c_set_clientdata(new_client, data); 418 new_client->addr = address; 419 new_client->adapter = adapter; 420 new_client->driver = &lm80_driver; 421 new_client->flags = 0; 422 423 /* Now, we do the remaining detection. It is lousy. */ 424 if (lm80_read_value(new_client, LM80_REG_ALARM2) & 0xc0) 425 goto error_free; 426 for (i = 0x2a; i <= 0x3d; i++) { 427 cur = i2c_smbus_read_byte_data(new_client, i); 428 if ((i2c_smbus_read_byte_data(new_client, i + 0x40) != cur) 429 || (i2c_smbus_read_byte_data(new_client, i + 0x80) != cur) 430 || (i2c_smbus_read_byte_data(new_client, i + 0xc0) != cur)) 431 goto error_free; 432 } 433 434 /* Determine the chip type - only one kind supported! */ 435 kind = lm80; 436 name = "lm80"; 437 438 /* Fill in the remaining client fields and put it into the global list */ 439 strlcpy(new_client->name, name, I2C_NAME_SIZE); 440 data->valid = 0; 441 mutex_init(&data->update_lock); 442 443 /* Tell the I2C layer a new client has arrived */ 444 if ((err = i2c_attach_client(new_client))) 445 goto error_free; 446 447 /* Initialize the LM80 chip */ 448 lm80_init_client(new_client); 449 450 /* A few vars need to be filled upon startup */ 451 data->fan_min[0] = lm80_read_value(new_client, LM80_REG_FAN_MIN(1)); 452 data->fan_min[1] = lm80_read_value(new_client, LM80_REG_FAN_MIN(2)); 453 454 /* Register sysfs hooks */ 455 data->class_dev = hwmon_device_register(&new_client->dev); 456 if (IS_ERR(data->class_dev)) { 457 err = PTR_ERR(data->class_dev); 458 goto error_detach; 459 } 460 461 device_create_file(&new_client->dev, &dev_attr_in0_min); 462 device_create_file(&new_client->dev, &dev_attr_in1_min); 463 device_create_file(&new_client->dev, &dev_attr_in2_min); 464 device_create_file(&new_client->dev, &dev_attr_in3_min); 465 device_create_file(&new_client->dev, &dev_attr_in4_min); 466 device_create_file(&new_client->dev, &dev_attr_in5_min); 467 device_create_file(&new_client->dev, &dev_attr_in6_min); 468 device_create_file(&new_client->dev, &dev_attr_in0_max); 469 device_create_file(&new_client->dev, &dev_attr_in1_max); 470 device_create_file(&new_client->dev, &dev_attr_in2_max); 471 device_create_file(&new_client->dev, &dev_attr_in3_max); 472 device_create_file(&new_client->dev, &dev_attr_in4_max); 473 device_create_file(&new_client->dev, &dev_attr_in5_max); 474 device_create_file(&new_client->dev, &dev_attr_in6_max); 475 device_create_file(&new_client->dev, &dev_attr_in0_input); 476 device_create_file(&new_client->dev, &dev_attr_in1_input); 477 device_create_file(&new_client->dev, &dev_attr_in2_input); 478 device_create_file(&new_client->dev, &dev_attr_in3_input); 479 device_create_file(&new_client->dev, &dev_attr_in4_input); 480 device_create_file(&new_client->dev, &dev_attr_in5_input); 481 device_create_file(&new_client->dev, &dev_attr_in6_input); 482 device_create_file(&new_client->dev, &dev_attr_fan1_min); 483 device_create_file(&new_client->dev, &dev_attr_fan2_min); 484 device_create_file(&new_client->dev, &dev_attr_fan1_input); 485 device_create_file(&new_client->dev, &dev_attr_fan2_input); 486 device_create_file(&new_client->dev, &dev_attr_fan1_div); 487 device_create_file(&new_client->dev, &dev_attr_fan2_div); 488 device_create_file(&new_client->dev, &dev_attr_temp1_input); 489 device_create_file(&new_client->dev, &dev_attr_temp1_max); 490 device_create_file(&new_client->dev, &dev_attr_temp1_max_hyst); 491 device_create_file(&new_client->dev, &dev_attr_temp1_crit); 492 device_create_file(&new_client->dev, &dev_attr_temp1_crit_hyst); 493 device_create_file(&new_client->dev, &dev_attr_alarms); 494 495 return 0; 496 497 error_detach: 498 i2c_detach_client(new_client); 499 error_free: 500 kfree(data); 501 exit: 502 return err; 503 } 504 505 static int lm80_detach_client(struct i2c_client *client) 506 { 507 struct lm80_data *data = i2c_get_clientdata(client); 508 int err; 509 510 hwmon_device_unregister(data->class_dev); 511 512 if ((err = i2c_detach_client(client))) 513 return err; 514 515 kfree(data); 516 return 0; 517 } 518 519 static int lm80_read_value(struct i2c_client *client, u8 reg) 520 { 521 return i2c_smbus_read_byte_data(client, reg); 522 } 523 524 static int lm80_write_value(struct i2c_client *client, u8 reg, u8 value) 525 { 526 return i2c_smbus_write_byte_data(client, reg, value); 527 } 528 529 /* Called when we have found a new LM80. */ 530 static void lm80_init_client(struct i2c_client *client) 531 { 532 /* Reset all except Watchdog values and last conversion values 533 This sets fan-divs to 2, among others. This makes most other 534 initializations unnecessary */ 535 lm80_write_value(client, LM80_REG_CONFIG, 0x80); 536 /* Set 11-bit temperature resolution */ 537 lm80_write_value(client, LM80_REG_RES, 0x08); 538 539 /* Start monitoring */ 540 lm80_write_value(client, LM80_REG_CONFIG, 0x01); 541 } 542 543 static struct lm80_data *lm80_update_device(struct device *dev) 544 { 545 struct i2c_client *client = to_i2c_client(dev); 546 struct lm80_data *data = i2c_get_clientdata(client); 547 int i; 548 549 mutex_lock(&data->update_lock); 550 551 if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) { 552 dev_dbg(&client->dev, "Starting lm80 update\n"); 553 for (i = 0; i <= 6; i++) { 554 data->in[i] = 555 lm80_read_value(client, LM80_REG_IN(i)); 556 data->in_min[i] = 557 lm80_read_value(client, LM80_REG_IN_MIN(i)); 558 data->in_max[i] = 559 lm80_read_value(client, LM80_REG_IN_MAX(i)); 560 } 561 data->fan[0] = lm80_read_value(client, LM80_REG_FAN1); 562 data->fan_min[0] = 563 lm80_read_value(client, LM80_REG_FAN_MIN(1)); 564 data->fan[1] = lm80_read_value(client, LM80_REG_FAN2); 565 data->fan_min[1] = 566 lm80_read_value(client, LM80_REG_FAN_MIN(2)); 567 568 data->temp = 569 (lm80_read_value(client, LM80_REG_TEMP) << 8) | 570 (lm80_read_value(client, LM80_REG_RES) & 0xf0); 571 data->temp_os_max = 572 lm80_read_value(client, LM80_REG_TEMP_OS_MAX); 573 data->temp_os_hyst = 574 lm80_read_value(client, LM80_REG_TEMP_OS_HYST); 575 data->temp_hot_max = 576 lm80_read_value(client, LM80_REG_TEMP_HOT_MAX); 577 data->temp_hot_hyst = 578 lm80_read_value(client, LM80_REG_TEMP_HOT_HYST); 579 580 i = lm80_read_value(client, LM80_REG_FANDIV); 581 data->fan_div[0] = (i >> 2) & 0x03; 582 data->fan_div[1] = (i >> 4) & 0x03; 583 data->alarms = lm80_read_value(client, LM80_REG_ALARM1) + 584 (lm80_read_value(client, LM80_REG_ALARM2) << 8); 585 data->last_updated = jiffies; 586 data->valid = 1; 587 } 588 589 mutex_unlock(&data->update_lock); 590 591 return data; 592 } 593 594 static int __init sensors_lm80_init(void) 595 { 596 return i2c_add_driver(&lm80_driver); 597 } 598 599 static void __exit sensors_lm80_exit(void) 600 { 601 i2c_del_driver(&lm80_driver); 602 } 603 604 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl> and " 605 "Philip Edelbrock <phil@netroedge.com>"); 606 MODULE_DESCRIPTION("LM80 driver"); 607 MODULE_LICENSE("GPL"); 608 609 module_init(sensors_lm80_init); 610 module_exit(sensors_lm80_exit); 611