ASoC: arizona: Correct handling of FLL theta in synchroniser mode
[linux/fpc-iii.git] / drivers / hwmon / max6697.c
blobf03a71722849acc85f76af700d44f6cc532dc11c
1 /*
2 * Copyright (c) 2012 Guenter Roeck <linux@roeck-us.net>
4 * based on max1668.c
5 * Copyright (c) 2011 David George <david.george@ska.ac.za>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
18 #include <linux/module.h>
19 #include <linux/init.h>
20 #include <linux/slab.h>
21 #include <linux/jiffies.h>
22 #include <linux/i2c.h>
23 #include <linux/hwmon.h>
24 #include <linux/hwmon-sysfs.h>
25 #include <linux/err.h>
26 #include <linux/mutex.h>
27 #include <linux/of.h>
29 #include <linux/platform_data/max6697.h>
31 enum chips { max6581, max6602, max6622, max6636, max6689, max6693, max6694,
32 max6697, max6698, max6699 };
34 /* Report local sensor as temp1 */
36 static const u8 MAX6697_REG_TEMP[] = {
37 0x07, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x08 };
38 static const u8 MAX6697_REG_TEMP_EXT[] = {
39 0x57, 0x09, 0x52, 0x53, 0x54, 0x55, 0x56, 0 };
40 static const u8 MAX6697_REG_MAX[] = {
41 0x17, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x18 };
42 static const u8 MAX6697_REG_CRIT[] = {
43 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27 };
46 * Map device tree / platform data register bit map to chip bit map.
47 * Applies to alert register and over-temperature register.
49 #define MAX6697_MAP_BITS(reg) ((((reg) & 0x7e) >> 1) | \
50 (((reg) & 0x01) << 6) | ((reg) & 0x80))
52 #define MAX6697_REG_STAT(n) (0x44 + (n))
54 #define MAX6697_REG_CONFIG 0x41
55 #define MAX6581_CONF_EXTENDED (1 << 1)
56 #define MAX6693_CONF_BETA (1 << 2)
57 #define MAX6697_CONF_RESISTANCE (1 << 3)
58 #define MAX6697_CONF_TIMEOUT (1 << 5)
59 #define MAX6697_REG_ALERT_MASK 0x42
60 #define MAX6697_REG_OVERT_MASK 0x43
62 #define MAX6581_REG_RESISTANCE 0x4a
63 #define MAX6581_REG_IDEALITY 0x4b
64 #define MAX6581_REG_IDEALITY_SELECT 0x4c
65 #define MAX6581_REG_OFFSET 0x4d
66 #define MAX6581_REG_OFFSET_SELECT 0x4e
68 #define MAX6697_CONV_TIME 156 /* ms per channel, worst case */
70 struct max6697_chip_data {
71 int channels;
72 u32 have_ext;
73 u32 have_crit;
74 u32 have_fault;
75 u8 valid_conf;
76 const u8 *alarm_map;
79 struct max6697_data {
80 struct i2c_client *client;
82 enum chips type;
83 const struct max6697_chip_data *chip;
85 int update_interval; /* in milli-seconds */
86 int temp_offset; /* in degrees C */
88 struct mutex update_lock;
89 unsigned long last_updated; /* In jiffies */
90 bool valid; /* true if following fields are valid */
92 /* 1x local and up to 7x remote */
93 u8 temp[8][4]; /* [nr][0]=temp [1]=ext [2]=max [3]=crit */
94 #define MAX6697_TEMP_INPUT 0
95 #define MAX6697_TEMP_EXT 1
96 #define MAX6697_TEMP_MAX 2
97 #define MAX6697_TEMP_CRIT 3
98 u32 alarms;
101 /* Diode fault status bits on MAX6581 are right shifted by one bit */
102 static const u8 max6581_alarm_map[] = {
103 0, 0, 1, 2, 3, 4, 5, 6, 8, 9, 10, 11, 12, 13, 14, 15,
104 16, 17, 18, 19, 20, 21, 22, 23 };
106 static const struct max6697_chip_data max6697_chip_data[] = {
107 [max6581] = {
108 .channels = 8,
109 .have_crit = 0xff,
110 .have_ext = 0x7f,
111 .have_fault = 0xfe,
112 .valid_conf = MAX6581_CONF_EXTENDED | MAX6697_CONF_TIMEOUT,
113 .alarm_map = max6581_alarm_map,
115 [max6602] = {
116 .channels = 5,
117 .have_crit = 0x12,
118 .have_ext = 0x02,
119 .have_fault = 0x1e,
120 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6697_CONF_TIMEOUT,
122 [max6622] = {
123 .channels = 5,
124 .have_crit = 0x12,
125 .have_ext = 0x02,
126 .have_fault = 0x1e,
127 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6697_CONF_TIMEOUT,
129 [max6636] = {
130 .channels = 7,
131 .have_crit = 0x72,
132 .have_ext = 0x02,
133 .have_fault = 0x7e,
134 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6697_CONF_TIMEOUT,
136 [max6689] = {
137 .channels = 7,
138 .have_crit = 0x72,
139 .have_ext = 0x02,
140 .have_fault = 0x7e,
141 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6697_CONF_TIMEOUT,
143 [max6693] = {
144 .channels = 7,
145 .have_crit = 0x72,
146 .have_ext = 0x02,
147 .have_fault = 0x7e,
148 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6693_CONF_BETA |
149 MAX6697_CONF_TIMEOUT,
151 [max6694] = {
152 .channels = 5,
153 .have_crit = 0x12,
154 .have_ext = 0x02,
155 .have_fault = 0x1e,
156 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6693_CONF_BETA |
157 MAX6697_CONF_TIMEOUT,
159 [max6697] = {
160 .channels = 7,
161 .have_crit = 0x72,
162 .have_ext = 0x02,
163 .have_fault = 0x7e,
164 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6697_CONF_TIMEOUT,
166 [max6698] = {
167 .channels = 7,
168 .have_crit = 0x72,
169 .have_ext = 0x02,
170 .have_fault = 0x0e,
171 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6697_CONF_TIMEOUT,
173 [max6699] = {
174 .channels = 5,
175 .have_crit = 0x12,
176 .have_ext = 0x02,
177 .have_fault = 0x1e,
178 .valid_conf = MAX6697_CONF_RESISTANCE | MAX6697_CONF_TIMEOUT,
182 static struct max6697_data *max6697_update_device(struct device *dev)
184 struct max6697_data *data = dev_get_drvdata(dev);
185 struct i2c_client *client = data->client;
186 struct max6697_data *ret = data;
187 int val;
188 int i;
189 u32 alarms;
191 mutex_lock(&data->update_lock);
193 if (data->valid &&
194 !time_after(jiffies, data->last_updated
195 + msecs_to_jiffies(data->update_interval)))
196 goto abort;
198 for (i = 0; i < data->chip->channels; i++) {
199 if (data->chip->have_ext & (1 << i)) {
200 val = i2c_smbus_read_byte_data(client,
201 MAX6697_REG_TEMP_EXT[i]);
202 if (unlikely(val < 0)) {
203 ret = ERR_PTR(val);
204 goto abort;
206 data->temp[i][MAX6697_TEMP_EXT] = val;
209 val = i2c_smbus_read_byte_data(client, MAX6697_REG_TEMP[i]);
210 if (unlikely(val < 0)) {
211 ret = ERR_PTR(val);
212 goto abort;
214 data->temp[i][MAX6697_TEMP_INPUT] = val;
216 val = i2c_smbus_read_byte_data(client, MAX6697_REG_MAX[i]);
217 if (unlikely(val < 0)) {
218 ret = ERR_PTR(val);
219 goto abort;
221 data->temp[i][MAX6697_TEMP_MAX] = val;
223 if (data->chip->have_crit & (1 << i)) {
224 val = i2c_smbus_read_byte_data(client,
225 MAX6697_REG_CRIT[i]);
226 if (unlikely(val < 0)) {
227 ret = ERR_PTR(val);
228 goto abort;
230 data->temp[i][MAX6697_TEMP_CRIT] = val;
234 alarms = 0;
235 for (i = 0; i < 3; i++) {
236 val = i2c_smbus_read_byte_data(client, MAX6697_REG_STAT(i));
237 if (unlikely(val < 0)) {
238 ret = ERR_PTR(val);
239 goto abort;
241 alarms = (alarms << 8) | val;
243 data->alarms = alarms;
244 data->last_updated = jiffies;
245 data->valid = true;
246 abort:
247 mutex_unlock(&data->update_lock);
249 return ret;
252 static ssize_t show_temp_input(struct device *dev,
253 struct device_attribute *devattr, char *buf)
255 int index = to_sensor_dev_attr(devattr)->index;
256 struct max6697_data *data = max6697_update_device(dev);
257 int temp;
259 if (IS_ERR(data))
260 return PTR_ERR(data);
262 temp = (data->temp[index][MAX6697_TEMP_INPUT] - data->temp_offset) << 3;
263 temp |= data->temp[index][MAX6697_TEMP_EXT] >> 5;
265 return sprintf(buf, "%d\n", temp * 125);
268 static ssize_t show_temp(struct device *dev,
269 struct device_attribute *devattr, char *buf)
271 int nr = to_sensor_dev_attr_2(devattr)->nr;
272 int index = to_sensor_dev_attr_2(devattr)->index;
273 struct max6697_data *data = max6697_update_device(dev);
274 int temp;
276 if (IS_ERR(data))
277 return PTR_ERR(data);
279 temp = data->temp[nr][index];
280 temp -= data->temp_offset;
282 return sprintf(buf, "%d\n", temp * 1000);
285 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
286 char *buf)
288 int index = to_sensor_dev_attr(attr)->index;
289 struct max6697_data *data = max6697_update_device(dev);
291 if (IS_ERR(data))
292 return PTR_ERR(data);
294 if (data->chip->alarm_map)
295 index = data->chip->alarm_map[index];
297 return sprintf(buf, "%u\n", (data->alarms >> index) & 0x1);
300 static ssize_t set_temp(struct device *dev,
301 struct device_attribute *devattr,
302 const char *buf, size_t count)
304 int nr = to_sensor_dev_attr_2(devattr)->nr;
305 int index = to_sensor_dev_attr_2(devattr)->index;
306 struct max6697_data *data = dev_get_drvdata(dev);
307 long temp;
308 int ret;
310 ret = kstrtol(buf, 10, &temp);
311 if (ret < 0)
312 return ret;
314 mutex_lock(&data->update_lock);
315 temp = DIV_ROUND_CLOSEST(temp, 1000) + data->temp_offset;
316 temp = clamp_val(temp, 0, data->type == max6581 ? 255 : 127);
317 data->temp[nr][index] = temp;
318 ret = i2c_smbus_write_byte_data(data->client,
319 index == 2 ? MAX6697_REG_MAX[nr]
320 : MAX6697_REG_CRIT[nr],
321 temp);
322 mutex_unlock(&data->update_lock);
324 return ret < 0 ? ret : count;
327 static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp_input, NULL, 0);
328 static SENSOR_DEVICE_ATTR_2(temp1_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
329 0, MAX6697_TEMP_MAX);
330 static SENSOR_DEVICE_ATTR_2(temp1_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
331 0, MAX6697_TEMP_CRIT);
333 static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp_input, NULL, 1);
334 static SENSOR_DEVICE_ATTR_2(temp2_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
335 1, MAX6697_TEMP_MAX);
336 static SENSOR_DEVICE_ATTR_2(temp2_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
337 1, MAX6697_TEMP_CRIT);
339 static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp_input, NULL, 2);
340 static SENSOR_DEVICE_ATTR_2(temp3_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
341 2, MAX6697_TEMP_MAX);
342 static SENSOR_DEVICE_ATTR_2(temp3_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
343 2, MAX6697_TEMP_CRIT);
345 static SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, show_temp_input, NULL, 3);
346 static SENSOR_DEVICE_ATTR_2(temp4_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
347 3, MAX6697_TEMP_MAX);
348 static SENSOR_DEVICE_ATTR_2(temp4_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
349 3, MAX6697_TEMP_CRIT);
351 static SENSOR_DEVICE_ATTR(temp5_input, S_IRUGO, show_temp_input, NULL, 4);
352 static SENSOR_DEVICE_ATTR_2(temp5_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
353 4, MAX6697_TEMP_MAX);
354 static SENSOR_DEVICE_ATTR_2(temp5_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
355 4, MAX6697_TEMP_CRIT);
357 static SENSOR_DEVICE_ATTR(temp6_input, S_IRUGO, show_temp_input, NULL, 5);
358 static SENSOR_DEVICE_ATTR_2(temp6_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
359 5, MAX6697_TEMP_MAX);
360 static SENSOR_DEVICE_ATTR_2(temp6_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
361 5, MAX6697_TEMP_CRIT);
363 static SENSOR_DEVICE_ATTR(temp7_input, S_IRUGO, show_temp_input, NULL, 6);
364 static SENSOR_DEVICE_ATTR_2(temp7_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
365 6, MAX6697_TEMP_MAX);
366 static SENSOR_DEVICE_ATTR_2(temp7_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
367 6, MAX6697_TEMP_CRIT);
369 static SENSOR_DEVICE_ATTR(temp8_input, S_IRUGO, show_temp_input, NULL, 7);
370 static SENSOR_DEVICE_ATTR_2(temp8_max, S_IRUGO | S_IWUSR, show_temp, set_temp,
371 7, MAX6697_TEMP_MAX);
372 static SENSOR_DEVICE_ATTR_2(temp8_crit, S_IRUGO | S_IWUSR, show_temp, set_temp,
373 7, MAX6697_TEMP_CRIT);
375 static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 22);
376 static SENSOR_DEVICE_ATTR(temp2_max_alarm, S_IRUGO, show_alarm, NULL, 16);
377 static SENSOR_DEVICE_ATTR(temp3_max_alarm, S_IRUGO, show_alarm, NULL, 17);
378 static SENSOR_DEVICE_ATTR(temp4_max_alarm, S_IRUGO, show_alarm, NULL, 18);
379 static SENSOR_DEVICE_ATTR(temp5_max_alarm, S_IRUGO, show_alarm, NULL, 19);
380 static SENSOR_DEVICE_ATTR(temp6_max_alarm, S_IRUGO, show_alarm, NULL, 20);
381 static SENSOR_DEVICE_ATTR(temp7_max_alarm, S_IRUGO, show_alarm, NULL, 21);
382 static SENSOR_DEVICE_ATTR(temp8_max_alarm, S_IRUGO, show_alarm, NULL, 23);
384 static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 14);
385 static SENSOR_DEVICE_ATTR(temp2_crit_alarm, S_IRUGO, show_alarm, NULL, 8);
386 static SENSOR_DEVICE_ATTR(temp3_crit_alarm, S_IRUGO, show_alarm, NULL, 9);
387 static SENSOR_DEVICE_ATTR(temp4_crit_alarm, S_IRUGO, show_alarm, NULL, 10);
388 static SENSOR_DEVICE_ATTR(temp5_crit_alarm, S_IRUGO, show_alarm, NULL, 11);
389 static SENSOR_DEVICE_ATTR(temp6_crit_alarm, S_IRUGO, show_alarm, NULL, 12);
390 static SENSOR_DEVICE_ATTR(temp7_crit_alarm, S_IRUGO, show_alarm, NULL, 13);
391 static SENSOR_DEVICE_ATTR(temp8_crit_alarm, S_IRUGO, show_alarm, NULL, 15);
393 static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 1);
394 static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 2);
395 static SENSOR_DEVICE_ATTR(temp4_fault, S_IRUGO, show_alarm, NULL, 3);
396 static SENSOR_DEVICE_ATTR(temp5_fault, S_IRUGO, show_alarm, NULL, 4);
397 static SENSOR_DEVICE_ATTR(temp6_fault, S_IRUGO, show_alarm, NULL, 5);
398 static SENSOR_DEVICE_ATTR(temp7_fault, S_IRUGO, show_alarm, NULL, 6);
399 static SENSOR_DEVICE_ATTR(temp8_fault, S_IRUGO, show_alarm, NULL, 7);
401 static DEVICE_ATTR(dummy, 0, NULL, NULL);
403 static umode_t max6697_is_visible(struct kobject *kobj, struct attribute *attr,
404 int index)
406 struct device *dev = container_of(kobj, struct device, kobj);
407 struct max6697_data *data = dev_get_drvdata(dev);
408 const struct max6697_chip_data *chip = data->chip;
409 int channel = index / 6; /* channel number */
410 int nr = index % 6; /* attribute index within channel */
412 if (channel >= chip->channels)
413 return 0;
415 if ((nr == 3 || nr == 4) && !(chip->have_crit & (1 << channel)))
416 return 0;
417 if (nr == 5 && !(chip->have_fault & (1 << channel)))
418 return 0;
420 return attr->mode;
424 * max6697_is_visible uses the index into the following array to determine
425 * if attributes should be created or not. Any change in order or content
426 * must be matched in max6697_is_visible.
428 static struct attribute *max6697_attributes[] = {
429 &sensor_dev_attr_temp1_input.dev_attr.attr,
430 &sensor_dev_attr_temp1_max.dev_attr.attr,
431 &sensor_dev_attr_temp1_max_alarm.dev_attr.attr,
432 &sensor_dev_attr_temp1_crit.dev_attr.attr,
433 &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr,
434 &dev_attr_dummy.attr,
436 &sensor_dev_attr_temp2_input.dev_attr.attr,
437 &sensor_dev_attr_temp2_max.dev_attr.attr,
438 &sensor_dev_attr_temp2_max_alarm.dev_attr.attr,
439 &sensor_dev_attr_temp2_crit.dev_attr.attr,
440 &sensor_dev_attr_temp2_crit_alarm.dev_attr.attr,
441 &sensor_dev_attr_temp2_fault.dev_attr.attr,
443 &sensor_dev_attr_temp3_input.dev_attr.attr,
444 &sensor_dev_attr_temp3_max.dev_attr.attr,
445 &sensor_dev_attr_temp3_max_alarm.dev_attr.attr,
446 &sensor_dev_attr_temp3_crit.dev_attr.attr,
447 &sensor_dev_attr_temp3_crit_alarm.dev_attr.attr,
448 &sensor_dev_attr_temp3_fault.dev_attr.attr,
450 &sensor_dev_attr_temp4_input.dev_attr.attr,
451 &sensor_dev_attr_temp4_max.dev_attr.attr,
452 &sensor_dev_attr_temp4_max_alarm.dev_attr.attr,
453 &sensor_dev_attr_temp4_crit.dev_attr.attr,
454 &sensor_dev_attr_temp4_crit_alarm.dev_attr.attr,
455 &sensor_dev_attr_temp4_fault.dev_attr.attr,
457 &sensor_dev_attr_temp5_input.dev_attr.attr,
458 &sensor_dev_attr_temp5_max.dev_attr.attr,
459 &sensor_dev_attr_temp5_max_alarm.dev_attr.attr,
460 &sensor_dev_attr_temp5_crit.dev_attr.attr,
461 &sensor_dev_attr_temp5_crit_alarm.dev_attr.attr,
462 &sensor_dev_attr_temp5_fault.dev_attr.attr,
464 &sensor_dev_attr_temp6_input.dev_attr.attr,
465 &sensor_dev_attr_temp6_max.dev_attr.attr,
466 &sensor_dev_attr_temp6_max_alarm.dev_attr.attr,
467 &sensor_dev_attr_temp6_crit.dev_attr.attr,
468 &sensor_dev_attr_temp6_crit_alarm.dev_attr.attr,
469 &sensor_dev_attr_temp6_fault.dev_attr.attr,
471 &sensor_dev_attr_temp7_input.dev_attr.attr,
472 &sensor_dev_attr_temp7_max.dev_attr.attr,
473 &sensor_dev_attr_temp7_max_alarm.dev_attr.attr,
474 &sensor_dev_attr_temp7_crit.dev_attr.attr,
475 &sensor_dev_attr_temp7_crit_alarm.dev_attr.attr,
476 &sensor_dev_attr_temp7_fault.dev_attr.attr,
478 &sensor_dev_attr_temp8_input.dev_attr.attr,
479 &sensor_dev_attr_temp8_max.dev_attr.attr,
480 &sensor_dev_attr_temp8_max_alarm.dev_attr.attr,
481 &sensor_dev_attr_temp8_crit.dev_attr.attr,
482 &sensor_dev_attr_temp8_crit_alarm.dev_attr.attr,
483 &sensor_dev_attr_temp8_fault.dev_attr.attr,
484 NULL
487 static const struct attribute_group max6697_group = {
488 .attrs = max6697_attributes, .is_visible = max6697_is_visible,
490 __ATTRIBUTE_GROUPS(max6697);
492 static void max6697_get_config_of(struct device_node *node,
493 struct max6697_platform_data *pdata)
495 int len;
496 const __be32 *prop;
498 pdata->smbus_timeout_disable =
499 of_property_read_bool(node, "smbus-timeout-disable");
500 pdata->extended_range_enable =
501 of_property_read_bool(node, "extended-range-enable");
502 pdata->beta_compensation =
503 of_property_read_bool(node, "beta-compensation-enable");
505 prop = of_get_property(node, "alert-mask", &len);
506 if (prop && len == sizeof(u32))
507 pdata->alert_mask = be32_to_cpu(prop[0]);
508 prop = of_get_property(node, "over-temperature-mask", &len);
509 if (prop && len == sizeof(u32))
510 pdata->over_temperature_mask = be32_to_cpu(prop[0]);
511 prop = of_get_property(node, "resistance-cancellation", &len);
512 if (prop) {
513 if (len == sizeof(u32))
514 pdata->resistance_cancellation = be32_to_cpu(prop[0]);
515 else
516 pdata->resistance_cancellation = 0xfe;
518 prop = of_get_property(node, "transistor-ideality", &len);
519 if (prop && len == 2 * sizeof(u32)) {
520 pdata->ideality_mask = be32_to_cpu(prop[0]);
521 pdata->ideality_value = be32_to_cpu(prop[1]);
525 static int max6697_init_chip(struct max6697_data *data,
526 struct i2c_client *client)
528 struct max6697_platform_data *pdata = dev_get_platdata(&client->dev);
529 struct max6697_platform_data p;
530 const struct max6697_chip_data *chip = data->chip;
531 int factor = chip->channels;
532 int ret, reg;
535 * Don't touch configuration if neither platform data nor OF
536 * configuration was specified. If that is the case, use the
537 * current chip configuration.
539 if (!pdata && !client->dev.of_node) {
540 reg = i2c_smbus_read_byte_data(client, MAX6697_REG_CONFIG);
541 if (reg < 0)
542 return reg;
543 if (data->type == max6581) {
544 if (reg & MAX6581_CONF_EXTENDED)
545 data->temp_offset = 64;
546 reg = i2c_smbus_read_byte_data(client,
547 MAX6581_REG_RESISTANCE);
548 if (reg < 0)
549 return reg;
550 factor += hweight8(reg);
551 } else {
552 if (reg & MAX6697_CONF_RESISTANCE)
553 factor++;
555 goto done;
558 if (client->dev.of_node) {
559 memset(&p, 0, sizeof(p));
560 max6697_get_config_of(client->dev.of_node, &p);
561 pdata = &p;
564 reg = 0;
565 if (pdata->smbus_timeout_disable &&
566 (chip->valid_conf & MAX6697_CONF_TIMEOUT)) {
567 reg |= MAX6697_CONF_TIMEOUT;
569 if (pdata->extended_range_enable &&
570 (chip->valid_conf & MAX6581_CONF_EXTENDED)) {
571 reg |= MAX6581_CONF_EXTENDED;
572 data->temp_offset = 64;
574 if (pdata->resistance_cancellation &&
575 (chip->valid_conf & MAX6697_CONF_RESISTANCE)) {
576 reg |= MAX6697_CONF_RESISTANCE;
577 factor++;
579 if (pdata->beta_compensation &&
580 (chip->valid_conf & MAX6693_CONF_BETA)) {
581 reg |= MAX6693_CONF_BETA;
584 ret = i2c_smbus_write_byte_data(client, MAX6697_REG_CONFIG, reg);
585 if (ret < 0)
586 return ret;
588 ret = i2c_smbus_write_byte_data(client, MAX6697_REG_ALERT_MASK,
589 MAX6697_MAP_BITS(pdata->alert_mask));
590 if (ret < 0)
591 return ret;
593 ret = i2c_smbus_write_byte_data(client, MAX6697_REG_OVERT_MASK,
594 MAX6697_MAP_BITS(pdata->over_temperature_mask));
595 if (ret < 0)
596 return ret;
598 if (data->type == max6581) {
599 factor += hweight8(pdata->resistance_cancellation >> 1);
600 ret = i2c_smbus_write_byte_data(client, MAX6581_REG_RESISTANCE,
601 pdata->resistance_cancellation >> 1);
602 if (ret < 0)
603 return ret;
604 ret = i2c_smbus_write_byte_data(client, MAX6581_REG_IDEALITY,
605 pdata->ideality_value);
606 if (ret < 0)
607 return ret;
608 ret = i2c_smbus_write_byte_data(client,
609 MAX6581_REG_IDEALITY_SELECT,
610 pdata->ideality_mask >> 1);
611 if (ret < 0)
612 return ret;
614 done:
615 data->update_interval = factor * MAX6697_CONV_TIME;
616 return 0;
619 static int max6697_probe(struct i2c_client *client,
620 const struct i2c_device_id *id)
622 struct i2c_adapter *adapter = client->adapter;
623 struct device *dev = &client->dev;
624 struct max6697_data *data;
625 struct device *hwmon_dev;
626 int err;
628 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
629 return -ENODEV;
631 data = devm_kzalloc(dev, sizeof(struct max6697_data), GFP_KERNEL);
632 if (!data)
633 return -ENOMEM;
635 data->type = id->driver_data;
636 data->chip = &max6697_chip_data[data->type];
637 data->client = client;
638 mutex_init(&data->update_lock);
640 err = max6697_init_chip(data, client);
641 if (err)
642 return err;
644 hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name,
645 data,
646 max6697_groups);
647 return PTR_ERR_OR_ZERO(hwmon_dev);
650 static const struct i2c_device_id max6697_id[] = {
651 { "max6581", max6581 },
652 { "max6602", max6602 },
653 { "max6622", max6622 },
654 { "max6636", max6636 },
655 { "max6689", max6689 },
656 { "max6693", max6693 },
657 { "max6694", max6694 },
658 { "max6697", max6697 },
659 { "max6698", max6698 },
660 { "max6699", max6699 },
663 MODULE_DEVICE_TABLE(i2c, max6697_id);
665 static struct i2c_driver max6697_driver = {
666 .class = I2C_CLASS_HWMON,
667 .driver = {
668 .name = "max6697",
670 .probe = max6697_probe,
671 .id_table = max6697_id,
674 module_i2c_driver(max6697_driver);
676 MODULE_AUTHOR("Guenter Roeck <linux@roeck-us.net>");
677 MODULE_DESCRIPTION("MAX6697 temperature sensor driver");
678 MODULE_LICENSE("GPL");