Staging: iio: adt7316: Add an extra check for 'ret' equals to 0
[linux-2.6-microblaze.git] / drivers / staging / iio / addac / adt7316-i2c.c
1 /*
2  * I2C bus driver for ADT7316/7/8 ADT7516/7/9 digital temperature
3  * sensor, ADC and DAC
4  *
5  * Copyright 2010 Analog Devices Inc.
6  *
7  * Licensed under the GPL-2 or later.
8  */
9
10 #include <linux/device.h>
11 #include <linux/kernel.h>
12 #include <linux/i2c.h>
13 #include <linux/interrupt.h>
14 #include <linux/module.h>
15
16 #include "adt7316.h"
17
18 /*
19  * adt7316 register access by I2C
20  */
21 static int adt7316_i2c_read(void *client, u8 reg, u8 *data)
22 {
23         struct i2c_client *cl = client;
24         int ret;
25
26         ret = i2c_smbus_write_byte(cl, reg);
27         if (ret < 0) {
28                 dev_err(&cl->dev, "I2C fail to select reg\n");
29                 return ret;
30         }
31
32         ret = i2c_smbus_read_byte(client);
33
34         if (!ret)
35                 return -EIO;
36
37         if (ret < 0) {
38                 dev_err(&cl->dev, "I2C read error\n");
39                 return ret;
40         }
41
42         *data = ret;
43
44         return 0;
45 }
46
47 static int adt7316_i2c_write(void *client, u8 reg, u8 data)
48 {
49         struct i2c_client *cl = client;
50         int ret = 0;
51
52         ret = i2c_smbus_write_byte_data(cl, reg, data);
53         if (ret < 0)
54                 dev_err(&cl->dev, "I2C write error\n");
55
56         return ret;
57 }
58
59 static int adt7316_i2c_multi_read(void *client, u8 reg, u8 count, u8 *data)
60 {
61         struct i2c_client *cl = client;
62         int i, ret = 0;
63
64         if (count > ADT7316_REG_MAX_ADDR)
65                 count = ADT7316_REG_MAX_ADDR;
66
67         for (i = 0; i < count; i++) {
68                 ret = adt7316_i2c_read(cl, reg, &data[i]);
69                 if (ret < 0) {
70                         dev_err(&cl->dev, "I2C multi read error\n");
71                         return ret;
72                 }
73         }
74
75         return 0;
76 }
77
78 static int adt7316_i2c_multi_write(void *client, u8 reg, u8 count, u8 *data)
79 {
80         struct i2c_client *cl = client;
81         int i, ret = 0;
82
83         if (count > ADT7316_REG_MAX_ADDR)
84                 count = ADT7316_REG_MAX_ADDR;
85
86         for (i = 0; i < count; i++) {
87                 ret = adt7316_i2c_write(cl, reg, data[i]);
88                 if (ret < 0) {
89                         dev_err(&cl->dev, "I2C multi write error\n");
90                         return ret;
91                 }
92         }
93
94         return 0;
95 }
96
97 /*
98  * device probe and remove
99  */
100
101 static int adt7316_i2c_probe(struct i2c_client *client,
102                              const struct i2c_device_id *id)
103 {
104         struct adt7316_bus bus = {
105                 .client = client,
106                 .irq = client->irq,
107                 .irq_flags = IRQF_TRIGGER_LOW,
108                 .read = adt7316_i2c_read,
109                 .write = adt7316_i2c_write,
110                 .multi_read = adt7316_i2c_multi_read,
111                 .multi_write = adt7316_i2c_multi_write,
112         };
113
114         return adt7316_probe(&client->dev, &bus, id->name);
115 }
116
117 static const struct i2c_device_id adt7316_i2c_id[] = {
118         { "adt7316", 0 },
119         { "adt7317", 0 },
120         { "adt7318", 0 },
121         { "adt7516", 0 },
122         { "adt7517", 0 },
123         { "adt7519", 0 },
124         { }
125 };
126
127 MODULE_DEVICE_TABLE(i2c, adt7316_i2c_id);
128
129 static struct i2c_driver adt7316_driver = {
130         .driver = {
131                 .name = "adt7316",
132                 .pm = ADT7316_PM_OPS,
133         },
134         .probe = adt7316_i2c_probe,
135         .id_table = adt7316_i2c_id,
136 };
137 module_i2c_driver(adt7316_driver);
138
139 MODULE_AUTHOR("Sonic Zhang <sonic.zhang@analog.com>");
140 MODULE_DESCRIPTION("I2C bus driver for Analog Devices ADT7316/7/9 and ADT7516/7/8 digital temperature sensor, ADC and DAC");
141 MODULE_LICENSE("GPL v2");