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/of_device.h>
30#include <linux/of.h>
31#include <linux/regmap.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_TEMP 0x00
70#define LM75_REG_CONF 0x01
71#define LM75_REG_HYST 0x02
72#define LM75_REG_MAX 0x03
73
74
75struct lm75_data {
76 struct i2c_client *client;
77 struct regmap *regmap;
78 u8 orig_conf;
79 u8 resolution;
80 u8 resolution_limits;
81 unsigned int sample_time;
82};
83
84
85
86static inline long lm75_reg_to_mc(s16 temp, u8 resolution)
87{
88 return ((temp >> (16 - resolution)) * 1000) >> (resolution - 8);
89}
90
91static int lm75_read(struct device *dev, enum hwmon_sensor_types type,
92 u32 attr, int channel, long *val)
93{
94 struct lm75_data *data = dev_get_drvdata(dev);
95 unsigned int regval;
96 int err, reg;
97
98 switch (type) {
99 case hwmon_chip:
100 switch (attr) {
101 case hwmon_chip_update_interval:
102 *val = data->sample_time;
103 break;
104 default:
105 return -EINVAL;
106 }
107 break;
108 case hwmon_temp:
109 switch (attr) {
110 case hwmon_temp_input:
111 reg = LM75_REG_TEMP;
112 break;
113 case hwmon_temp_max:
114 reg = LM75_REG_MAX;
115 break;
116 case hwmon_temp_max_hyst:
117 reg = LM75_REG_HYST;
118 break;
119 default:
120 return -EINVAL;
121 }
122 err = regmap_read(data->regmap, reg, ®val);
123 if (err < 0)
124 return err;
125
126 *val = lm75_reg_to_mc(regval, data->resolution);
127 break;
128 default:
129 return -EINVAL;
130 }
131 return 0;
132}
133
134static int lm75_write(struct device *dev, enum hwmon_sensor_types type,
135 u32 attr, int channel, long temp)
136{
137 struct lm75_data *data = dev_get_drvdata(dev);
138 u8 resolution;
139 int reg;
140
141 if (type != hwmon_temp)
142 return -EINVAL;
143
144 switch (attr) {
145 case hwmon_temp_max:
146 reg = LM75_REG_MAX;
147 break;
148 case hwmon_temp_max_hyst:
149 reg = LM75_REG_HYST;
150 break;
151 default:
152 return -EINVAL;
153 }
154
155
156
157
158
159 if (data->resolution_limits)
160 resolution = data->resolution_limits;
161 else
162 resolution = data->resolution;
163
164 temp = clamp_val(temp, LM75_TEMP_MIN, LM75_TEMP_MAX);
165 temp = DIV_ROUND_CLOSEST(temp << (resolution - 8),
166 1000) << (16 - resolution);
167
168 return regmap_write(data->regmap, reg, temp);
169}
170
171static umode_t lm75_is_visible(const void *data, enum hwmon_sensor_types type,
172 u32 attr, int channel)
173{
174 switch (type) {
175 case hwmon_chip:
176 switch (attr) {
177 case hwmon_chip_update_interval:
178 return S_IRUGO;
179 }
180 break;
181 case hwmon_temp:
182 switch (attr) {
183 case hwmon_temp_input:
184 return S_IRUGO;
185 case hwmon_temp_max:
186 case hwmon_temp_max_hyst:
187 return S_IRUGO | S_IWUSR;
188 }
189 break;
190 default:
191 break;
192 }
193 return 0;
194}
195
196
197
198
199
200
201
202static const u32 lm75_chip_config[] = {
203 HWMON_C_REGISTER_TZ | HWMON_C_UPDATE_INTERVAL,
204 0
205};
206
207static const struct hwmon_channel_info lm75_chip = {
208 .type = hwmon_chip,
209 .config = lm75_chip_config,
210};
211
212static const u32 lm75_temp_config[] = {
213 HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_MAX_HYST,
214 0
215};
216
217static const struct hwmon_channel_info lm75_temp = {
218 .type = hwmon_temp,
219 .config = lm75_temp_config,
220};
221
222static const struct hwmon_channel_info *lm75_info[] = {
223 &lm75_chip,
224 &lm75_temp,
225 NULL
226};
227
228static const struct hwmon_ops lm75_hwmon_ops = {
229 .is_visible = lm75_is_visible,
230 .read = lm75_read,
231 .write = lm75_write,
232};
233
234static const struct hwmon_chip_info lm75_chip_info = {
235 .ops = &lm75_hwmon_ops,
236 .info = lm75_info,
237};
238
239static bool lm75_is_writeable_reg(struct device *dev, unsigned int reg)
240{
241 return reg != LM75_REG_TEMP;
242}
243
244static bool lm75_is_volatile_reg(struct device *dev, unsigned int reg)
245{
246 return reg == LM75_REG_TEMP;
247}
248
249static const struct regmap_config lm75_regmap_config = {
250 .reg_bits = 8,
251 .val_bits = 16,
252 .max_register = LM75_REG_MAX,
253 .writeable_reg = lm75_is_writeable_reg,
254 .volatile_reg = lm75_is_volatile_reg,
255 .val_format_endian = REGMAP_ENDIAN_BIG,
256 .cache_type = REGCACHE_RBTREE,
257 .use_single_read = true,
258 .use_single_write = true,
259};
260
261static void lm75_remove(void *data)
262{
263 struct lm75_data *lm75 = data;
264 struct i2c_client *client = lm75->client;
265
266 i2c_smbus_write_byte_data(client, LM75_REG_CONF, lm75->orig_conf);
267}
268
269static int
270lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
271{
272 struct device *dev = &client->dev;
273 struct device *hwmon_dev;
274 struct lm75_data *data;
275 int status, err;
276 u8 set_mask, clr_mask;
277 int new;
278 enum lm75_type kind;
279
280 if (client->dev.of_node)
281 kind = (enum lm75_type)of_device_get_match_data(&client->dev);
282 else
283 kind = id->driver_data;
284
285 if (!i2c_check_functionality(client->adapter,
286 I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA))
287 return -EIO;
288
289 data = devm_kzalloc(dev, sizeof(struct lm75_data), GFP_KERNEL);
290 if (!data)
291 return -ENOMEM;
292
293 data->client = client;
294
295 data->regmap = devm_regmap_init_i2c(client, &lm75_regmap_config);
296 if (IS_ERR(data->regmap))
297 return PTR_ERR(data->regmap);
298
299
300
301
302 set_mask = 0;
303 clr_mask = LM75_SHUTDOWN;
304
305 switch (kind) {
306 case adt75:
307 clr_mask |= 1 << 5;
308 data->resolution = 12;
309 data->sample_time = MSEC_PER_SEC / 8;
310 break;
311 case ds1775:
312 case ds75:
313 case stds75:
314 clr_mask |= 3 << 5;
315 set_mask |= 2 << 5;
316 data->resolution = 11;
317 data->sample_time = MSEC_PER_SEC;
318 break;
319 case ds7505:
320 set_mask |= 3 << 5;
321 data->resolution = 12;
322 data->sample_time = MSEC_PER_SEC / 4;
323 break;
324 case g751:
325 case lm75:
326 case lm75a:
327 data->resolution = 9;
328 data->sample_time = MSEC_PER_SEC / 2;
329 break;
330 case lm75b:
331 data->resolution = 11;
332 data->sample_time = MSEC_PER_SEC / 4;
333 break;
334 case max6625:
335 data->resolution = 9;
336 data->sample_time = MSEC_PER_SEC / 4;
337 break;
338 case max6626:
339 data->resolution = 12;
340 data->resolution_limits = 9;
341 data->sample_time = MSEC_PER_SEC / 4;
342 break;
343 case tcn75:
344 data->resolution = 9;
345 data->sample_time = MSEC_PER_SEC / 8;
346 break;
347 case mcp980x:
348 data->resolution_limits = 9;
349
350 case tmp100:
351 case tmp101:
352 set_mask |= 3 << 5;
353 data->resolution = 12;
354 data->sample_time = MSEC_PER_SEC;
355 clr_mask |= 1 << 7;
356 break;
357 case tmp112:
358 set_mask |= 3 << 5;
359 clr_mask |= 1 << 7;
360 data->resolution = 12;
361 data->sample_time = MSEC_PER_SEC / 4;
362 break;
363 case tmp105:
364 case tmp175:
365 case tmp275:
366 case tmp75:
367 set_mask |= 3 << 5;
368 clr_mask |= 1 << 7;
369 data->resolution = 12;
370 data->sample_time = MSEC_PER_SEC / 2;
371 break;
372 case tmp75c:
373 clr_mask |= 1 << 5;
374 data->resolution = 12;
375 data->sample_time = MSEC_PER_SEC / 4;
376 break;
377 }
378
379
380 status = i2c_smbus_read_byte_data(client, LM75_REG_CONF);
381 if (status < 0) {
382 dev_dbg(dev, "Can't read config? %d\n", status);
383 return status;
384 }
385 data->orig_conf = status;
386 new = status & ~clr_mask;
387 new |= set_mask;
388 if (status != new)
389 i2c_smbus_write_byte_data(client, LM75_REG_CONF, new);
390
391 err = devm_add_action_or_reset(dev, lm75_remove, data);
392 if (err)
393 return err;
394
395 dev_dbg(dev, "Config %02x\n", new);
396
397 hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,
398 data, &lm75_chip_info,
399 NULL);
400 if (IS_ERR(hwmon_dev))
401 return PTR_ERR(hwmon_dev);
402
403 dev_info(dev, "%s: sensor '%s'\n", dev_name(hwmon_dev), client->name);
404
405 return 0;
406}
407
408static const struct i2c_device_id lm75_ids[] = {
409 { "adt75", adt75, },
410 { "ds1775", ds1775, },
411 { "ds75", ds75, },
412 { "ds7505", ds7505, },
413 { "g751", g751, },
414 { "lm75", lm75, },
415 { "lm75a", lm75a, },
416 { "lm75b", lm75b, },
417 { "max6625", max6625, },
418 { "max6626", max6626, },
419 { "mcp980x", mcp980x, },
420 { "stds75", stds75, },
421 { "tcn75", tcn75, },
422 { "tmp100", tmp100, },
423 { "tmp101", tmp101, },
424 { "tmp105", tmp105, },
425 { "tmp112", tmp112, },
426 { "tmp175", tmp175, },
427 { "tmp275", tmp275, },
428 { "tmp75", tmp75, },
429 { "tmp75c", tmp75c, },
430 { }
431};
432MODULE_DEVICE_TABLE(i2c, lm75_ids);
433
434static const struct of_device_id lm75_of_match[] = {
435 {
436 .compatible = "adi,adt75",
437 .data = (void *)adt75
438 },
439 {
440 .compatible = "dallas,ds1775",
441 .data = (void *)ds1775
442 },
443 {
444 .compatible = "dallas,ds75",
445 .data = (void *)ds75
446 },
447 {
448 .compatible = "dallas,ds7505",
449 .data = (void *)ds7505
450 },
451 {
452 .compatible = "gmt,g751",
453 .data = (void *)g751
454 },
455 {
456 .compatible = "national,lm75",
457 .data = (void *)lm75
458 },
459 {
460 .compatible = "national,lm75a",
461 .data = (void *)lm75a
462 },
463 {
464 .compatible = "national,lm75b",
465 .data = (void *)lm75b
466 },
467 {
468 .compatible = "maxim,max6625",
469 .data = (void *)max6625
470 },
471 {
472 .compatible = "maxim,max6626",
473 .data = (void *)max6626
474 },
475 {
476 .compatible = "maxim,mcp980x",
477 .data = (void *)mcp980x
478 },
479 {
480 .compatible = "st,stds75",
481 .data = (void *)stds75
482 },
483 {
484 .compatible = "microchip,tcn75",
485 .data = (void *)tcn75
486 },
487 {
488 .compatible = "ti,tmp100",
489 .data = (void *)tmp100
490 },
491 {
492 .compatible = "ti,tmp101",
493 .data = (void *)tmp101
494 },
495 {
496 .compatible = "ti,tmp105",
497 .data = (void *)tmp105
498 },
499 {
500 .compatible = "ti,tmp112",
501 .data = (void *)tmp112
502 },
503 {
504 .compatible = "ti,tmp175",
505 .data = (void *)tmp175
506 },
507 {
508 .compatible = "ti,tmp275",
509 .data = (void *)tmp275
510 },
511 {
512 .compatible = "ti,tmp75",
513 .data = (void *)tmp75
514 },
515 {
516 .compatible = "ti,tmp75c",
517 .data = (void *)tmp75c
518 },
519 { },
520};
521MODULE_DEVICE_TABLE(of, lm75_of_match);
522
523#define LM75A_ID 0xA1
524
525
526static int lm75_detect(struct i2c_client *new_client,
527 struct i2c_board_info *info)
528{
529 struct i2c_adapter *adapter = new_client->adapter;
530 int i;
531 int conf, hyst, os;
532 bool is_lm75a = 0;
533
534 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
535 I2C_FUNC_SMBUS_WORD_DATA))
536 return -ENODEV;
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564 conf = i2c_smbus_read_byte_data(new_client, 1);
565 if (conf & 0xe0)
566 return -ENODEV;
567
568
569 if (i2c_smbus_read_byte_data(new_client, 7) == LM75A_ID) {
570
571
572 if (i2c_smbus_read_byte_data(new_client, 4) != 0xff
573 || i2c_smbus_read_byte_data(new_client, 5) != 0xff
574 || i2c_smbus_read_byte_data(new_client, 6) != 0xff)
575 return -ENODEV;
576 is_lm75a = 1;
577 hyst = i2c_smbus_read_byte_data(new_client, 2);
578 os = i2c_smbus_read_byte_data(new_client, 3);
579 } else {
580
581 hyst = i2c_smbus_read_byte_data(new_client, 2);
582 if (i2c_smbus_read_byte_data(new_client, 4) != hyst
583 || i2c_smbus_read_byte_data(new_client, 5) != hyst
584 || i2c_smbus_read_byte_data(new_client, 6) != hyst
585 || i2c_smbus_read_byte_data(new_client, 7) != hyst)
586 return -ENODEV;
587 os = i2c_smbus_read_byte_data(new_client, 3);
588 if (i2c_smbus_read_byte_data(new_client, 4) != os
589 || i2c_smbus_read_byte_data(new_client, 5) != os
590 || i2c_smbus_read_byte_data(new_client, 6) != os
591 || i2c_smbus_read_byte_data(new_client, 7) != os)
592 return -ENODEV;
593 }
594
595
596
597
598 if (hyst == 0 && os == 0)
599 return -ENODEV;
600
601
602 for (i = 8; i <= 248; i += 40) {
603 if (i2c_smbus_read_byte_data(new_client, i + 1) != conf
604 || i2c_smbus_read_byte_data(new_client, i + 2) != hyst
605 || i2c_smbus_read_byte_data(new_client, i + 3) != os)
606 return -ENODEV;
607 if (is_lm75a && i2c_smbus_read_byte_data(new_client, i + 7)
608 != LM75A_ID)
609 return -ENODEV;
610 }
611
612 strlcpy(info->type, is_lm75a ? "lm75a" : "lm75", I2C_NAME_SIZE);
613
614 return 0;
615}
616
617#ifdef CONFIG_PM
618static int lm75_suspend(struct device *dev)
619{
620 int status;
621 struct i2c_client *client = to_i2c_client(dev);
622 status = i2c_smbus_read_byte_data(client, LM75_REG_CONF);
623 if (status < 0) {
624 dev_dbg(&client->dev, "Can't read config? %d\n", status);
625 return status;
626 }
627 status = status | LM75_SHUTDOWN;
628 i2c_smbus_write_byte_data(client, LM75_REG_CONF, status);
629 return 0;
630}
631
632static int lm75_resume(struct device *dev)
633{
634 int status;
635 struct i2c_client *client = to_i2c_client(dev);
636 status = i2c_smbus_read_byte_data(client, LM75_REG_CONF);
637 if (status < 0) {
638 dev_dbg(&client->dev, "Can't read config? %d\n", status);
639 return status;
640 }
641 status = status & ~LM75_SHUTDOWN;
642 i2c_smbus_write_byte_data(client, LM75_REG_CONF, status);
643 return 0;
644}
645
646static const struct dev_pm_ops lm75_dev_pm_ops = {
647 .suspend = lm75_suspend,
648 .resume = lm75_resume,
649};
650#define LM75_DEV_PM_OPS (&lm75_dev_pm_ops)
651#else
652#define LM75_DEV_PM_OPS NULL
653#endif
654
655static struct i2c_driver lm75_driver = {
656 .class = I2C_CLASS_HWMON,
657 .driver = {
658 .name = "lm75",
659 .of_match_table = of_match_ptr(lm75_of_match),
660 .pm = LM75_DEV_PM_OPS,
661 },
662 .probe = lm75_probe,
663 .id_table = lm75_ids,
664 .detect = lm75_detect,
665 .address_list = normal_i2c,
666};
667
668module_i2c_driver(lm75_driver);
669
670MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
671MODULE_DESCRIPTION("LM75 driver");
672MODULE_LICENSE("GPL");
673