Avoid beyond bounds copy while caching ACL
[zen-stable.git] / drivers / hwmon / smm665.c
blob411638181fd85fd938c0107f24c2aa0de119337c
1 /*
2 * Driver for SMM665 Power Controller / Monitor
4 * Copyright (C) 2010 Ericsson AB.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; version 2 of the License.
10 * This driver should also work for SMM465, SMM764, and SMM766, but is untested
11 * for those chips. Only monitoring functionality is implemented.
13 * Datasheets:
14 * http://www.summitmicro.com/prod_select/summary/SMM665/SMM665B_2089_20.pdf
15 * http://www.summitmicro.com/prod_select/summary/SMM766B/SMM766B_2122.pdf
18 #include <linux/kernel.h>
19 #include <linux/module.h>
20 #include <linux/init.h>
21 #include <linux/err.h>
22 #include <linux/slab.h>
23 #include <linux/i2c.h>
24 #include <linux/hwmon.h>
25 #include <linux/hwmon-sysfs.h>
26 #include <linux/delay.h>
28 /* Internal reference voltage (VREF, x 1000 */
29 #define SMM665_VREF_ADC_X1000 1250
31 /* module parameters */
32 static int vref = SMM665_VREF_ADC_X1000;
33 module_param(vref, int, 0);
34 MODULE_PARM_DESC(vref, "Reference voltage in mV");
36 enum chips { smm465, smm665, smm665c, smm764, smm766 };
39 * ADC channel addresses
41 #define SMM665_MISC16_ADC_DATA_A 0x00
42 #define SMM665_MISC16_ADC_DATA_B 0x01
43 #define SMM665_MISC16_ADC_DATA_C 0x02
44 #define SMM665_MISC16_ADC_DATA_D 0x03
45 #define SMM665_MISC16_ADC_DATA_E 0x04
46 #define SMM665_MISC16_ADC_DATA_F 0x05
47 #define SMM665_MISC16_ADC_DATA_VDD 0x06
48 #define SMM665_MISC16_ADC_DATA_12V 0x07
49 #define SMM665_MISC16_ADC_DATA_INT_TEMP 0x08
50 #define SMM665_MISC16_ADC_DATA_AIN1 0x09
51 #define SMM665_MISC16_ADC_DATA_AIN2 0x0a
54 * Command registers
56 #define SMM665_MISC8_CMD_STS 0x80
57 #define SMM665_MISC8_STATUS1 0x81
58 #define SMM665_MISC8_STATUSS2 0x82
59 #define SMM665_MISC8_IO_POLARITY 0x83
60 #define SMM665_MISC8_PUP_POLARITY 0x84
61 #define SMM665_MISC8_ADOC_STATUS1 0x85
62 #define SMM665_MISC8_ADOC_STATUS2 0x86
63 #define SMM665_MISC8_WRITE_PROT 0x87
64 #define SMM665_MISC8_STS_TRACK 0x88
67 * Configuration registers and register groups
69 #define SMM665_ADOC_ENABLE 0x0d
70 #define SMM665_LIMIT_BASE 0x80 /* First limit register */
73 * Limit register bit masks
75 #define SMM665_TRIGGER_RST 0x8000
76 #define SMM665_TRIGGER_HEALTHY 0x4000
77 #define SMM665_TRIGGER_POWEROFF 0x2000
78 #define SMM665_TRIGGER_SHUTDOWN 0x1000
79 #define SMM665_ADC_MASK 0x03ff
81 #define smm665_is_critical(lim) ((lim) & (SMM665_TRIGGER_RST \
82 | SMM665_TRIGGER_POWEROFF \
83 | SMM665_TRIGGER_SHUTDOWN))
85 * Fault register bit definitions
86 * Values are merged from status registers 1/2,
87 * with status register 1 providing the upper 8 bits.
89 #define SMM665_FAULT_A 0x0001
90 #define SMM665_FAULT_B 0x0002
91 #define SMM665_FAULT_C 0x0004
92 #define SMM665_FAULT_D 0x0008
93 #define SMM665_FAULT_E 0x0010
94 #define SMM665_FAULT_F 0x0020
95 #define SMM665_FAULT_VDD 0x0040
96 #define SMM665_FAULT_12V 0x0080
97 #define SMM665_FAULT_TEMP 0x0100
98 #define SMM665_FAULT_AIN1 0x0200
99 #define SMM665_FAULT_AIN2 0x0400
102 * I2C Register addresses
104 * The configuration register needs to be the configured base register.
105 * The command/status register address is derived from it.
107 #define SMM665_REGMASK 0x78
108 #define SMM665_CMDREG_BASE 0x48
109 #define SMM665_CONFREG_BASE 0x50
112 * Equations given by chip manufacturer to calculate voltage/temperature values
113 * vref = Reference voltage on VREF_ADC pin (module parameter)
114 * adc = 10bit ADC value read back from registers
117 /* Voltage A-F and VDD */
118 #define SMM665_VMON_ADC_TO_VOLTS(adc) ((adc) * vref / 256)
120 /* Voltage 12VIN */
121 #define SMM665_12VIN_ADC_TO_VOLTS(adc) ((adc) * vref * 3 / 256)
123 /* Voltage AIN1, AIN2 */
124 #define SMM665_AIN_ADC_TO_VOLTS(adc) ((adc) * vref / 512)
126 /* Temp Sensor */
127 #define SMM665_TEMP_ADC_TO_CELSIUS(adc) ((adc) <= 511) ? \
128 ((int)(adc) * 1000 / 4) : \
129 (((int)(adc) - 0x400) * 1000 / 4)
131 #define SMM665_NUM_ADC 11
134 * Chip dependent ADC conversion time, in uS
136 #define SMM665_ADC_WAIT_SMM665 70
137 #define SMM665_ADC_WAIT_SMM766 185
139 struct smm665_data {
140 enum chips type;
141 int conversion_time; /* ADC conversion time */
142 struct device *hwmon_dev;
143 struct mutex update_lock;
144 bool valid;
145 unsigned long last_updated; /* in jiffies */
146 u16 adc[SMM665_NUM_ADC]; /* adc values (raw) */
147 u16 faults; /* fault status */
148 /* The following values are in mV */
149 int critical_min_limit[SMM665_NUM_ADC];
150 int alarm_min_limit[SMM665_NUM_ADC];
151 int critical_max_limit[SMM665_NUM_ADC];
152 int alarm_max_limit[SMM665_NUM_ADC];
153 struct i2c_client *cmdreg;
157 * smm665_read16()
159 * Read 16 bit value from <reg>, <reg+1>. Upper 8 bits are in <reg>.
161 static int smm665_read16(struct i2c_client *client, int reg)
163 int rv, val;
165 rv = i2c_smbus_read_byte_data(client, reg);
166 if (rv < 0)
167 return rv;
168 val = rv << 8;
169 rv = i2c_smbus_read_byte_data(client, reg + 1);
170 if (rv < 0)
171 return rv;
172 val |= rv;
173 return val;
177 * Read adc value.
179 static int smm665_read_adc(struct smm665_data *data, int adc)
181 struct i2c_client *client = data->cmdreg;
182 int rv;
183 int radc;
186 * Algorithm for reading ADC, per SMM665 datasheet
188 * {[S][addr][W][Ack]} {[offset][Ack]} {[S][addr][R][Nack]}
189 * [wait conversion time]
190 * {[S][addr][R][Ack]} {[datahi][Ack]} {[datalo][Ack][P]}
192 * To implement the first part of this exchange,
193 * do a full read transaction and expect a failure/Nack.
194 * This sets up the address pointer on the SMM665
195 * and starts the ADC conversion.
196 * Then do a two-byte read transaction.
198 rv = i2c_smbus_read_byte_data(client, adc << 3);
199 if (rv != -ENXIO) {
201 * We expect ENXIO to reflect NACK
202 * (per Documentation/i2c/fault-codes).
203 * Everything else is an error.
205 dev_dbg(&client->dev,
206 "Unexpected return code %d when setting ADC index", rv);
207 return (rv < 0) ? rv : -EIO;
210 udelay(data->conversion_time);
213 * Now read two bytes.
215 * Neither i2c_smbus_read_byte() nor
216 * i2c_smbus_read_block_data() worked here,
217 * so use i2c_smbus_read_word_swapped() instead.
218 * We could also try to use i2c_master_recv(),
219 * but that is not always supported.
221 rv = i2c_smbus_read_word_swapped(client, 0);
222 if (rv < 0) {
223 dev_dbg(&client->dev, "Failed to read ADC value: error %d", rv);
224 return -1;
227 * Validate/verify readback adc channel (in bit 11..14).
229 radc = (rv >> 11) & 0x0f;
230 if (radc != adc) {
231 dev_dbg(&client->dev, "Unexpected RADC: Expected %d got %d",
232 adc, radc);
233 return -EIO;
236 return rv & SMM665_ADC_MASK;
239 static struct smm665_data *smm665_update_device(struct device *dev)
241 struct i2c_client *client = to_i2c_client(dev);
242 struct smm665_data *data = i2c_get_clientdata(client);
243 struct smm665_data *ret = data;
245 mutex_lock(&data->update_lock);
247 if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
248 int i, val;
251 * read status registers
253 val = smm665_read16(client, SMM665_MISC8_STATUS1);
254 if (unlikely(val < 0)) {
255 ret = ERR_PTR(val);
256 goto abort;
258 data->faults = val;
260 /* Read adc registers */
261 for (i = 0; i < SMM665_NUM_ADC; i++) {
262 val = smm665_read_adc(data, i);
263 if (unlikely(val < 0)) {
264 ret = ERR_PTR(val);
265 goto abort;
267 data->adc[i] = val;
269 data->last_updated = jiffies;
270 data->valid = 1;
272 abort:
273 mutex_unlock(&data->update_lock);
274 return ret;
277 /* Return converted value from given adc */
278 static int smm665_convert(u16 adcval, int index)
280 int val = 0;
282 switch (index) {
283 case SMM665_MISC16_ADC_DATA_12V:
284 val = SMM665_12VIN_ADC_TO_VOLTS(adcval & SMM665_ADC_MASK);
285 break;
287 case SMM665_MISC16_ADC_DATA_VDD:
288 case SMM665_MISC16_ADC_DATA_A:
289 case SMM665_MISC16_ADC_DATA_B:
290 case SMM665_MISC16_ADC_DATA_C:
291 case SMM665_MISC16_ADC_DATA_D:
292 case SMM665_MISC16_ADC_DATA_E:
293 case SMM665_MISC16_ADC_DATA_F:
294 val = SMM665_VMON_ADC_TO_VOLTS(adcval & SMM665_ADC_MASK);
295 break;
297 case SMM665_MISC16_ADC_DATA_AIN1:
298 case SMM665_MISC16_ADC_DATA_AIN2:
299 val = SMM665_AIN_ADC_TO_VOLTS(adcval & SMM665_ADC_MASK);
300 break;
302 case SMM665_MISC16_ADC_DATA_INT_TEMP:
303 val = SMM665_TEMP_ADC_TO_CELSIUS(adcval & SMM665_ADC_MASK);
304 break;
306 default:
307 /* If we get here, the developer messed up */
308 WARN_ON_ONCE(1);
309 break;
312 return val;
315 static int smm665_get_min(struct device *dev, int index)
317 struct i2c_client *client = to_i2c_client(dev);
318 struct smm665_data *data = i2c_get_clientdata(client);
320 return data->alarm_min_limit[index];
323 static int smm665_get_max(struct device *dev, int index)
325 struct i2c_client *client = to_i2c_client(dev);
326 struct smm665_data *data = i2c_get_clientdata(client);
328 return data->alarm_max_limit[index];
331 static int smm665_get_lcrit(struct device *dev, int index)
333 struct i2c_client *client = to_i2c_client(dev);
334 struct smm665_data *data = i2c_get_clientdata(client);
336 return data->critical_min_limit[index];
339 static int smm665_get_crit(struct device *dev, int index)
341 struct i2c_client *client = to_i2c_client(dev);
342 struct smm665_data *data = i2c_get_clientdata(client);
344 return data->critical_max_limit[index];
347 static ssize_t smm665_show_crit_alarm(struct device *dev,
348 struct device_attribute *da, char *buf)
350 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
351 struct smm665_data *data = smm665_update_device(dev);
352 int val = 0;
354 if (IS_ERR(data))
355 return PTR_ERR(data);
357 if (data->faults & (1 << attr->index))
358 val = 1;
360 return snprintf(buf, PAGE_SIZE, "%d\n", val);
363 static ssize_t smm665_show_input(struct device *dev,
364 struct device_attribute *da, char *buf)
366 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
367 struct smm665_data *data = smm665_update_device(dev);
368 int adc = attr->index;
369 int val;
371 if (IS_ERR(data))
372 return PTR_ERR(data);
374 val = smm665_convert(data->adc[adc], adc);
375 return snprintf(buf, PAGE_SIZE, "%d\n", val);
378 #define SMM665_SHOW(what) \
379 static ssize_t smm665_show_##what(struct device *dev, \
380 struct device_attribute *da, char *buf) \
382 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
383 const int val = smm665_get_##what(dev, attr->index); \
384 return snprintf(buf, PAGE_SIZE, "%d\n", val); \
387 SMM665_SHOW(min);
388 SMM665_SHOW(max);
389 SMM665_SHOW(lcrit);
390 SMM665_SHOW(crit);
392 /* These macros are used below in constructing device attribute objects
393 * for use with sysfs_create_group() to make a sysfs device file
394 * for each register.
397 #define SMM665_ATTR(name, type, cmd_idx) \
398 static SENSOR_DEVICE_ATTR(name##_##type, S_IRUGO, \
399 smm665_show_##type, NULL, cmd_idx)
401 /* Construct a sensor_device_attribute structure for each register */
403 /* Input voltages */
404 SMM665_ATTR(in1, input, SMM665_MISC16_ADC_DATA_12V);
405 SMM665_ATTR(in2, input, SMM665_MISC16_ADC_DATA_VDD);
406 SMM665_ATTR(in3, input, SMM665_MISC16_ADC_DATA_A);
407 SMM665_ATTR(in4, input, SMM665_MISC16_ADC_DATA_B);
408 SMM665_ATTR(in5, input, SMM665_MISC16_ADC_DATA_C);
409 SMM665_ATTR(in6, input, SMM665_MISC16_ADC_DATA_D);
410 SMM665_ATTR(in7, input, SMM665_MISC16_ADC_DATA_E);
411 SMM665_ATTR(in8, input, SMM665_MISC16_ADC_DATA_F);
412 SMM665_ATTR(in9, input, SMM665_MISC16_ADC_DATA_AIN1);
413 SMM665_ATTR(in10, input, SMM665_MISC16_ADC_DATA_AIN2);
415 /* Input voltages min */
416 SMM665_ATTR(in1, min, SMM665_MISC16_ADC_DATA_12V);
417 SMM665_ATTR(in2, min, SMM665_MISC16_ADC_DATA_VDD);
418 SMM665_ATTR(in3, min, SMM665_MISC16_ADC_DATA_A);
419 SMM665_ATTR(in4, min, SMM665_MISC16_ADC_DATA_B);
420 SMM665_ATTR(in5, min, SMM665_MISC16_ADC_DATA_C);
421 SMM665_ATTR(in6, min, SMM665_MISC16_ADC_DATA_D);
422 SMM665_ATTR(in7, min, SMM665_MISC16_ADC_DATA_E);
423 SMM665_ATTR(in8, min, SMM665_MISC16_ADC_DATA_F);
424 SMM665_ATTR(in9, min, SMM665_MISC16_ADC_DATA_AIN1);
425 SMM665_ATTR(in10, min, SMM665_MISC16_ADC_DATA_AIN2);
427 /* Input voltages max */
428 SMM665_ATTR(in1, max, SMM665_MISC16_ADC_DATA_12V);
429 SMM665_ATTR(in2, max, SMM665_MISC16_ADC_DATA_VDD);
430 SMM665_ATTR(in3, max, SMM665_MISC16_ADC_DATA_A);
431 SMM665_ATTR(in4, max, SMM665_MISC16_ADC_DATA_B);
432 SMM665_ATTR(in5, max, SMM665_MISC16_ADC_DATA_C);
433 SMM665_ATTR(in6, max, SMM665_MISC16_ADC_DATA_D);
434 SMM665_ATTR(in7, max, SMM665_MISC16_ADC_DATA_E);
435 SMM665_ATTR(in8, max, SMM665_MISC16_ADC_DATA_F);
436 SMM665_ATTR(in9, max, SMM665_MISC16_ADC_DATA_AIN1);
437 SMM665_ATTR(in10, max, SMM665_MISC16_ADC_DATA_AIN2);
439 /* Input voltages lcrit */
440 SMM665_ATTR(in1, lcrit, SMM665_MISC16_ADC_DATA_12V);
441 SMM665_ATTR(in2, lcrit, SMM665_MISC16_ADC_DATA_VDD);
442 SMM665_ATTR(in3, lcrit, SMM665_MISC16_ADC_DATA_A);
443 SMM665_ATTR(in4, lcrit, SMM665_MISC16_ADC_DATA_B);
444 SMM665_ATTR(in5, lcrit, SMM665_MISC16_ADC_DATA_C);
445 SMM665_ATTR(in6, lcrit, SMM665_MISC16_ADC_DATA_D);
446 SMM665_ATTR(in7, lcrit, SMM665_MISC16_ADC_DATA_E);
447 SMM665_ATTR(in8, lcrit, SMM665_MISC16_ADC_DATA_F);
448 SMM665_ATTR(in9, lcrit, SMM665_MISC16_ADC_DATA_AIN1);
449 SMM665_ATTR(in10, lcrit, SMM665_MISC16_ADC_DATA_AIN2);
451 /* Input voltages crit */
452 SMM665_ATTR(in1, crit, SMM665_MISC16_ADC_DATA_12V);
453 SMM665_ATTR(in2, crit, SMM665_MISC16_ADC_DATA_VDD);
454 SMM665_ATTR(in3, crit, SMM665_MISC16_ADC_DATA_A);
455 SMM665_ATTR(in4, crit, SMM665_MISC16_ADC_DATA_B);
456 SMM665_ATTR(in5, crit, SMM665_MISC16_ADC_DATA_C);
457 SMM665_ATTR(in6, crit, SMM665_MISC16_ADC_DATA_D);
458 SMM665_ATTR(in7, crit, SMM665_MISC16_ADC_DATA_E);
459 SMM665_ATTR(in8, crit, SMM665_MISC16_ADC_DATA_F);
460 SMM665_ATTR(in9, crit, SMM665_MISC16_ADC_DATA_AIN1);
461 SMM665_ATTR(in10, crit, SMM665_MISC16_ADC_DATA_AIN2);
463 /* critical alarms */
464 SMM665_ATTR(in1, crit_alarm, SMM665_FAULT_12V);
465 SMM665_ATTR(in2, crit_alarm, SMM665_FAULT_VDD);
466 SMM665_ATTR(in3, crit_alarm, SMM665_FAULT_A);
467 SMM665_ATTR(in4, crit_alarm, SMM665_FAULT_B);
468 SMM665_ATTR(in5, crit_alarm, SMM665_FAULT_C);
469 SMM665_ATTR(in6, crit_alarm, SMM665_FAULT_D);
470 SMM665_ATTR(in7, crit_alarm, SMM665_FAULT_E);
471 SMM665_ATTR(in8, crit_alarm, SMM665_FAULT_F);
472 SMM665_ATTR(in9, crit_alarm, SMM665_FAULT_AIN1);
473 SMM665_ATTR(in10, crit_alarm, SMM665_FAULT_AIN2);
475 /* Temperature */
476 SMM665_ATTR(temp1, input, SMM665_MISC16_ADC_DATA_INT_TEMP);
477 SMM665_ATTR(temp1, min, SMM665_MISC16_ADC_DATA_INT_TEMP);
478 SMM665_ATTR(temp1, max, SMM665_MISC16_ADC_DATA_INT_TEMP);
479 SMM665_ATTR(temp1, lcrit, SMM665_MISC16_ADC_DATA_INT_TEMP);
480 SMM665_ATTR(temp1, crit, SMM665_MISC16_ADC_DATA_INT_TEMP);
481 SMM665_ATTR(temp1, crit_alarm, SMM665_FAULT_TEMP);
484 * Finally, construct an array of pointers to members of the above objects,
485 * as required for sysfs_create_group()
487 static struct attribute *smm665_attributes[] = {
488 &sensor_dev_attr_in1_input.dev_attr.attr,
489 &sensor_dev_attr_in1_min.dev_attr.attr,
490 &sensor_dev_attr_in1_max.dev_attr.attr,
491 &sensor_dev_attr_in1_lcrit.dev_attr.attr,
492 &sensor_dev_attr_in1_crit.dev_attr.attr,
493 &sensor_dev_attr_in1_crit_alarm.dev_attr.attr,
495 &sensor_dev_attr_in2_input.dev_attr.attr,
496 &sensor_dev_attr_in2_min.dev_attr.attr,
497 &sensor_dev_attr_in2_max.dev_attr.attr,
498 &sensor_dev_attr_in2_lcrit.dev_attr.attr,
499 &sensor_dev_attr_in2_crit.dev_attr.attr,
500 &sensor_dev_attr_in2_crit_alarm.dev_attr.attr,
502 &sensor_dev_attr_in3_input.dev_attr.attr,
503 &sensor_dev_attr_in3_min.dev_attr.attr,
504 &sensor_dev_attr_in3_max.dev_attr.attr,
505 &sensor_dev_attr_in3_lcrit.dev_attr.attr,
506 &sensor_dev_attr_in3_crit.dev_attr.attr,
507 &sensor_dev_attr_in3_crit_alarm.dev_attr.attr,
509 &sensor_dev_attr_in4_input.dev_attr.attr,
510 &sensor_dev_attr_in4_min.dev_attr.attr,
511 &sensor_dev_attr_in4_max.dev_attr.attr,
512 &sensor_dev_attr_in4_lcrit.dev_attr.attr,
513 &sensor_dev_attr_in4_crit.dev_attr.attr,
514 &sensor_dev_attr_in4_crit_alarm.dev_attr.attr,
516 &sensor_dev_attr_in5_input.dev_attr.attr,
517 &sensor_dev_attr_in5_min.dev_attr.attr,
518 &sensor_dev_attr_in5_max.dev_attr.attr,
519 &sensor_dev_attr_in5_lcrit.dev_attr.attr,
520 &sensor_dev_attr_in5_crit.dev_attr.attr,
521 &sensor_dev_attr_in5_crit_alarm.dev_attr.attr,
523 &sensor_dev_attr_in6_input.dev_attr.attr,
524 &sensor_dev_attr_in6_min.dev_attr.attr,
525 &sensor_dev_attr_in6_max.dev_attr.attr,
526 &sensor_dev_attr_in6_lcrit.dev_attr.attr,
527 &sensor_dev_attr_in6_crit.dev_attr.attr,
528 &sensor_dev_attr_in6_crit_alarm.dev_attr.attr,
530 &sensor_dev_attr_in7_input.dev_attr.attr,
531 &sensor_dev_attr_in7_min.dev_attr.attr,
532 &sensor_dev_attr_in7_max.dev_attr.attr,
533 &sensor_dev_attr_in7_lcrit.dev_attr.attr,
534 &sensor_dev_attr_in7_crit.dev_attr.attr,
535 &sensor_dev_attr_in7_crit_alarm.dev_attr.attr,
537 &sensor_dev_attr_in8_input.dev_attr.attr,
538 &sensor_dev_attr_in8_min.dev_attr.attr,
539 &sensor_dev_attr_in8_max.dev_attr.attr,
540 &sensor_dev_attr_in8_lcrit.dev_attr.attr,
541 &sensor_dev_attr_in8_crit.dev_attr.attr,
542 &sensor_dev_attr_in8_crit_alarm.dev_attr.attr,
544 &sensor_dev_attr_in9_input.dev_attr.attr,
545 &sensor_dev_attr_in9_min.dev_attr.attr,
546 &sensor_dev_attr_in9_max.dev_attr.attr,
547 &sensor_dev_attr_in9_lcrit.dev_attr.attr,
548 &sensor_dev_attr_in9_crit.dev_attr.attr,
549 &sensor_dev_attr_in9_crit_alarm.dev_attr.attr,
551 &sensor_dev_attr_in10_input.dev_attr.attr,
552 &sensor_dev_attr_in10_min.dev_attr.attr,
553 &sensor_dev_attr_in10_max.dev_attr.attr,
554 &sensor_dev_attr_in10_lcrit.dev_attr.attr,
555 &sensor_dev_attr_in10_crit.dev_attr.attr,
556 &sensor_dev_attr_in10_crit_alarm.dev_attr.attr,
558 &sensor_dev_attr_temp1_input.dev_attr.attr,
559 &sensor_dev_attr_temp1_min.dev_attr.attr,
560 &sensor_dev_attr_temp1_max.dev_attr.attr,
561 &sensor_dev_attr_temp1_lcrit.dev_attr.attr,
562 &sensor_dev_attr_temp1_crit.dev_attr.attr,
563 &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr,
565 NULL,
568 static const struct attribute_group smm665_group = {
569 .attrs = smm665_attributes,
572 static int smm665_probe(struct i2c_client *client,
573 const struct i2c_device_id *id)
575 struct i2c_adapter *adapter = client->adapter;
576 struct smm665_data *data;
577 int i, ret;
579 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA
580 | I2C_FUNC_SMBUS_WORD_DATA))
581 return -ENODEV;
583 if (i2c_smbus_read_byte_data(client, SMM665_ADOC_ENABLE) < 0)
584 return -ENODEV;
586 ret = -ENOMEM;
587 data = kzalloc(sizeof(*data), GFP_KERNEL);
588 if (!data)
589 goto out_return;
591 i2c_set_clientdata(client, data);
592 mutex_init(&data->update_lock);
594 data->type = id->driver_data;
595 data->cmdreg = i2c_new_dummy(adapter, (client->addr & ~SMM665_REGMASK)
596 | SMM665_CMDREG_BASE);
597 if (!data->cmdreg)
598 goto out_kfree;
600 switch (data->type) {
601 case smm465:
602 case smm665:
603 data->conversion_time = SMM665_ADC_WAIT_SMM665;
604 break;
605 case smm665c:
606 case smm764:
607 case smm766:
608 data->conversion_time = SMM665_ADC_WAIT_SMM766;
609 break;
612 ret = -ENODEV;
613 if (i2c_smbus_read_byte_data(data->cmdreg, SMM665_MISC8_CMD_STS) < 0)
614 goto out_unregister;
617 * Read limits.
619 * Limit registers start with register SMM665_LIMIT_BASE.
620 * Each channel uses 8 registers, providing four limit values
621 * per channel. Each limit value requires two registers, with the
622 * high byte in the first register and the low byte in the second
623 * register. The first two limits are under limit values, followed
624 * by two over limit values.
626 * Limit register order matches the ADC register order, so we use
627 * ADC register defines throughout the code to index limit registers.
629 * We save the first retrieved value both as "critical" and "alarm"
630 * value. The second value overwrites either the critical or the
631 * alarm value, depending on its configuration. This ensures that both
632 * critical and alarm values are initialized, even if both registers are
633 * configured as critical or non-critical.
635 for (i = 0; i < SMM665_NUM_ADC; i++) {
636 int val;
638 val = smm665_read16(client, SMM665_LIMIT_BASE + i * 8);
639 if (unlikely(val < 0))
640 goto out_unregister;
641 data->critical_min_limit[i] = data->alarm_min_limit[i]
642 = smm665_convert(val, i);
643 val = smm665_read16(client, SMM665_LIMIT_BASE + i * 8 + 2);
644 if (unlikely(val < 0))
645 goto out_unregister;
646 if (smm665_is_critical(val))
647 data->critical_min_limit[i] = smm665_convert(val, i);
648 else
649 data->alarm_min_limit[i] = smm665_convert(val, i);
650 val = smm665_read16(client, SMM665_LIMIT_BASE + i * 8 + 4);
651 if (unlikely(val < 0))
652 goto out_unregister;
653 data->critical_max_limit[i] = data->alarm_max_limit[i]
654 = smm665_convert(val, i);
655 val = smm665_read16(client, SMM665_LIMIT_BASE + i * 8 + 6);
656 if (unlikely(val < 0))
657 goto out_unregister;
658 if (smm665_is_critical(val))
659 data->critical_max_limit[i] = smm665_convert(val, i);
660 else
661 data->alarm_max_limit[i] = smm665_convert(val, i);
664 /* Register sysfs hooks */
665 ret = sysfs_create_group(&client->dev.kobj, &smm665_group);
666 if (ret)
667 goto out_unregister;
669 data->hwmon_dev = hwmon_device_register(&client->dev);
670 if (IS_ERR(data->hwmon_dev)) {
671 ret = PTR_ERR(data->hwmon_dev);
672 goto out_remove_group;
675 return 0;
677 out_remove_group:
678 sysfs_remove_group(&client->dev.kobj, &smm665_group);
679 out_unregister:
680 i2c_unregister_device(data->cmdreg);
681 out_kfree:
682 kfree(data);
683 out_return:
684 return ret;
687 static int smm665_remove(struct i2c_client *client)
689 struct smm665_data *data = i2c_get_clientdata(client);
691 i2c_unregister_device(data->cmdreg);
692 hwmon_device_unregister(data->hwmon_dev);
693 sysfs_remove_group(&client->dev.kobj, &smm665_group);
695 kfree(data);
697 return 0;
700 static const struct i2c_device_id smm665_id[] = {
701 {"smm465", smm465},
702 {"smm665", smm665},
703 {"smm665c", smm665c},
704 {"smm764", smm764},
705 {"smm766", smm766},
709 MODULE_DEVICE_TABLE(i2c, smm665_id);
711 /* This is the driver that will be inserted */
712 static struct i2c_driver smm665_driver = {
713 .driver = {
714 .name = "smm665",
716 .probe = smm665_probe,
717 .remove = smm665_remove,
718 .id_table = smm665_id,
721 static int __init smm665_init(void)
723 return i2c_add_driver(&smm665_driver);
726 static void __exit smm665_exit(void)
728 i2c_del_driver(&smm665_driver);
731 MODULE_AUTHOR("Guenter Roeck");
732 MODULE_DESCRIPTION("SMM665 driver");
733 MODULE_LICENSE("GPL");
735 module_init(smm665_init);
736 module_exit(smm665_exit);