Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Driver for Texas Instruments / National Semiconductor LM95234
4 *
5 * Copyright (c) 2013, 2014 Guenter Roeck <linux@roeck-us.net>
6 *
7 * Derived from lm95241.c
8 * Copyright (C) 2008, 2010 Davide Rizzo <elpa.rizzo@gmail.com>
9 */
10
11#include <linux/err.h>
12#include <linux/hwmon.h>
13#include <linux/i2c.h>
14#include <linux/init.h>
15#include <linux/module.h>
16#include <linux/slab.h>
17#include <linux/mutex.h>
18#include <linux/regmap.h>
19#include <linux/util_macros.h>
20
21#define DRVNAME "lm95234"
22
23enum chips { lm95233, lm95234 };
24
25static const unsigned short normal_i2c[] = {
26 0x18, 0x2a, 0x2b, 0x4d, 0x4e, I2C_CLIENT_END };
27
28/* LM95234 registers */
29#define LM95234_REG_MAN_ID 0xFE
30#define LM95234_REG_CHIP_ID 0xFF
31#define LM95234_REG_STATUS 0x02
32#define LM95234_REG_CONFIG 0x03
33#define LM95234_REG_CONVRATE 0x04
34#define LM95234_REG_ENABLE 0x05
35#define LM95234_REG_FILTER 0x06
36#define LM95234_REG_STS_FAULT 0x07
37#define LM95234_REG_STS_TCRIT1 0x08
38#define LM95234_REG_STS_TCRIT2 0x09
39#define LM95234_REG_TEMPH(x) ((x) + 0x10)
40#define LM95234_REG_TEMPL(x) ((x) + 0x20)
41#define LM95234_REG_UTEMPH(x) ((x) + 0x19) /* Remote only */
42#define LM95234_REG_UTEMPL(x) ((x) + 0x29)
43#define LM95234_REG_REM_MODEL 0x30
44#define LM95234_REG_REM_MODEL_STS 0x38
45#define LM95234_REG_OFFSET(x) ((x) + 0x31) /* Remote only */
46#define LM95234_REG_TCRIT1(x) ((x) + 0x40)
47#define LM95234_REG_TCRIT2(x) ((x) + 0x49) /* Remote channel 1,2 */
48#define LM95234_REG_TCRIT_HYST 0x5a
49
50#define NATSEMI_MAN_ID 0x01
51#define LM95233_CHIP_ID 0x89
52#define LM95234_CHIP_ID 0x79
53
54/* Client data (each client gets its own) */
55struct lm95234_data {
56 struct regmap *regmap;
57 struct mutex update_lock;
58 enum chips type;
59};
60
61static int lm95234_read_temp(struct regmap *regmap, int index, long *t)
62{
63 unsigned int regs[2];
64 int temp = 0, ret;
65 u8 regvals[2];
66
67 if (index) {
68 regs[0] = LM95234_REG_UTEMPH(index - 1);
69 regs[1] = LM95234_REG_UTEMPL(index - 1);
70 ret = regmap_multi_reg_read(regmap, regs, regvals, 2);
71 if (ret)
72 return ret;
73 temp = (regvals[0] << 8) | regvals[1];
74 }
75 /*
76 * Read signed temperature if unsigned temperature is 0,
77 * or if this is the local sensor.
78 */
79 if (!temp) {
80 regs[0] = LM95234_REG_TEMPH(index);
81 regs[1] = LM95234_REG_TEMPL(index);
82 ret = regmap_multi_reg_read(regmap, regs, regvals, 2);
83 if (ret)
84 return ret;
85 temp = (regvals[0] << 8) | regvals[1];
86 temp = sign_extend32(temp, 15);
87 }
88 *t = DIV_ROUND_CLOSEST(temp * 125, 32);
89 return 0;
90}
91
92static int lm95234_hyst_get(struct regmap *regmap, int reg, long *val)
93{
94 unsigned int regs[2] = {reg, LM95234_REG_TCRIT_HYST};
95 u8 regvals[2];
96 int ret;
97
98 ret = regmap_multi_reg_read(regmap, regs, regvals, 2);
99 if (ret)
100 return ret;
101 *val = (regvals[0] - regvals[1]) * 1000;
102 return 0;
103}
104
105static ssize_t lm95234_hyst_set(struct lm95234_data *data, long val)
106{
107 u32 tcrit;
108 int ret;
109
110 mutex_lock(&data->update_lock);
111
112 ret = regmap_read(data->regmap, LM95234_REG_TCRIT1(0), &tcrit);
113 if (ret)
114 goto unlock;
115
116 val = DIV_ROUND_CLOSEST(clamp_val(val, -255000, 255000), 1000);
117 val = clamp_val((int)tcrit - val, 0, 31);
118
119 ret = regmap_write(data->regmap, LM95234_REG_TCRIT_HYST, val);
120unlock:
121 mutex_unlock(&data->update_lock);
122 return ret;
123}
124
125static int lm95234_crit_reg(int channel)
126{
127 if (channel == 1 || channel == 2)
128 return LM95234_REG_TCRIT2(channel - 1);
129 return LM95234_REG_TCRIT1(channel);
130}
131
132static int lm95234_temp_write(struct device *dev, u32 attr, int channel, long val)
133{
134 struct lm95234_data *data = dev_get_drvdata(dev);
135 struct regmap *regmap = data->regmap;
136
137 switch (attr) {
138 case hwmon_temp_enable:
139 if (val && val != 1)
140 return -EINVAL;
141 return regmap_update_bits(regmap, LM95234_REG_ENABLE,
142 BIT(channel), val ? BIT(channel) : 0);
143 case hwmon_temp_type:
144 if (val != 1 && val != 2)
145 return -EINVAL;
146 return regmap_update_bits(regmap, LM95234_REG_REM_MODEL,
147 BIT(channel),
148 val == 1 ? BIT(channel) : 0);
149 case hwmon_temp_offset:
150 val = DIV_ROUND_CLOSEST(clamp_val(val, -64000, 63500), 500);
151 return regmap_write(regmap, LM95234_REG_OFFSET(channel - 1), val);
152 case hwmon_temp_max:
153 val = clamp_val(val, 0, channel == 1 ? 127000 : 255000);
154 val = DIV_ROUND_CLOSEST(val, 1000);
155 return regmap_write(regmap, lm95234_crit_reg(channel), val);
156 case hwmon_temp_max_hyst:
157 return lm95234_hyst_set(data, val);
158 case hwmon_temp_crit:
159 val = DIV_ROUND_CLOSEST(clamp_val(val, 0, 255000), 1000);
160 return regmap_write(regmap, LM95234_REG_TCRIT1(channel), val);
161 default:
162 return -EOPNOTSUPP;
163 }
164 return 0;
165}
166
167static int lm95234_alarm_reg(int channel)
168{
169 if (channel == 1 || channel == 2)
170 return LM95234_REG_STS_TCRIT2;
171 return LM95234_REG_STS_TCRIT1;
172}
173
174static int lm95234_temp_read(struct device *dev, u32 attr, int channel, long *val)
175{
176 struct lm95234_data *data = dev_get_drvdata(dev);
177 struct regmap *regmap = data->regmap;
178 u32 regval, mask;
179 int ret;
180
181 switch (attr) {
182 case hwmon_temp_enable:
183 ret = regmap_read(regmap, LM95234_REG_ENABLE, ®val);
184 if (ret)
185 return ret;
186 *val = !!(regval & BIT(channel));
187 break;
188 case hwmon_temp_input:
189 return lm95234_read_temp(regmap, channel, val);
190 case hwmon_temp_max_alarm:
191 ret = regmap_read(regmap, lm95234_alarm_reg(channel), ®val);
192 if (ret)
193 return ret;
194 *val = !!(regval & BIT(channel));
195 break;
196 case hwmon_temp_crit_alarm:
197 ret = regmap_read(regmap, LM95234_REG_STS_TCRIT1, ®val);
198 if (ret)
199 return ret;
200 *val = !!(regval & BIT(channel));
201 break;
202 case hwmon_temp_crit_hyst:
203 return lm95234_hyst_get(regmap, LM95234_REG_TCRIT1(channel), val);
204 case hwmon_temp_type:
205 ret = regmap_read(regmap, LM95234_REG_REM_MODEL, ®val);
206 if (ret)
207 return ret;
208 *val = (regval & BIT(channel)) ? 1 : 2;
209 break;
210 case hwmon_temp_offset:
211 ret = regmap_read(regmap, LM95234_REG_OFFSET(channel - 1), ®val);
212 if (ret)
213 return ret;
214 *val = sign_extend32(regval, 7) * 500;
215 break;
216 case hwmon_temp_fault:
217 ret = regmap_read(regmap, LM95234_REG_STS_FAULT, ®val);
218 if (ret)
219 return ret;
220 mask = (BIT(0) | BIT(1)) << ((channel - 1) << 1);
221 *val = !!(regval & mask);
222 break;
223 case hwmon_temp_max:
224 ret = regmap_read(regmap, lm95234_crit_reg(channel), ®val);
225 if (ret)
226 return ret;
227 *val = regval * 1000;
228 break;
229 case hwmon_temp_max_hyst:
230 return lm95234_hyst_get(regmap, lm95234_crit_reg(channel), val);
231 case hwmon_temp_crit:
232 ret = regmap_read(regmap, LM95234_REG_TCRIT1(channel), ®val);
233 if (ret)
234 return ret;
235 *val = regval * 1000;
236 break;
237 default:
238 return -EOPNOTSUPP;
239 }
240 return 0;
241}
242
243static u16 update_intervals[] = { 143, 364, 1000, 2500 };
244
245static int lm95234_chip_write(struct device *dev, u32 attr, long val)
246{
247 struct lm95234_data *data = dev_get_drvdata(dev);
248
249 switch (attr) {
250 case hwmon_chip_update_interval:
251 val = find_closest(val, update_intervals, ARRAY_SIZE(update_intervals));
252 return regmap_write(data->regmap, LM95234_REG_CONVRATE, val);
253 default:
254 return -EOPNOTSUPP;
255 }
256 return 0;
257}
258
259static int lm95234_chip_read(struct device *dev, u32 attr, long *val)
260{
261 struct lm95234_data *data = dev_get_drvdata(dev);
262 u32 convrate;
263 int ret;
264
265 switch (attr) {
266 case hwmon_chip_update_interval:
267 ret = regmap_read(data->regmap, LM95234_REG_CONVRATE, &convrate);
268 if (ret)
269 return ret;
270
271 *val = update_intervals[convrate & 0x03];
272 break;
273 default:
274 return -EOPNOTSUPP;
275 }
276 return 0;
277}
278
279static int lm95234_write(struct device *dev, enum hwmon_sensor_types type,
280 u32 attr, int channel, long val)
281{
282 switch (type) {
283 case hwmon_chip:
284 return lm95234_chip_write(dev, attr, val);
285 case hwmon_temp:
286 return lm95234_temp_write(dev, attr, channel, val);
287 default:
288 return -EOPNOTSUPP;
289 }
290}
291
292static int lm95234_read(struct device *dev, enum hwmon_sensor_types type,
293 u32 attr, int channel, long *val)
294{
295 switch (type) {
296 case hwmon_chip:
297 return lm95234_chip_read(dev, attr, val);
298 case hwmon_temp:
299 return lm95234_temp_read(dev, attr, channel, val);
300 default:
301 return -EOPNOTSUPP;
302 }
303}
304
305static umode_t lm95234_is_visible(const void *_data, enum hwmon_sensor_types type,
306 u32 attr, int channel)
307{
308 const struct lm95234_data *data = _data;
309
310 if (data->type == lm95233 && channel > 2)
311 return 0;
312
313 switch (type) {
314 case hwmon_chip:
315 switch (attr) {
316 case hwmon_chip_update_interval:
317 return 0644;
318 default:
319 break;
320 }
321 break;
322 case hwmon_temp:
323 switch (attr) {
324 case hwmon_temp_input:
325 case hwmon_temp_max_alarm:
326 return 0444;
327 case hwmon_temp_crit_alarm:
328 case hwmon_temp_crit_hyst:
329 return (channel && channel < 3) ? 0444 : 0;
330 case hwmon_temp_type:
331 case hwmon_temp_offset:
332 return channel ? 0644 : 0;
333 case hwmon_temp_fault:
334 return channel ? 0444 : 0;
335 case hwmon_temp_max:
336 case hwmon_temp_enable:
337 return 0644;
338 case hwmon_temp_max_hyst:
339 return channel ? 0444 : 0644;
340 case hwmon_temp_crit:
341 return (channel && channel < 3) ? 0644 : 0;
342 default:
343 break;
344 }
345 break;
346 default:
347 break;
348 }
349 return 0;
350}
351
352static const struct hwmon_channel_info * const lm95234_info[] = {
353 HWMON_CHANNEL_INFO(chip, HWMON_C_UPDATE_INTERVAL),
354 HWMON_CHANNEL_INFO(temp,
355 HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_MAX_HYST |
356 HWMON_T_MAX_ALARM | HWMON_T_ENABLE,
357 HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_MAX_HYST |
358 HWMON_T_MAX_ALARM | HWMON_T_FAULT | HWMON_T_TYPE |
359 HWMON_T_CRIT | HWMON_T_CRIT_HYST |
360 HWMON_T_CRIT_ALARM | HWMON_T_OFFSET | HWMON_T_ENABLE,
361 HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_MAX_HYST |
362 HWMON_T_MAX_ALARM | HWMON_T_FAULT | HWMON_T_TYPE |
363 HWMON_T_CRIT | HWMON_T_CRIT_HYST |
364 HWMON_T_CRIT_ALARM | HWMON_T_OFFSET | HWMON_T_ENABLE,
365 HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_MAX_HYST |
366 HWMON_T_MAX_ALARM | HWMON_T_FAULT | HWMON_T_TYPE |
367 HWMON_T_OFFSET | HWMON_T_ENABLE,
368 HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_MAX_HYST |
369 HWMON_T_MAX_ALARM | HWMON_T_FAULT | HWMON_T_TYPE |
370 HWMON_T_OFFSET | HWMON_T_ENABLE),
371 NULL
372};
373
374static const struct hwmon_ops lm95234_hwmon_ops = {
375 .is_visible = lm95234_is_visible,
376 .read = lm95234_read,
377 .write = lm95234_write,
378};
379
380static const struct hwmon_chip_info lm95234_chip_info = {
381 .ops = &lm95234_hwmon_ops,
382 .info = lm95234_info,
383};
384
385static bool lm95234_volatile_reg(struct device *dev, unsigned int reg)
386{
387 switch (reg) {
388 case LM95234_REG_TEMPH(0) ... LM95234_REG_TEMPH(4):
389 case LM95234_REG_TEMPL(0) ... LM95234_REG_TEMPL(4):
390 case LM95234_REG_UTEMPH(0) ... LM95234_REG_UTEMPH(3):
391 case LM95234_REG_UTEMPL(0) ... LM95234_REG_UTEMPL(3):
392 case LM95234_REG_STS_FAULT:
393 case LM95234_REG_STS_TCRIT1:
394 case LM95234_REG_STS_TCRIT2:
395 case LM95234_REG_REM_MODEL_STS:
396 return true;
397 default:
398 return false;
399 }
400}
401
402static bool lm95234_writeable_reg(struct device *dev, unsigned int reg)
403{
404 switch (reg) {
405 case LM95234_REG_CONFIG ... LM95234_REG_FILTER:
406 case LM95234_REG_REM_MODEL ... LM95234_REG_OFFSET(3):
407 case LM95234_REG_TCRIT1(0) ... LM95234_REG_TCRIT1(4):
408 case LM95234_REG_TCRIT2(0) ... LM95234_REG_TCRIT2(1):
409 case LM95234_REG_TCRIT_HYST:
410 return true;
411 default:
412 return false;
413 }
414}
415
416static const struct regmap_config lm95234_regmap_config = {
417 .reg_bits = 8,
418 .val_bits = 8,
419 .writeable_reg = lm95234_writeable_reg,
420 .volatile_reg = lm95234_volatile_reg,
421 .cache_type = REGCACHE_MAPLE,
422};
423
424static int lm95234_detect(struct i2c_client *client,
425 struct i2c_board_info *info)
426{
427 struct i2c_adapter *adapter = client->adapter;
428 int address = client->addr;
429 u8 config_mask, model_mask;
430 int mfg_id, chip_id, val;
431 const char *name;
432
433 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
434 return -ENODEV;
435
436 mfg_id = i2c_smbus_read_byte_data(client, LM95234_REG_MAN_ID);
437 if (mfg_id != NATSEMI_MAN_ID)
438 return -ENODEV;
439
440 chip_id = i2c_smbus_read_byte_data(client, LM95234_REG_CHIP_ID);
441 switch (chip_id) {
442 case LM95233_CHIP_ID:
443 if (address != 0x18 && address != 0x2a && address != 0x2b)
444 return -ENODEV;
445 config_mask = 0xbf;
446 model_mask = 0xf9;
447 name = "lm95233";
448 break;
449 case LM95234_CHIP_ID:
450 if (address != 0x18 && address != 0x4d && address != 0x4e)
451 return -ENODEV;
452 config_mask = 0xbc;
453 model_mask = 0xe1;
454 name = "lm95234";
455 break;
456 default:
457 return -ENODEV;
458 }
459
460 val = i2c_smbus_read_byte_data(client, LM95234_REG_STATUS);
461 if (val & 0x30)
462 return -ENODEV;
463
464 val = i2c_smbus_read_byte_data(client, LM95234_REG_CONFIG);
465 if (val & config_mask)
466 return -ENODEV;
467
468 val = i2c_smbus_read_byte_data(client, LM95234_REG_CONVRATE);
469 if (val & 0xfc)
470 return -ENODEV;
471
472 val = i2c_smbus_read_byte_data(client, LM95234_REG_REM_MODEL);
473 if (val & model_mask)
474 return -ENODEV;
475
476 val = i2c_smbus_read_byte_data(client, LM95234_REG_REM_MODEL_STS);
477 if (val & model_mask)
478 return -ENODEV;
479
480 strscpy(info->type, name, I2C_NAME_SIZE);
481 return 0;
482}
483
484static int lm95234_init_client(struct device *dev, struct regmap *regmap)
485{
486 u32 val, model;
487 int ret;
488
489 /* start conversion if necessary */
490 ret = regmap_clear_bits(regmap, LM95234_REG_CONFIG, 0x40);
491 if (ret)
492 return ret;
493
494 /* If diode type status reports an error, try to fix it */
495 ret = regmap_read(regmap, LM95234_REG_REM_MODEL_STS, &val);
496 if (ret < 0)
497 return ret;
498 ret = regmap_read(regmap, LM95234_REG_REM_MODEL, &model);
499 if (ret < 0)
500 return ret;
501 if (model & val) {
502 dev_notice(dev,
503 "Fixing remote diode type misconfiguration (0x%x)\n",
504 val);
505 ret = regmap_write(regmap, LM95234_REG_REM_MODEL, model & ~val);
506 }
507 return ret;
508}
509
510static int lm95234_probe(struct i2c_client *client)
511{
512 struct device *dev = &client->dev;
513 struct lm95234_data *data;
514 struct device *hwmon_dev;
515 struct regmap *regmap;
516 int err;
517
518 data = devm_kzalloc(dev, sizeof(struct lm95234_data), GFP_KERNEL);
519 if (!data)
520 return -ENOMEM;
521
522 data->type = (uintptr_t)i2c_get_match_data(client);
523
524 regmap = devm_regmap_init_i2c(client, &lm95234_regmap_config);
525 if (IS_ERR(regmap))
526 return PTR_ERR(regmap);
527
528 data->regmap = regmap;
529 mutex_init(&data->update_lock);
530
531 /* Initialize the LM95234 chip */
532 err = lm95234_init_client(dev, regmap);
533 if (err < 0)
534 return err;
535
536 hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,
537 data, &lm95234_chip_info, NULL);
538 return PTR_ERR_OR_ZERO(hwmon_dev);
539}
540
541/* Driver data (common to all clients) */
542static const struct i2c_device_id lm95234_id[] = {
543 { "lm95233", lm95233 },
544 { "lm95234", lm95234 },
545 { }
546};
547MODULE_DEVICE_TABLE(i2c, lm95234_id);
548
549static struct i2c_driver lm95234_driver = {
550 .class = I2C_CLASS_HWMON,
551 .driver = {
552 .name = DRVNAME,
553 },
554 .probe = lm95234_probe,
555 .id_table = lm95234_id,
556 .detect = lm95234_detect,
557 .address_list = normal_i2c,
558};
559
560module_i2c_driver(lm95234_driver);
561
562MODULE_AUTHOR("Guenter Roeck <linux@roeck-us.net>");
563MODULE_DESCRIPTION("LM95233/LM95234 sensor driver");
564MODULE_LICENSE("GPL");
1/*
2 * Driver for Texas Instruments / National Semiconductor LM95234
3 *
4 * Copyright (c) 2013, 2014 Guenter Roeck <linux@roeck-us.net>
5 *
6 * Derived from lm95241.c
7 * Copyright (C) 2008, 2010 Davide Rizzo <elpa.rizzo@gmail.com>
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
20#include <linux/module.h>
21#include <linux/init.h>
22#include <linux/slab.h>
23#include <linux/jiffies.h>
24#include <linux/i2c.h>
25#include <linux/hwmon.h>
26#include <linux/hwmon-sysfs.h>
27#include <linux/err.h>
28#include <linux/mutex.h>
29#include <linux/sysfs.h>
30
31#define DRVNAME "lm95234"
32
33enum chips { lm95233, lm95234 };
34
35static const unsigned short normal_i2c[] = {
36 0x18, 0x2a, 0x2b, 0x4d, 0x4e, I2C_CLIENT_END };
37
38/* LM95234 registers */
39#define LM95234_REG_MAN_ID 0xFE
40#define LM95234_REG_CHIP_ID 0xFF
41#define LM95234_REG_STATUS 0x02
42#define LM95234_REG_CONFIG 0x03
43#define LM95234_REG_CONVRATE 0x04
44#define LM95234_REG_STS_FAULT 0x07
45#define LM95234_REG_STS_TCRIT1 0x08
46#define LM95234_REG_STS_TCRIT2 0x09
47#define LM95234_REG_TEMPH(x) ((x) + 0x10)
48#define LM95234_REG_TEMPL(x) ((x) + 0x20)
49#define LM95234_REG_UTEMPH(x) ((x) + 0x19) /* Remote only */
50#define LM95234_REG_UTEMPL(x) ((x) + 0x29)
51#define LM95234_REG_REM_MODEL 0x30
52#define LM95234_REG_REM_MODEL_STS 0x38
53#define LM95234_REG_OFFSET(x) ((x) + 0x31) /* Remote only */
54#define LM95234_REG_TCRIT1(x) ((x) + 0x40)
55#define LM95234_REG_TCRIT2(x) ((x) + 0x49) /* Remote channel 1,2 */
56#define LM95234_REG_TCRIT_HYST 0x5a
57
58#define NATSEMI_MAN_ID 0x01
59#define LM95233_CHIP_ID 0x89
60#define LM95234_CHIP_ID 0x79
61
62/* Client data (each client gets its own) */
63struct lm95234_data {
64 struct i2c_client *client;
65 const struct attribute_group *groups[3];
66 struct mutex update_lock;
67 unsigned long last_updated, interval; /* in jiffies */
68 bool valid; /* false until following fields are valid */
69 /* registers values */
70 int temp[5]; /* temperature (signed) */
71 u32 status; /* fault/alarm status */
72 u8 tcrit1[5]; /* critical temperature limit */
73 u8 tcrit2[2]; /* high temperature limit */
74 s8 toffset[4]; /* remote temperature offset */
75 u8 thyst; /* common hysteresis */
76
77 u8 sensor_type; /* temperature sensor type */
78};
79
80static int lm95234_read_temp(struct i2c_client *client, int index, int *t)
81{
82 int val;
83 u16 temp = 0;
84
85 if (index) {
86 val = i2c_smbus_read_byte_data(client,
87 LM95234_REG_UTEMPH(index - 1));
88 if (val < 0)
89 return val;
90 temp = val << 8;
91 val = i2c_smbus_read_byte_data(client,
92 LM95234_REG_UTEMPL(index - 1));
93 if (val < 0)
94 return val;
95 temp |= val;
96 *t = temp;
97 }
98 /*
99 * Read signed temperature if unsigned temperature is 0,
100 * or if this is the local sensor.
101 */
102 if (!temp) {
103 val = i2c_smbus_read_byte_data(client,
104 LM95234_REG_TEMPH(index));
105 if (val < 0)
106 return val;
107 temp = val << 8;
108 val = i2c_smbus_read_byte_data(client,
109 LM95234_REG_TEMPL(index));
110 if (val < 0)
111 return val;
112 temp |= val;
113 *t = (s16)temp;
114 }
115 return 0;
116}
117
118static u16 update_intervals[] = { 143, 364, 1000, 2500 };
119
120/* Fill value cache. Must be called with update lock held. */
121
122static int lm95234_fill_cache(struct lm95234_data *data,
123 struct i2c_client *client)
124{
125 int i, ret;
126
127 ret = i2c_smbus_read_byte_data(client, LM95234_REG_CONVRATE);
128 if (ret < 0)
129 return ret;
130
131 data->interval = msecs_to_jiffies(update_intervals[ret & 0x03]);
132
133 for (i = 0; i < ARRAY_SIZE(data->tcrit1); i++) {
134 ret = i2c_smbus_read_byte_data(client, LM95234_REG_TCRIT1(i));
135 if (ret < 0)
136 return ret;
137 data->tcrit1[i] = ret;
138 }
139 for (i = 0; i < ARRAY_SIZE(data->tcrit2); i++) {
140 ret = i2c_smbus_read_byte_data(client, LM95234_REG_TCRIT2(i));
141 if (ret < 0)
142 return ret;
143 data->tcrit2[i] = ret;
144 }
145 for (i = 0; i < ARRAY_SIZE(data->toffset); i++) {
146 ret = i2c_smbus_read_byte_data(client, LM95234_REG_OFFSET(i));
147 if (ret < 0)
148 return ret;
149 data->toffset[i] = ret;
150 }
151
152 ret = i2c_smbus_read_byte_data(client, LM95234_REG_TCRIT_HYST);
153 if (ret < 0)
154 return ret;
155 data->thyst = ret;
156
157 ret = i2c_smbus_read_byte_data(client, LM95234_REG_REM_MODEL);
158 if (ret < 0)
159 return ret;
160 data->sensor_type = ret;
161
162 return 0;
163}
164
165static int lm95234_update_device(struct lm95234_data *data)
166{
167 struct i2c_client *client = data->client;
168 int ret;
169
170 mutex_lock(&data->update_lock);
171
172 if (time_after(jiffies, data->last_updated + data->interval) ||
173 !data->valid) {
174 int i;
175
176 if (!data->valid) {
177 ret = lm95234_fill_cache(data, client);
178 if (ret < 0)
179 goto abort;
180 }
181
182 data->valid = false;
183 for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
184 ret = lm95234_read_temp(client, i, &data->temp[i]);
185 if (ret < 0)
186 goto abort;
187 }
188
189 ret = i2c_smbus_read_byte_data(client, LM95234_REG_STS_FAULT);
190 if (ret < 0)
191 goto abort;
192 data->status = ret;
193
194 ret = i2c_smbus_read_byte_data(client, LM95234_REG_STS_TCRIT1);
195 if (ret < 0)
196 goto abort;
197 data->status |= ret << 8;
198
199 ret = i2c_smbus_read_byte_data(client, LM95234_REG_STS_TCRIT2);
200 if (ret < 0)
201 goto abort;
202 data->status |= ret << 16;
203
204 data->last_updated = jiffies;
205 data->valid = true;
206 }
207 ret = 0;
208abort:
209 mutex_unlock(&data->update_lock);
210
211 return ret;
212}
213
214static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
215 char *buf)
216{
217 struct lm95234_data *data = dev_get_drvdata(dev);
218 int index = to_sensor_dev_attr(attr)->index;
219 int ret = lm95234_update_device(data);
220
221 if (ret)
222 return ret;
223
224 return sprintf(buf, "%d\n",
225 DIV_ROUND_CLOSEST(data->temp[index] * 125, 32));
226}
227
228static ssize_t show_alarm(struct device *dev,
229 struct device_attribute *attr, char *buf)
230{
231 struct lm95234_data *data = dev_get_drvdata(dev);
232 u32 mask = to_sensor_dev_attr(attr)->index;
233 int ret = lm95234_update_device(data);
234
235 if (ret)
236 return ret;
237
238 return sprintf(buf, "%u", !!(data->status & mask));
239}
240
241static ssize_t show_type(struct device *dev, struct device_attribute *attr,
242 char *buf)
243{
244 struct lm95234_data *data = dev_get_drvdata(dev);
245 u8 mask = to_sensor_dev_attr(attr)->index;
246 int ret = lm95234_update_device(data);
247
248 if (ret)
249 return ret;
250
251 return sprintf(buf, data->sensor_type & mask ? "1\n" : "2\n");
252}
253
254static ssize_t set_type(struct device *dev, struct device_attribute *attr,
255 const char *buf, size_t count)
256{
257 struct lm95234_data *data = dev_get_drvdata(dev);
258 unsigned long val;
259 u8 mask = to_sensor_dev_attr(attr)->index;
260 int ret = lm95234_update_device(data);
261
262 if (ret)
263 return ret;
264
265 ret = kstrtoul(buf, 10, &val);
266 if (ret < 0)
267 return ret;
268
269 if (val != 1 && val != 2)
270 return -EINVAL;
271
272 mutex_lock(&data->update_lock);
273 if (val == 1)
274 data->sensor_type |= mask;
275 else
276 data->sensor_type &= ~mask;
277 data->valid = false;
278 i2c_smbus_write_byte_data(data->client, LM95234_REG_REM_MODEL,
279 data->sensor_type);
280 mutex_unlock(&data->update_lock);
281
282 return count;
283}
284
285static ssize_t show_tcrit2(struct device *dev, struct device_attribute *attr,
286 char *buf)
287{
288 struct lm95234_data *data = dev_get_drvdata(dev);
289 int index = to_sensor_dev_attr(attr)->index;
290 int ret = lm95234_update_device(data);
291
292 if (ret)
293 return ret;
294
295 return sprintf(buf, "%u", data->tcrit2[index] * 1000);
296}
297
298static ssize_t set_tcrit2(struct device *dev, struct device_attribute *attr,
299 const char *buf, size_t count)
300{
301 struct lm95234_data *data = dev_get_drvdata(dev);
302 int index = to_sensor_dev_attr(attr)->index;
303 long val;
304 int ret = lm95234_update_device(data);
305
306 if (ret)
307 return ret;
308
309 ret = kstrtol(buf, 10, &val);
310 if (ret < 0)
311 return ret;
312
313 val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, index ? 255 : 127);
314
315 mutex_lock(&data->update_lock);
316 data->tcrit2[index] = val;
317 i2c_smbus_write_byte_data(data->client, LM95234_REG_TCRIT2(index), val);
318 mutex_unlock(&data->update_lock);
319
320 return count;
321}
322
323static ssize_t show_tcrit2_hyst(struct device *dev,
324 struct device_attribute *attr, char *buf)
325{
326 struct lm95234_data *data = dev_get_drvdata(dev);
327 int index = to_sensor_dev_attr(attr)->index;
328 int ret = lm95234_update_device(data);
329
330 if (ret)
331 return ret;
332
333 /* Result can be negative, so be careful with unsigned operands */
334 return sprintf(buf, "%d",
335 ((int)data->tcrit2[index] - (int)data->thyst) * 1000);
336}
337
338static ssize_t show_tcrit1(struct device *dev, struct device_attribute *attr,
339 char *buf)
340{
341 struct lm95234_data *data = dev_get_drvdata(dev);
342 int index = to_sensor_dev_attr(attr)->index;
343
344 return sprintf(buf, "%u", data->tcrit1[index] * 1000);
345}
346
347static ssize_t set_tcrit1(struct device *dev, struct device_attribute *attr,
348 const char *buf, size_t count)
349{
350 struct lm95234_data *data = dev_get_drvdata(dev);
351 int index = to_sensor_dev_attr(attr)->index;
352 int ret = lm95234_update_device(data);
353 long val;
354
355 if (ret)
356 return ret;
357
358 ret = kstrtol(buf, 10, &val);
359 if (ret < 0)
360 return ret;
361
362 val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, 255);
363
364 mutex_lock(&data->update_lock);
365 data->tcrit1[index] = val;
366 i2c_smbus_write_byte_data(data->client, LM95234_REG_TCRIT1(index), val);
367 mutex_unlock(&data->update_lock);
368
369 return count;
370}
371
372static ssize_t show_tcrit1_hyst(struct device *dev,
373 struct device_attribute *attr, char *buf)
374{
375 struct lm95234_data *data = dev_get_drvdata(dev);
376 int index = to_sensor_dev_attr(attr)->index;
377 int ret = lm95234_update_device(data);
378
379 if (ret)
380 return ret;
381
382 /* Result can be negative, so be careful with unsigned operands */
383 return sprintf(buf, "%d",
384 ((int)data->tcrit1[index] - (int)data->thyst) * 1000);
385}
386
387static ssize_t set_tcrit1_hyst(struct device *dev,
388 struct device_attribute *attr,
389 const char *buf, size_t count)
390{
391 struct lm95234_data *data = dev_get_drvdata(dev);
392 int index = to_sensor_dev_attr(attr)->index;
393 int ret = lm95234_update_device(data);
394 long val;
395
396 if (ret)
397 return ret;
398
399 ret = kstrtol(buf, 10, &val);
400 if (ret < 0)
401 return ret;
402
403 val = DIV_ROUND_CLOSEST(val, 1000);
404 val = clamp_val((int)data->tcrit1[index] - val, 0, 31);
405
406 mutex_lock(&data->update_lock);
407 data->thyst = val;
408 i2c_smbus_write_byte_data(data->client, LM95234_REG_TCRIT_HYST, val);
409 mutex_unlock(&data->update_lock);
410
411 return count;
412}
413
414static ssize_t show_offset(struct device *dev, struct device_attribute *attr,
415 char *buf)
416{
417 struct lm95234_data *data = dev_get_drvdata(dev);
418 int index = to_sensor_dev_attr(attr)->index;
419 int ret = lm95234_update_device(data);
420
421 if (ret)
422 return ret;
423
424 return sprintf(buf, "%d", data->toffset[index] * 500);
425}
426
427static ssize_t set_offset(struct device *dev, struct device_attribute *attr,
428 const char *buf, size_t count)
429{
430 struct lm95234_data *data = dev_get_drvdata(dev);
431 int index = to_sensor_dev_attr(attr)->index;
432 int ret = lm95234_update_device(data);
433 long val;
434
435 if (ret)
436 return ret;
437
438 ret = kstrtol(buf, 10, &val);
439 if (ret < 0)
440 return ret;
441
442 /* Accuracy is 1/2 degrees C */
443 val = clamp_val(DIV_ROUND_CLOSEST(val, 500), -128, 127);
444
445 mutex_lock(&data->update_lock);
446 data->toffset[index] = val;
447 i2c_smbus_write_byte_data(data->client, LM95234_REG_OFFSET(index), val);
448 mutex_unlock(&data->update_lock);
449
450 return count;
451}
452
453static ssize_t update_interval_show(struct device *dev,
454 struct device_attribute *attr, char *buf)
455{
456 struct lm95234_data *data = dev_get_drvdata(dev);
457 int ret = lm95234_update_device(data);
458
459 if (ret)
460 return ret;
461
462 return sprintf(buf, "%lu\n",
463 DIV_ROUND_CLOSEST(data->interval * 1000, HZ));
464}
465
466static ssize_t update_interval_store(struct device *dev,
467 struct device_attribute *attr,
468 const char *buf, size_t count)
469{
470 struct lm95234_data *data = dev_get_drvdata(dev);
471 int ret = lm95234_update_device(data);
472 unsigned long val;
473 u8 regval;
474
475 if (ret)
476 return ret;
477
478 ret = kstrtoul(buf, 10, &val);
479 if (ret < 0)
480 return ret;
481
482 for (regval = 0; regval < 3; regval++) {
483 if (val <= update_intervals[regval])
484 break;
485 }
486
487 mutex_lock(&data->update_lock);
488 data->interval = msecs_to_jiffies(update_intervals[regval]);
489 i2c_smbus_write_byte_data(data->client, LM95234_REG_CONVRATE, regval);
490 mutex_unlock(&data->update_lock);
491
492 return count;
493}
494
495static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);
496static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1);
497static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2);
498static SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, show_temp, NULL, 3);
499static SENSOR_DEVICE_ATTR(temp5_input, S_IRUGO, show_temp, NULL, 4);
500
501static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL,
502 BIT(0) | BIT(1));
503static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL,
504 BIT(2) | BIT(3));
505static SENSOR_DEVICE_ATTR(temp4_fault, S_IRUGO, show_alarm, NULL,
506 BIT(4) | BIT(5));
507static SENSOR_DEVICE_ATTR(temp5_fault, S_IRUGO, show_alarm, NULL,
508 BIT(6) | BIT(7));
509
510static SENSOR_DEVICE_ATTR(temp2_type, S_IWUSR | S_IRUGO, show_type, set_type,
511 BIT(1));
512static SENSOR_DEVICE_ATTR(temp3_type, S_IWUSR | S_IRUGO, show_type, set_type,
513 BIT(2));
514static SENSOR_DEVICE_ATTR(temp4_type, S_IWUSR | S_IRUGO, show_type, set_type,
515 BIT(3));
516static SENSOR_DEVICE_ATTR(temp5_type, S_IWUSR | S_IRUGO, show_type, set_type,
517 BIT(4));
518
519static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_tcrit1,
520 set_tcrit1, 0);
521static SENSOR_DEVICE_ATTR(temp2_max, S_IWUSR | S_IRUGO, show_tcrit2,
522 set_tcrit2, 0);
523static SENSOR_DEVICE_ATTR(temp3_max, S_IWUSR | S_IRUGO, show_tcrit2,
524 set_tcrit2, 1);
525static SENSOR_DEVICE_ATTR(temp4_max, S_IWUSR | S_IRUGO, show_tcrit1,
526 set_tcrit1, 3);
527static SENSOR_DEVICE_ATTR(temp5_max, S_IWUSR | S_IRUGO, show_tcrit1,
528 set_tcrit1, 4);
529
530static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO, show_tcrit1_hyst,
531 set_tcrit1_hyst, 0);
532static SENSOR_DEVICE_ATTR(temp2_max_hyst, S_IRUGO, show_tcrit2_hyst, NULL, 0);
533static SENSOR_DEVICE_ATTR(temp3_max_hyst, S_IRUGO, show_tcrit2_hyst, NULL, 1);
534static SENSOR_DEVICE_ATTR(temp4_max_hyst, S_IRUGO, show_tcrit1_hyst, NULL, 3);
535static SENSOR_DEVICE_ATTR(temp5_max_hyst, S_IRUGO, show_tcrit1_hyst, NULL, 4);
536
537static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL,
538 BIT(0 + 8));
539static SENSOR_DEVICE_ATTR(temp2_max_alarm, S_IRUGO, show_alarm, NULL,
540 BIT(1 + 16));
541static SENSOR_DEVICE_ATTR(temp3_max_alarm, S_IRUGO, show_alarm, NULL,
542 BIT(2 + 16));
543static SENSOR_DEVICE_ATTR(temp4_max_alarm, S_IRUGO, show_alarm, NULL,
544 BIT(3 + 8));
545static SENSOR_DEVICE_ATTR(temp5_max_alarm, S_IRUGO, show_alarm, NULL,
546 BIT(4 + 8));
547
548static SENSOR_DEVICE_ATTR(temp2_crit, S_IWUSR | S_IRUGO, show_tcrit1,
549 set_tcrit1, 1);
550static SENSOR_DEVICE_ATTR(temp3_crit, S_IWUSR | S_IRUGO, show_tcrit1,
551 set_tcrit1, 2);
552
553static SENSOR_DEVICE_ATTR(temp2_crit_hyst, S_IRUGO, show_tcrit1_hyst, NULL, 1);
554static SENSOR_DEVICE_ATTR(temp3_crit_hyst, S_IRUGO, show_tcrit1_hyst, NULL, 2);
555
556static SENSOR_DEVICE_ATTR(temp2_crit_alarm, S_IRUGO, show_alarm, NULL,
557 BIT(1 + 8));
558static SENSOR_DEVICE_ATTR(temp3_crit_alarm, S_IRUGO, show_alarm, NULL,
559 BIT(2 + 8));
560
561static SENSOR_DEVICE_ATTR(temp2_offset, S_IWUSR | S_IRUGO, show_offset,
562 set_offset, 0);
563static SENSOR_DEVICE_ATTR(temp3_offset, S_IWUSR | S_IRUGO, show_offset,
564 set_offset, 1);
565static SENSOR_DEVICE_ATTR(temp4_offset, S_IWUSR | S_IRUGO, show_offset,
566 set_offset, 2);
567static SENSOR_DEVICE_ATTR(temp5_offset, S_IWUSR | S_IRUGO, show_offset,
568 set_offset, 3);
569
570static DEVICE_ATTR_RW(update_interval);
571
572static struct attribute *lm95234_common_attrs[] = {
573 &sensor_dev_attr_temp1_input.dev_attr.attr,
574 &sensor_dev_attr_temp2_input.dev_attr.attr,
575 &sensor_dev_attr_temp3_input.dev_attr.attr,
576 &sensor_dev_attr_temp2_fault.dev_attr.attr,
577 &sensor_dev_attr_temp3_fault.dev_attr.attr,
578 &sensor_dev_attr_temp2_type.dev_attr.attr,
579 &sensor_dev_attr_temp3_type.dev_attr.attr,
580 &sensor_dev_attr_temp1_max.dev_attr.attr,
581 &sensor_dev_attr_temp2_max.dev_attr.attr,
582 &sensor_dev_attr_temp3_max.dev_attr.attr,
583 &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
584 &sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
585 &sensor_dev_attr_temp3_max_hyst.dev_attr.attr,
586 &sensor_dev_attr_temp1_max_alarm.dev_attr.attr,
587 &sensor_dev_attr_temp2_max_alarm.dev_attr.attr,
588 &sensor_dev_attr_temp3_max_alarm.dev_attr.attr,
589 &sensor_dev_attr_temp2_crit.dev_attr.attr,
590 &sensor_dev_attr_temp3_crit.dev_attr.attr,
591 &sensor_dev_attr_temp2_crit_hyst.dev_attr.attr,
592 &sensor_dev_attr_temp3_crit_hyst.dev_attr.attr,
593 &sensor_dev_attr_temp2_crit_alarm.dev_attr.attr,
594 &sensor_dev_attr_temp3_crit_alarm.dev_attr.attr,
595 &sensor_dev_attr_temp2_offset.dev_attr.attr,
596 &sensor_dev_attr_temp3_offset.dev_attr.attr,
597 &dev_attr_update_interval.attr,
598 NULL
599};
600
601static const struct attribute_group lm95234_common_group = {
602 .attrs = lm95234_common_attrs,
603};
604
605static struct attribute *lm95234_attrs[] = {
606 &sensor_dev_attr_temp4_input.dev_attr.attr,
607 &sensor_dev_attr_temp5_input.dev_attr.attr,
608 &sensor_dev_attr_temp4_fault.dev_attr.attr,
609 &sensor_dev_attr_temp5_fault.dev_attr.attr,
610 &sensor_dev_attr_temp4_type.dev_attr.attr,
611 &sensor_dev_attr_temp5_type.dev_attr.attr,
612 &sensor_dev_attr_temp4_max.dev_attr.attr,
613 &sensor_dev_attr_temp5_max.dev_attr.attr,
614 &sensor_dev_attr_temp4_max_hyst.dev_attr.attr,
615 &sensor_dev_attr_temp5_max_hyst.dev_attr.attr,
616 &sensor_dev_attr_temp4_max_alarm.dev_attr.attr,
617 &sensor_dev_attr_temp5_max_alarm.dev_attr.attr,
618 &sensor_dev_attr_temp4_offset.dev_attr.attr,
619 &sensor_dev_attr_temp5_offset.dev_attr.attr,
620 NULL
621};
622
623static const struct attribute_group lm95234_group = {
624 .attrs = lm95234_attrs,
625};
626
627static int lm95234_detect(struct i2c_client *client,
628 struct i2c_board_info *info)
629{
630 struct i2c_adapter *adapter = client->adapter;
631 int address = client->addr;
632 u8 config_mask, model_mask;
633 int mfg_id, chip_id, val;
634 const char *name;
635
636 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
637 return -ENODEV;
638
639 mfg_id = i2c_smbus_read_byte_data(client, LM95234_REG_MAN_ID);
640 if (mfg_id != NATSEMI_MAN_ID)
641 return -ENODEV;
642
643 chip_id = i2c_smbus_read_byte_data(client, LM95234_REG_CHIP_ID);
644 switch (chip_id) {
645 case LM95233_CHIP_ID:
646 if (address != 0x18 && address != 0x2a && address != 0x2b)
647 return -ENODEV;
648 config_mask = 0xbf;
649 model_mask = 0xf9;
650 name = "lm95233";
651 break;
652 case LM95234_CHIP_ID:
653 if (address != 0x18 && address != 0x4d && address != 0x4e)
654 return -ENODEV;
655 config_mask = 0xbc;
656 model_mask = 0xe1;
657 name = "lm95234";
658 break;
659 default:
660 return -ENODEV;
661 }
662
663 val = i2c_smbus_read_byte_data(client, LM95234_REG_STATUS);
664 if (val & 0x30)
665 return -ENODEV;
666
667 val = i2c_smbus_read_byte_data(client, LM95234_REG_CONFIG);
668 if (val & config_mask)
669 return -ENODEV;
670
671 val = i2c_smbus_read_byte_data(client, LM95234_REG_CONVRATE);
672 if (val & 0xfc)
673 return -ENODEV;
674
675 val = i2c_smbus_read_byte_data(client, LM95234_REG_REM_MODEL);
676 if (val & model_mask)
677 return -ENODEV;
678
679 val = i2c_smbus_read_byte_data(client, LM95234_REG_REM_MODEL_STS);
680 if (val & model_mask)
681 return -ENODEV;
682
683 strlcpy(info->type, name, I2C_NAME_SIZE);
684 return 0;
685}
686
687static int lm95234_init_client(struct i2c_client *client)
688{
689 int val, model;
690
691 /* start conversion if necessary */
692 val = i2c_smbus_read_byte_data(client, LM95234_REG_CONFIG);
693 if (val < 0)
694 return val;
695 if (val & 0x40)
696 i2c_smbus_write_byte_data(client, LM95234_REG_CONFIG,
697 val & ~0x40);
698
699 /* If diode type status reports an error, try to fix it */
700 val = i2c_smbus_read_byte_data(client, LM95234_REG_REM_MODEL_STS);
701 if (val < 0)
702 return val;
703 model = i2c_smbus_read_byte_data(client, LM95234_REG_REM_MODEL);
704 if (model < 0)
705 return model;
706 if (model & val) {
707 dev_notice(&client->dev,
708 "Fixing remote diode type misconfiguration (0x%x)\n",
709 val);
710 i2c_smbus_write_byte_data(client, LM95234_REG_REM_MODEL,
711 model & ~val);
712 }
713 return 0;
714}
715
716static int lm95234_probe(struct i2c_client *client,
717 const struct i2c_device_id *id)
718{
719 struct device *dev = &client->dev;
720 struct lm95234_data *data;
721 struct device *hwmon_dev;
722 int err;
723
724 data = devm_kzalloc(dev, sizeof(struct lm95234_data), GFP_KERNEL);
725 if (!data)
726 return -ENOMEM;
727
728 data->client = client;
729 mutex_init(&data->update_lock);
730
731 /* Initialize the LM95234 chip */
732 err = lm95234_init_client(client);
733 if (err < 0)
734 return err;
735
736 data->groups[0] = &lm95234_common_group;
737 if (id->driver_data == lm95234)
738 data->groups[1] = &lm95234_group;
739
740 hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name,
741 data, data->groups);
742 return PTR_ERR_OR_ZERO(hwmon_dev);
743}
744
745/* Driver data (common to all clients) */
746static const struct i2c_device_id lm95234_id[] = {
747 { "lm95233", lm95233 },
748 { "lm95234", lm95234 },
749 { }
750};
751MODULE_DEVICE_TABLE(i2c, lm95234_id);
752
753static struct i2c_driver lm95234_driver = {
754 .class = I2C_CLASS_HWMON,
755 .driver = {
756 .name = DRVNAME,
757 },
758 .probe = lm95234_probe,
759 .id_table = lm95234_id,
760 .detect = lm95234_detect,
761 .address_list = normal_i2c,
762};
763
764module_i2c_driver(lm95234_driver);
765
766MODULE_AUTHOR("Guenter Roeck <linux@roeck-us.net>");
767MODULE_DESCRIPTION("LM95233/LM95234 sensor driver");
768MODULE_LICENSE("GPL");