Blame view
drivers/hwmon/lm77.c
13.1 KB
1da177e4c Linux-2.6.12-rc2 |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 |
/* lm77.c - Part of lm_sensors, Linux kernel modules for hardware monitoring Copyright (c) 2004 Andras BALI <drewie@freemail.hu> Heavily based on lm75.c by Frodo Looijaard <frodol@dds.nl>. The LM77 is a temperature sensor and thermal window comparator with 0.5 deg resolution made by National Semiconductor. Complete datasheet can be obtained at their site: http://www.national.com/pf/LM/LM77.html This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ |
1da177e4c Linux-2.6.12-rc2 |
27 28 29 30 31 |
#include <linux/module.h> #include <linux/init.h> #include <linux/slab.h> #include <linux/jiffies.h> #include <linux/i2c.h> |
943b0830c [PATCH] I2C hwmon... |
32 |
#include <linux/hwmon.h> |
1f52af0f6 hwmon: (lm77) Add... |
33 |
#include <linux/hwmon-sysfs.h> |
943b0830c [PATCH] I2C hwmon... |
34 |
#include <linux/err.h> |
9a61bf630 [PATCH] hwmon: Se... |
35 |
#include <linux/mutex.h> |
1da177e4c Linux-2.6.12-rc2 |
36 37 |
/* Addresses to scan */ |
25e9c86d5 hwmon: normal_i2c... |
38 39 |
static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b, I2C_CLIENT_END }; |
1da177e4c Linux-2.6.12-rc2 |
40 |
|
1da177e4c Linux-2.6.12-rc2 |
41 42 43 44 45 46 47 48 49 50 |
/* The LM77 registers */ #define LM77_REG_TEMP 0x00 #define LM77_REG_CONF 0x01 #define LM77_REG_TEMP_HYST 0x02 #define LM77_REG_TEMP_CRIT 0x03 #define LM77_REG_TEMP_MIN 0x04 #define LM77_REG_TEMP_MAX 0x05 /* Each client has this additional data */ struct lm77_data { |
1beeffe43 hwmon: Convert fr... |
51 |
struct device *hwmon_dev; |
9a61bf630 [PATCH] hwmon: Se... |
52 |
struct mutex update_lock; |
1da177e4c Linux-2.6.12-rc2 |
53 54 55 56 57 58 59 60 61 |
char valid; unsigned long last_updated; /* In jiffies */ int temp_input; /* Temperatures */ int temp_crit; int temp_min; int temp_max; int temp_hyst; u8 alarms; }; |
a189dd62d hwmon: (lm77) Con... |
62 63 |
static int lm77_probe(struct i2c_client *client, const struct i2c_device_id *id); |
310ec7921 i2c: Drop the kin... |
64 |
static int lm77_detect(struct i2c_client *client, struct i2c_board_info *info); |
1da177e4c Linux-2.6.12-rc2 |
65 |
static void lm77_init_client(struct i2c_client *client); |
a189dd62d hwmon: (lm77) Con... |
66 |
static int lm77_remove(struct i2c_client *client); |
1da177e4c Linux-2.6.12-rc2 |
67 68 69 70 |
static u16 lm77_read_value(struct i2c_client *client, u8 reg); static int lm77_write_value(struct i2c_client *client, u8 reg, u16 value); static struct lm77_data *lm77_update_device(struct device *dev); |
a189dd62d hwmon: (lm77) Con... |
71 |
static const struct i2c_device_id lm77_id[] = { |
1f86df49d i2c: Drop I2C_CLI... |
72 |
{ "lm77", 0 }, |
a189dd62d hwmon: (lm77) Con... |
73 74 75 |
{ } }; MODULE_DEVICE_TABLE(i2c, lm77_id); |
1da177e4c Linux-2.6.12-rc2 |
76 77 |
/* This is the driver that will be inserted */ static struct i2c_driver lm77_driver = { |
a189dd62d hwmon: (lm77) Con... |
78 |
.class = I2C_CLASS_HWMON, |
cdaf79349 [PATCH] i2c: Drop... |
79 |
.driver = { |
cdaf79349 [PATCH] i2c: Drop... |
80 81 |
.name = "lm77", }, |
a189dd62d hwmon: (lm77) Con... |
82 83 84 85 |
.probe = lm77_probe, .remove = lm77_remove, .id_table = lm77_id, .detect = lm77_detect, |
c3813d6af i2c: Get rid of s... |
86 |
.address_list = normal_i2c, |
1da177e4c Linux-2.6.12-rc2 |
87 88 89 90 91 92 93 94 |
}; /* straight from the datasheet */ #define LM77_TEMP_MIN (-55000) #define LM77_TEMP_MAX 125000 /* In the temperature registers, the low 3 bits are not part of the temperature values; they are the status bits. */ |
413b64515 [PATCH] hwmon: Fi... |
95 |
static inline s16 LM77_TEMP_TO_REG(int temp) |
1da177e4c Linux-2.6.12-rc2 |
96 97 |
{ int ntemp = SENSORS_LIMIT(temp, LM77_TEMP_MIN, LM77_TEMP_MAX); |
413b64515 [PATCH] hwmon: Fi... |
98 |
return (ntemp / 500) * 8; |
1da177e4c Linux-2.6.12-rc2 |
99 |
} |
413b64515 [PATCH] hwmon: Fi... |
100 |
static inline int LM77_TEMP_FROM_REG(s16 reg) |
1da177e4c Linux-2.6.12-rc2 |
101 |
{ |
413b64515 [PATCH] hwmon: Fi... |
102 |
return (reg / 8) * 500; |
1da177e4c Linux-2.6.12-rc2 |
103 104 105 106 107 108 |
} /* sysfs stuff */ /* read routines for temperature limits */ #define show(value) \ |
8627f9ba5 [PATCH] Driver Co... |
109 |
static ssize_t show_##value(struct device *dev, struct device_attribute *attr, char *buf) \ |
1da177e4c Linux-2.6.12-rc2 |
110 111 112 113 114 115 116 117 118 119 |
{ \ struct lm77_data *data = lm77_update_device(dev); \ return sprintf(buf, "%d ", data->value); \ } show(temp_input); show(temp_crit); show(temp_min); show(temp_max); |
1da177e4c Linux-2.6.12-rc2 |
120 121 |
/* read routines for hysteresis values */ |
8627f9ba5 [PATCH] Driver Co... |
122 |
static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4c Linux-2.6.12-rc2 |
123 124 125 126 127 |
{ struct lm77_data *data = lm77_update_device(dev); return sprintf(buf, "%d ", data->temp_crit - data->temp_hyst); } |
8627f9ba5 [PATCH] Driver Co... |
128 |
static ssize_t show_temp_min_hyst(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4c Linux-2.6.12-rc2 |
129 130 131 132 133 |
{ struct lm77_data *data = lm77_update_device(dev); return sprintf(buf, "%d ", data->temp_min + data->temp_hyst); } |
8627f9ba5 [PATCH] Driver Co... |
134 |
static ssize_t show_temp_max_hyst(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4c Linux-2.6.12-rc2 |
135 136 137 138 139 140 141 142 |
{ struct lm77_data *data = lm77_update_device(dev); return sprintf(buf, "%d ", data->temp_max - data->temp_hyst); } /* write routines */ #define set(value, reg) \ |
8627f9ba5 [PATCH] Driver Co... |
143 |
static ssize_t set_##value(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ |
1da177e4c Linux-2.6.12-rc2 |
144 145 146 |
{ \ struct i2c_client *client = to_i2c_client(dev); \ struct lm77_data *data = i2c_get_clientdata(client); \ |
5bfedac04 hwmon: Allow writ... |
147 |
long val = simple_strtol(buf, NULL, 10); \ |
1da177e4c Linux-2.6.12-rc2 |
148 |
\ |
9a61bf630 [PATCH] hwmon: Se... |
149 |
mutex_lock(&data->update_lock); \ |
1da177e4c Linux-2.6.12-rc2 |
150 151 |
data->value = val; \ lm77_write_value(client, reg, LM77_TEMP_TO_REG(data->value)); \ |
9a61bf630 [PATCH] hwmon: Se... |
152 |
mutex_unlock(&data->update_lock); \ |
1da177e4c Linux-2.6.12-rc2 |
153 154 155 156 157 158 159 160 |
return count; \ } set(temp_min, LM77_REG_TEMP_MIN); set(temp_max, LM77_REG_TEMP_MAX); /* hysteresis is stored as a relative value on the chip, so it has to be converted first */ |
8627f9ba5 [PATCH] Driver Co... |
161 |
static ssize_t set_temp_crit_hyst(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
1da177e4c Linux-2.6.12-rc2 |
162 163 164 165 |
{ struct i2c_client *client = to_i2c_client(dev); struct lm77_data *data = i2c_get_clientdata(client); unsigned long val = simple_strtoul(buf, NULL, 10); |
9a61bf630 [PATCH] hwmon: Se... |
166 |
mutex_lock(&data->update_lock); |
1da177e4c Linux-2.6.12-rc2 |
167 168 169 |
data->temp_hyst = data->temp_crit - val; lm77_write_value(client, LM77_REG_TEMP_HYST, LM77_TEMP_TO_REG(data->temp_hyst)); |
9a61bf630 [PATCH] hwmon: Se... |
170 |
mutex_unlock(&data->update_lock); |
1da177e4c Linux-2.6.12-rc2 |
171 172 173 174 |
return count; } /* preserve hysteresis when setting T_crit */ |
8627f9ba5 [PATCH] Driver Co... |
175 |
static ssize_t set_temp_crit(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
1da177e4c Linux-2.6.12-rc2 |
176 177 178 179 180 181 |
{ struct i2c_client *client = to_i2c_client(dev); struct lm77_data *data = i2c_get_clientdata(client); long val = simple_strtoul(buf, NULL, 10); int oldcrithyst; |
9a61bf630 [PATCH] hwmon: Se... |
182 |
mutex_lock(&data->update_lock); |
1da177e4c Linux-2.6.12-rc2 |
183 184 185 186 187 188 189 |
oldcrithyst = data->temp_crit - data->temp_hyst; data->temp_crit = val; data->temp_hyst = data->temp_crit - oldcrithyst; lm77_write_value(client, LM77_REG_TEMP_CRIT, LM77_TEMP_TO_REG(data->temp_crit)); lm77_write_value(client, LM77_REG_TEMP_HYST, LM77_TEMP_TO_REG(data->temp_hyst)); |
9a61bf630 [PATCH] hwmon: Se... |
190 |
mutex_unlock(&data->update_lock); |
1da177e4c Linux-2.6.12-rc2 |
191 192 |
return count; } |
1f52af0f6 hwmon: (lm77) Add... |
193 194 195 196 197 198 199 200 |
static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, char *buf) { int bitnr = to_sensor_dev_attr(attr)->index; struct lm77_data *data = lm77_update_device(dev); return sprintf(buf, "%u ", (data->alarms >> bitnr) & 1); } |
1da177e4c Linux-2.6.12-rc2 |
201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 |
static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp_input, NULL); static DEVICE_ATTR(temp1_crit, S_IWUSR | S_IRUGO, show_temp_crit, set_temp_crit); static DEVICE_ATTR(temp1_min, S_IWUSR | S_IRUGO, show_temp_min, set_temp_min); static DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_max, set_temp_max); static DEVICE_ATTR(temp1_crit_hyst, S_IWUSR | S_IRUGO, show_temp_crit_hyst, set_temp_crit_hyst); static DEVICE_ATTR(temp1_min_hyst, S_IRUGO, show_temp_min_hyst, NULL); static DEVICE_ATTR(temp1_max_hyst, S_IRUGO, show_temp_max_hyst, NULL); |
1f52af0f6 hwmon: (lm77) Add... |
216 217 218 |
static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 2); static SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_alarm, NULL, 0); static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 1); |
1da177e4c Linux-2.6.12-rc2 |
219 |
|
0501a3816 hwmon: Fix unchec... |
220 221 222 223 224 225 226 227 |
static struct attribute *lm77_attributes[] = { &dev_attr_temp1_input.attr, &dev_attr_temp1_crit.attr, &dev_attr_temp1_min.attr, &dev_attr_temp1_max.attr, &dev_attr_temp1_crit_hyst.attr, &dev_attr_temp1_min_hyst.attr, &dev_attr_temp1_max_hyst.attr, |
1f52af0f6 hwmon: (lm77) Add... |
228 229 230 |
&sensor_dev_attr_temp1_crit_alarm.dev_attr.attr, &sensor_dev_attr_temp1_min_alarm.dev_attr.attr, &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, |
0501a3816 hwmon: Fix unchec... |
231 232 233 234 235 236 |
NULL }; static const struct attribute_group lm77_group = { .attrs = lm77_attributes, }; |
a189dd62d hwmon: (lm77) Con... |
237 |
/* Return 0 if detection is successful, -ENODEV otherwise */ |
310ec7921 i2c: Drop the kin... |
238 |
static int lm77_detect(struct i2c_client *new_client, |
a189dd62d hwmon: (lm77) Con... |
239 |
struct i2c_board_info *info) |
1da177e4c Linux-2.6.12-rc2 |
240 |
{ |
a189dd62d hwmon: (lm77) Con... |
241 |
struct i2c_adapter *adapter = new_client->adapter; |
747d9bedc hwmon: (lm77) Cle... |
242 |
int i, cur, conf, hyst, crit, min, max; |
1da177e4c Linux-2.6.12-rc2 |
243 244 245 |
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA)) |
a189dd62d hwmon: (lm77) Con... |
246 |
return -ENODEV; |
1da177e4c Linux-2.6.12-rc2 |
247 248 249 250 251 252 253 254 255 256 257 258 |
/* Here comes the remaining detection. Since the LM77 has no register dedicated to identification, we have to rely on the following tricks: 1. the high 4 bits represent the sign and thus they should always be the same 2. the high 3 bits are unused in the configuration register 3. addresses 0x06 and 0x07 return the last read value 4. registers cycling over 8-address boundaries Word-sized registers are high-byte first. */ |
1da177e4c Linux-2.6.12-rc2 |
259 |
|
747d9bedc hwmon: (lm77) Cle... |
260 261 262 263 264 265 266 267 268 269 270 271 272 |
/* addresses cycling */ cur = i2c_smbus_read_word_data(new_client, 0); conf = i2c_smbus_read_byte_data(new_client, 1); hyst = i2c_smbus_read_word_data(new_client, 2); crit = i2c_smbus_read_word_data(new_client, 3); min = i2c_smbus_read_word_data(new_client, 4); max = i2c_smbus_read_word_data(new_client, 5); for (i = 8; i <= 0xff; i += 8) { if (i2c_smbus_read_byte_data(new_client, i + 1) != conf || i2c_smbus_read_word_data(new_client, i + 2) != hyst || i2c_smbus_read_word_data(new_client, i + 3) != crit || i2c_smbus_read_word_data(new_client, i + 4) != min || i2c_smbus_read_word_data(new_client, i + 5) != max) |
a189dd62d hwmon: (lm77) Con... |
273 |
return -ENODEV; |
747d9bedc hwmon: (lm77) Cle... |
274 |
} |
1da177e4c Linux-2.6.12-rc2 |
275 |
|
747d9bedc hwmon: (lm77) Cle... |
276 277 278 279 280 281 282 |
/* sign bits */ if (((cur & 0x00f0) != 0xf0 && (cur & 0x00f0) != 0x0) || ((hyst & 0x00f0) != 0xf0 && (hyst & 0x00f0) != 0x0) || ((crit & 0x00f0) != 0xf0 && (crit & 0x00f0) != 0x0) || ((min & 0x00f0) != 0xf0 && (min & 0x00f0) != 0x0) || ((max & 0x00f0) != 0xf0 && (max & 0x00f0) != 0x0)) return -ENODEV; |
1da177e4c Linux-2.6.12-rc2 |
283 |
|
747d9bedc hwmon: (lm77) Cle... |
284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 |
/* unused bits */ if (conf & 0xe0) return -ENODEV; /* 0x06 and 0x07 return the last read value */ cur = i2c_smbus_read_word_data(new_client, 0); if (i2c_smbus_read_word_data(new_client, 6) != cur || i2c_smbus_read_word_data(new_client, 7) != cur) return -ENODEV; hyst = i2c_smbus_read_word_data(new_client, 2); if (i2c_smbus_read_word_data(new_client, 6) != hyst || i2c_smbus_read_word_data(new_client, 7) != hyst) return -ENODEV; min = i2c_smbus_read_word_data(new_client, 4); if (i2c_smbus_read_word_data(new_client, 6) != min || i2c_smbus_read_word_data(new_client, 7) != min) return -ENODEV; |
1da177e4c Linux-2.6.12-rc2 |
301 |
|
a189dd62d hwmon: (lm77) Con... |
302 |
strlcpy(info->type, "lm77", I2C_NAME_SIZE); |
1da177e4c Linux-2.6.12-rc2 |
303 |
|
a189dd62d hwmon: (lm77) Con... |
304 305 306 307 308 309 310 311 312 313 314 315 316 |
return 0; } static int lm77_probe(struct i2c_client *new_client, const struct i2c_device_id *id) { struct lm77_data *data; int err; data = kzalloc(sizeof(struct lm77_data), GFP_KERNEL); if (!data) { err = -ENOMEM; goto exit; |
1da177e4c Linux-2.6.12-rc2 |
317 |
} |
a189dd62d hwmon: (lm77) Con... |
318 |
i2c_set_clientdata(new_client, data); |
1da177e4c Linux-2.6.12-rc2 |
319 |
data->valid = 0; |
9a61bf630 [PATCH] hwmon: Se... |
320 |
mutex_init(&data->update_lock); |
1da177e4c Linux-2.6.12-rc2 |
321 |
|
1da177e4c Linux-2.6.12-rc2 |
322 323 324 325 |
/* Initialize the LM77 chip */ lm77_init_client(new_client); /* Register sysfs hooks */ |
0501a3816 hwmon: Fix unchec... |
326 |
if ((err = sysfs_create_group(&new_client->dev.kobj, &lm77_group))) |
a189dd62d hwmon: (lm77) Con... |
327 |
goto exit_free; |
0501a3816 hwmon: Fix unchec... |
328 |
|
1beeffe43 hwmon: Convert fr... |
329 330 331 |
data->hwmon_dev = hwmon_device_register(&new_client->dev); if (IS_ERR(data->hwmon_dev)) { err = PTR_ERR(data->hwmon_dev); |
0501a3816 hwmon: Fix unchec... |
332 |
goto exit_remove; |
943b0830c [PATCH] I2C hwmon... |
333 |
} |
1da177e4c Linux-2.6.12-rc2 |
334 |
return 0; |
0501a3816 hwmon: Fix unchec... |
335 336 |
exit_remove: sysfs_remove_group(&new_client->dev.kobj, &lm77_group); |
1da177e4c Linux-2.6.12-rc2 |
337 338 339 340 341 |
exit_free: kfree(data); exit: return err; } |
a189dd62d hwmon: (lm77) Con... |
342 |
static int lm77_remove(struct i2c_client *client) |
1da177e4c Linux-2.6.12-rc2 |
343 |
{ |
943b0830c [PATCH] I2C hwmon... |
344 |
struct lm77_data *data = i2c_get_clientdata(client); |
1beeffe43 hwmon: Convert fr... |
345 |
hwmon_device_unregister(data->hwmon_dev); |
0501a3816 hwmon: Fix unchec... |
346 |
sysfs_remove_group(&client->dev.kobj, &lm77_group); |
943b0830c [PATCH] I2C hwmon... |
347 |
kfree(data); |
1da177e4c Linux-2.6.12-rc2 |
348 349 350 351 352 353 354 355 356 357 |
return 0; } /* All registers are word-sized, except for the configuration register. The LM77 uses the high-byte first convention. */ static u16 lm77_read_value(struct i2c_client *client, u8 reg) { if (reg == LM77_REG_CONF) return i2c_smbus_read_byte_data(client, reg); else |
90f4102ce hwmon: Use i2c_sm... |
358 |
return i2c_smbus_read_word_swapped(client, reg); |
1da177e4c Linux-2.6.12-rc2 |
359 360 361 362 363 364 365 |
} static int lm77_write_value(struct i2c_client *client, u8 reg, u16 value) { if (reg == LM77_REG_CONF) return i2c_smbus_write_byte_data(client, reg, value); else |
90f4102ce hwmon: Use i2c_sm... |
366 |
return i2c_smbus_write_word_swapped(client, reg, value); |
1da177e4c Linux-2.6.12-rc2 |
367 368 369 370 371 372 373 374 375 376 377 378 379 380 |
} static void lm77_init_client(struct i2c_client *client) { /* Initialize the LM77 chip - turn off shutdown mode */ int conf = lm77_read_value(client, LM77_REG_CONF); if (conf & 1) lm77_write_value(client, LM77_REG_CONF, conf & 0xfe); } static struct lm77_data *lm77_update_device(struct device *dev) { struct i2c_client *client = to_i2c_client(dev); struct lm77_data *data = i2c_get_clientdata(client); |
9a61bf630 [PATCH] hwmon: Se... |
381 |
mutex_lock(&data->update_lock); |
1da177e4c Linux-2.6.12-rc2 |
382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 |
if (time_after(jiffies, data->last_updated + HZ + HZ / 2) || !data->valid) { dev_dbg(&client->dev, "Starting lm77 update "); data->temp_input = LM77_TEMP_FROM_REG(lm77_read_value(client, LM77_REG_TEMP)); data->temp_hyst = LM77_TEMP_FROM_REG(lm77_read_value(client, LM77_REG_TEMP_HYST)); data->temp_crit = LM77_TEMP_FROM_REG(lm77_read_value(client, LM77_REG_TEMP_CRIT)); data->temp_min = LM77_TEMP_FROM_REG(lm77_read_value(client, LM77_REG_TEMP_MIN)); data->temp_max = LM77_TEMP_FROM_REG(lm77_read_value(client, LM77_REG_TEMP_MAX)); data->alarms = lm77_read_value(client, LM77_REG_TEMP) & 0x0007; data->last_updated = jiffies; data->valid = 1; } |
9a61bf630 [PATCH] hwmon: Se... |
407 |
mutex_unlock(&data->update_lock); |
1da177e4c Linux-2.6.12-rc2 |
408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 |
return data; } static int __init sensors_lm77_init(void) { return i2c_add_driver(&lm77_driver); } static void __exit sensors_lm77_exit(void) { i2c_del_driver(&lm77_driver); } MODULE_AUTHOR("Andras BALI <drewie@freemail.hu>"); MODULE_DESCRIPTION("LM77 driver"); MODULE_LICENSE("GPL"); module_init(sensors_lm77_init); module_exit(sensors_lm77_exit); |