1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/module.h>
22#include <linux/init.h>
23#include <linux/slab.h>
24#include <linux/jiffies.h>
25#include <linux/i2c.h>
26#include <linux/hwmon.h>
27#include <linux/hwmon-sysfs.h>
28#include <linux/err.h>
29#include <linux/mutex.h>
30#include <linux/of.h>
31#include <linux/thermal.h>
32#include "lm75.h"
33
34
35
36
37
38
39enum lm75_type {
40 adt75,
41 ds1775,
42 ds75,
43 ds7505,
44 g751,
45 lm75,
46 lm75a,
47 lm75b,
48 max6625,
49 max6626,
50 mcp980x,
51 stds75,
52 tcn75,
53 tmp100,
54 tmp101,
55 tmp105,
56 tmp112,
57 tmp175,
58 tmp275,
59 tmp75,
60 tmp75c,
61};
62
63
64static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b, 0x4c,
65 0x4d, 0x4e, 0x4f, I2C_CLIENT_END };
66
67
68
69#define LM75_REG_CONF 0x01
70static const u8 LM75_REG_TEMP[3] = {
71 0x00,
72 0x03,
73 0x02,
74};
75
76
77struct lm75_data {
78 struct i2c_client *client;
79 struct device *hwmon_dev;
80 struct thermal_zone_device *tz;
81 struct mutex update_lock;
82 u8 orig_conf;
83 u8 resolution;
84 u8 resolution_limits;
85 char valid;
86 unsigned long last_updated;
87 unsigned long sample_time;
88 s16 temp[3];
89
90
91
92};
93
94static int lm75_read_value(struct i2c_client *client, u8 reg);
95static int lm75_write_value(struct i2c_client *client, u8 reg, u16 value);
96static struct lm75_data *lm75_update_device(struct device *dev);
97
98
99
100
101static inline long lm75_reg_to_mc(s16 temp, u8 resolution)
102{
103 return ((temp >> (16 - resolution)) * 1000) >> (resolution - 8);
104}
105
106
107
108static int lm75_read_temp(void *dev, int *temp)
109{
110 struct lm75_data *data = lm75_update_device(dev);
111
112 if (IS_ERR(data))
113 return PTR_ERR(data);
114
115 *temp = lm75_reg_to_mc(data->temp[0], data->resolution);
116
117 return 0;
118}
119
120static ssize_t show_temp(struct device *dev, struct device_attribute *da,
121 char *buf)
122{
123 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
124 struct lm75_data *data = lm75_update_device(dev);
125
126 if (IS_ERR(data))
127 return PTR_ERR(data);
128
129 return sprintf(buf, "%ld\n", lm75_reg_to_mc(data->temp[attr->index],
130 data->resolution));
131}
132
133static ssize_t set_temp(struct device *dev, struct device_attribute *da,
134 const char *buf, size_t count)
135{
136 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
137 struct lm75_data *data = dev_get_drvdata(dev);
138 struct i2c_client *client = data->client;
139 int nr = attr->index;
140 long temp;
141 int error;
142 u8 resolution;
143
144 error = kstrtol(buf, 10, &temp);
145 if (error)
146 return error;
147
148
149
150
151
152 if (attr->index && data->resolution_limits)
153 resolution = data->resolution_limits;
154 else
155 resolution = data->resolution;
156
157 mutex_lock(&data->update_lock);
158 temp = clamp_val(temp, LM75_TEMP_MIN, LM75_TEMP_MAX);
159 data->temp[nr] = DIV_ROUND_CLOSEST(temp << (resolution - 8),
160 1000) << (16 - resolution);
161 lm75_write_value(client, LM75_REG_TEMP[nr], data->temp[nr]);
162 mutex_unlock(&data->update_lock);
163 return count;
164}
165
166static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO,
167 show_temp, set_temp, 1);
168static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO,
169 show_temp, set_temp, 2);
170static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);
171
172static struct attribute *lm75_attrs[] = {
173 &sensor_dev_attr_temp1_input.dev_attr.attr,
174 &sensor_dev_attr_temp1_max.dev_attr.attr,
175 &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
176
177 NULL
178};
179ATTRIBUTE_GROUPS(lm75);
180
181static const struct thermal_zone_of_device_ops lm75_of_thermal_ops = {
182 .get_temp = lm75_read_temp,
183};
184
185
186
187
188
189static int
190lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
191{
192 struct device *dev = &client->dev;
193 struct lm75_data *data;
194 int status;
195 u8 set_mask, clr_mask;
196 int new;
197 enum lm75_type kind = id->driver_data;
198
199 if (!i2c_check_functionality(client->adapter,
200 I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA))
201 return -EIO;
202
203 data = devm_kzalloc(dev, sizeof(struct lm75_data), GFP_KERNEL);
204 if (!data)
205 return -ENOMEM;
206
207 data->client = client;
208 i2c_set_clientdata(client, data);
209 mutex_init(&data->update_lock);
210
211
212
213
214 set_mask = 0;
215 clr_mask = LM75_SHUTDOWN;
216
217 switch (kind) {
218 case adt75:
219 clr_mask |= 1 << 5;
220 data->resolution = 12;
221 data->sample_time = HZ / 8;
222 break;
223 case ds1775:
224 case ds75:
225 case stds75:
226 clr_mask |= 3 << 5;
227 set_mask |= 2 << 5;
228 data->resolution = 11;
229 data->sample_time = HZ;
230 break;
231 case ds7505:
232 set_mask |= 3 << 5;
233 data->resolution = 12;
234 data->sample_time = HZ / 4;
235 break;
236 case g751:
237 case lm75:
238 case lm75a:
239 data->resolution = 9;
240 data->sample_time = HZ / 2;
241 break;
242 case lm75b:
243 data->resolution = 11;
244 data->sample_time = HZ / 4;
245 break;
246 case max6625:
247 data->resolution = 9;
248 data->sample_time = HZ / 4;
249 break;
250 case max6626:
251 data->resolution = 12;
252 data->resolution_limits = 9;
253 data->sample_time = HZ / 4;
254 break;
255 case tcn75:
256 data->resolution = 9;
257 data->sample_time = HZ / 8;
258 break;
259 case mcp980x:
260 data->resolution_limits = 9;
261
262 case tmp100:
263 case tmp101:
264 set_mask |= 3 << 5;
265 data->resolution = 12;
266 data->sample_time = HZ;
267 clr_mask |= 1 << 7;
268 break;
269 case tmp112:
270 set_mask |= 3 << 5;
271 clr_mask |= 1 << 7;
272 data->resolution = 12;
273 data->sample_time = HZ / 4;
274 break;
275 case tmp105:
276 case tmp175:
277 case tmp275:
278 case tmp75:
279 set_mask |= 3 << 5;
280 clr_mask |= 1 << 7;
281 data->resolution = 12;
282 data->sample_time = HZ / 2;
283 break;
284 case tmp75c:
285 clr_mask |= 1 << 5;
286 data->resolution = 12;
287 data->sample_time = HZ / 4;
288 break;
289 }
290
291
292 status = lm75_read_value(client, LM75_REG_CONF);
293 if (status < 0) {
294 dev_dbg(dev, "Can't read config? %d\n", status);
295 return status;
296 }
297 data->orig_conf = status;
298 new = status & ~clr_mask;
299 new |= set_mask;
300 if (status != new)
301 lm75_write_value(client, LM75_REG_CONF, new);
302 dev_dbg(dev, "Config %02x\n", new);
303
304 data->hwmon_dev = hwmon_device_register_with_groups(dev, client->name,
305 data, lm75_groups);
306 if (IS_ERR(data->hwmon_dev))
307 return PTR_ERR(data->hwmon_dev);
308
309 data->tz = thermal_zone_of_sensor_register(data->hwmon_dev, 0,
310 data->hwmon_dev,
311 &lm75_of_thermal_ops);
312 if (IS_ERR(data->tz))
313 data->tz = NULL;
314
315 dev_info(dev, "%s: sensor '%s'\n",
316 dev_name(data->hwmon_dev), client->name);
317
318 return 0;
319}
320
321static int lm75_remove(struct i2c_client *client)
322{
323 struct lm75_data *data = i2c_get_clientdata(client);
324
325 thermal_zone_of_sensor_unregister(data->hwmon_dev, data->tz);
326 hwmon_device_unregister(data->hwmon_dev);
327 lm75_write_value(client, LM75_REG_CONF, data->orig_conf);
328 return 0;
329}
330
331static const struct i2c_device_id lm75_ids[] = {
332 { "adt75", adt75, },
333 { "ds1775", ds1775, },
334 { "ds75", ds75, },
335 { "ds7505", ds7505, },
336 { "g751", g751, },
337 { "lm75", lm75, },
338 { "lm75a", lm75a, },
339 { "lm75b", lm75b, },
340 { "max6625", max6625, },
341 { "max6626", max6626, },
342 { "mcp980x", mcp980x, },
343 { "stds75", stds75, },
344 { "tcn75", tcn75, },
345 { "tmp100", tmp100, },
346 { "tmp101", tmp101, },
347 { "tmp105", tmp105, },
348 { "tmp112", tmp112, },
349 { "tmp175", tmp175, },
350 { "tmp275", tmp275, },
351 { "tmp75", tmp75, },
352 { "tmp75c", tmp75c, },
353 { }
354};
355MODULE_DEVICE_TABLE(i2c, lm75_ids);
356
357#define LM75A_ID 0xA1
358
359
360static int lm75_detect(struct i2c_client *new_client,
361 struct i2c_board_info *info)
362{
363 struct i2c_adapter *adapter = new_client->adapter;
364 int i;
365 int conf, hyst, os;
366 bool is_lm75a = 0;
367
368 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
369 I2C_FUNC_SMBUS_WORD_DATA))
370 return -ENODEV;
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398 conf = i2c_smbus_read_byte_data(new_client, 1);
399 if (conf & 0xe0)
400 return -ENODEV;
401
402
403 if (i2c_smbus_read_byte_data(new_client, 7) == LM75A_ID) {
404
405
406 if (i2c_smbus_read_byte_data(new_client, 4) != 0xff
407 || i2c_smbus_read_byte_data(new_client, 5) != 0xff
408 || i2c_smbus_read_byte_data(new_client, 6) != 0xff)
409 return -ENODEV;
410 is_lm75a = 1;
411 hyst = i2c_smbus_read_byte_data(new_client, 2);
412 os = i2c_smbus_read_byte_data(new_client, 3);
413 } else {
414
415 hyst = i2c_smbus_read_byte_data(new_client, 2);
416 if (i2c_smbus_read_byte_data(new_client, 4) != hyst
417 || i2c_smbus_read_byte_data(new_client, 5) != hyst
418 || i2c_smbus_read_byte_data(new_client, 6) != hyst
419 || i2c_smbus_read_byte_data(new_client, 7) != hyst)
420 return -ENODEV;
421 os = i2c_smbus_read_byte_data(new_client, 3);
422 if (i2c_smbus_read_byte_data(new_client, 4) != os
423 || i2c_smbus_read_byte_data(new_client, 5) != os
424 || i2c_smbus_read_byte_data(new_client, 6) != os
425 || i2c_smbus_read_byte_data(new_client, 7) != os)
426 return -ENODEV;
427 }
428
429
430
431
432 if (hyst == 0 && os == 0)
433 return -ENODEV;
434
435
436 for (i = 8; i <= 248; i += 40) {
437 if (i2c_smbus_read_byte_data(new_client, i + 1) != conf
438 || i2c_smbus_read_byte_data(new_client, i + 2) != hyst
439 || i2c_smbus_read_byte_data(new_client, i + 3) != os)
440 return -ENODEV;
441 if (is_lm75a && i2c_smbus_read_byte_data(new_client, i + 7)
442 != LM75A_ID)
443 return -ENODEV;
444 }
445
446 strlcpy(info->type, is_lm75a ? "lm75a" : "lm75", I2C_NAME_SIZE);
447
448 return 0;
449}
450
451#ifdef CONFIG_PM
452static int lm75_suspend(struct device *dev)
453{
454 int status;
455 struct i2c_client *client = to_i2c_client(dev);
456 status = lm75_read_value(client, LM75_REG_CONF);
457 if (status < 0) {
458 dev_dbg(&client->dev, "Can't read config? %d\n", status);
459 return status;
460 }
461 status = status | LM75_SHUTDOWN;
462 lm75_write_value(client, LM75_REG_CONF, status);
463 return 0;
464}
465
466static int lm75_resume(struct device *dev)
467{
468 int status;
469 struct i2c_client *client = to_i2c_client(dev);
470 status = lm75_read_value(client, LM75_REG_CONF);
471 if (status < 0) {
472 dev_dbg(&client->dev, "Can't read config? %d\n", status);
473 return status;
474 }
475 status = status & ~LM75_SHUTDOWN;
476 lm75_write_value(client, LM75_REG_CONF, status);
477 return 0;
478}
479
480static const struct dev_pm_ops lm75_dev_pm_ops = {
481 .suspend = lm75_suspend,
482 .resume = lm75_resume,
483};
484#define LM75_DEV_PM_OPS (&lm75_dev_pm_ops)
485#else
486#define LM75_DEV_PM_OPS NULL
487#endif
488
489static struct i2c_driver lm75_driver = {
490 .class = I2C_CLASS_HWMON,
491 .driver = {
492 .name = "lm75",
493 .pm = LM75_DEV_PM_OPS,
494 },
495 .probe = lm75_probe,
496 .remove = lm75_remove,
497 .id_table = lm75_ids,
498 .detect = lm75_detect,
499 .address_list = normal_i2c,
500};
501
502
503
504
505
506
507
508
509
510
511static int lm75_read_value(struct i2c_client *client, u8 reg)
512{
513 if (reg == LM75_REG_CONF)
514 return i2c_smbus_read_byte_data(client, reg);
515 else
516 return i2c_smbus_read_word_swapped(client, reg);
517}
518
519static int lm75_write_value(struct i2c_client *client, u8 reg, u16 value)
520{
521 if (reg == LM75_REG_CONF)
522 return i2c_smbus_write_byte_data(client, reg, value);
523 else
524 return i2c_smbus_write_word_swapped(client, reg, value);
525}
526
527static struct lm75_data *lm75_update_device(struct device *dev)
528{
529 struct lm75_data *data = dev_get_drvdata(dev);
530 struct i2c_client *client = data->client;
531 struct lm75_data *ret = data;
532
533 mutex_lock(&data->update_lock);
534
535 if (time_after(jiffies, data->last_updated + data->sample_time)
536 || !data->valid) {
537 int i;
538 dev_dbg(&client->dev, "Starting lm75 update\n");
539
540 for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
541 int status;
542
543 status = lm75_read_value(client, LM75_REG_TEMP[i]);
544 if (unlikely(status < 0)) {
545 dev_dbg(dev,
546 "LM75: Failed to read value: reg %d, error %d\n",
547 LM75_REG_TEMP[i], status);
548 ret = ERR_PTR(status);
549 data->valid = 0;
550 goto abort;
551 }
552 data->temp[i] = status;
553 }
554 data->last_updated = jiffies;
555 data->valid = 1;
556 }
557
558abort:
559 mutex_unlock(&data->update_lock);
560 return ret;
561}
562
563module_i2c_driver(lm75_driver);
564
565MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
566MODULE_DESCRIPTION("LM75 driver");
567MODULE_LICENSE("GPL");
568