Merge tag 'lsk-v3.10-android-14.11'
[firefly-linux-kernel-4.4.55.git] / drivers / hwmon / ads1015.c
1 /*
2  * ads1015.c - lm_sensors driver for ads1015 12-bit 4-input ADC
3  * (C) Copyright 2010
4  * Dirk Eibach, Guntermann & Drunck GmbH <eibach@gdsys.de>
5  *
6  * Based on the ads7828 driver by Steve Hardy.
7  *
8  * Datasheet available at: http://focus.ti.com/lit/ds/symlink/ads1015.pdf
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License as published by
12  * the Free Software Foundation; either version 2 of the License, or
13  * (at your option) any later version.
14  *
15  * This program is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  * GNU General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23  */
24
25 #include <linux/module.h>
26 #include <linux/init.h>
27 #include <linux/slab.h>
28 #include <linux/delay.h>
29 #include <linux/i2c.h>
30 #include <linux/hwmon.h>
31 #include <linux/hwmon-sysfs.h>
32 #include <linux/err.h>
33 #include <linux/mutex.h>
34 #include <linux/of.h>
35
36 #include <linux/i2c/ads1015.h>
37
38 /* ADS1015 registers */
39 enum {
40         ADS1015_CONVERSION = 0,
41         ADS1015_CONFIG = 1,
42 };
43
44 /* PGA fullscale voltages in mV */
45 static const unsigned int fullscale_table[8] = {
46         6144, 4096, 2048, 1024, 512, 256, 256, 256 };
47
48 /* Data rates in samples per second */
49 static const unsigned int data_rate_table[8] = {
50         128, 250, 490, 920, 1600, 2400, 3300, 3300 };
51
52 #define ADS1015_DEFAULT_CHANNELS 0xff
53 #define ADS1015_DEFAULT_PGA 2
54 #define ADS1015_DEFAULT_DATA_RATE 4
55
56 struct ads1015_data {
57         struct device *hwmon_dev;
58         struct mutex update_lock; /* mutex protect updates */
59         struct ads1015_channel_data channel_data[ADS1015_CHANNELS];
60 };
61
62 static int ads1015_read_adc(struct i2c_client *client, unsigned int channel)
63 {
64         u16 config;
65         struct ads1015_data *data = i2c_get_clientdata(client);
66         unsigned int pga = data->channel_data[channel].pga;
67         unsigned int data_rate = data->channel_data[channel].data_rate;
68         unsigned int conversion_time_ms;
69         int res;
70
71         mutex_lock(&data->update_lock);
72
73         /* get channel parameters */
74         res = i2c_smbus_read_word_swapped(client, ADS1015_CONFIG);
75         if (res < 0)
76                 goto err_unlock;
77         config = res;
78         conversion_time_ms = DIV_ROUND_UP(1000, data_rate_table[data_rate]);
79
80         /* setup and start single conversion */
81         config &= 0x001f;
82         config |= (1 << 15) | (1 << 8);
83         config |= (channel & 0x0007) << 12;
84         config |= (pga & 0x0007) << 9;
85         config |= (data_rate & 0x0007) << 5;
86
87         res = i2c_smbus_write_word_swapped(client, ADS1015_CONFIG, config);
88         if (res < 0)
89                 goto err_unlock;
90
91         /* wait until conversion finished */
92         msleep(conversion_time_ms);
93         res = i2c_smbus_read_word_swapped(client, ADS1015_CONFIG);
94         if (res < 0)
95                 goto err_unlock;
96         config = res;
97         if (!(config & (1 << 15))) {
98                 /* conversion not finished in time */
99                 res = -EIO;
100                 goto err_unlock;
101         }
102
103         res = i2c_smbus_read_word_swapped(client, ADS1015_CONVERSION);
104
105 err_unlock:
106         mutex_unlock(&data->update_lock);
107         return res;
108 }
109
110 static int ads1015_reg_to_mv(struct i2c_client *client, unsigned int channel,
111                              s16 reg)
112 {
113         struct ads1015_data *data = i2c_get_clientdata(client);
114         unsigned int pga = data->channel_data[channel].pga;
115         int fullscale = fullscale_table[pga];
116
117         return DIV_ROUND_CLOSEST(reg * fullscale, 0x7ff0);
118 }
119
120 /* sysfs callback function */
121 static ssize_t show_in(struct device *dev, struct device_attribute *da,
122         char *buf)
123 {
124         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
125         struct i2c_client *client = to_i2c_client(dev);
126         int res;
127         int index = attr->index;
128
129         res = ads1015_read_adc(client, index);
130         if (res < 0)
131                 return res;
132
133         return sprintf(buf, "%d\n", ads1015_reg_to_mv(client, index, res));
134 }
135
136 static const struct sensor_device_attribute ads1015_in[] = {
137         SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
138         SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
139         SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
140         SENSOR_ATTR(in3_input, S_IRUGO, show_in, NULL, 3),
141         SENSOR_ATTR(in4_input, S_IRUGO, show_in, NULL, 4),
142         SENSOR_ATTR(in5_input, S_IRUGO, show_in, NULL, 5),
143         SENSOR_ATTR(in6_input, S_IRUGO, show_in, NULL, 6),
144         SENSOR_ATTR(in7_input, S_IRUGO, show_in, NULL, 7),
145 };
146
147 /*
148  * Driver interface
149  */
150
151 static int ads1015_remove(struct i2c_client *client)
152 {
153         struct ads1015_data *data = i2c_get_clientdata(client);
154         int k;
155
156         hwmon_device_unregister(data->hwmon_dev);
157         for (k = 0; k < ADS1015_CHANNELS; ++k)
158                 device_remove_file(&client->dev, &ads1015_in[k].dev_attr);
159         return 0;
160 }
161
162 #ifdef CONFIG_OF
163 static int ads1015_get_channels_config_of(struct i2c_client *client)
164 {
165         struct ads1015_data *data = i2c_get_clientdata(client);
166         struct device_node *node;
167
168         if (!client->dev.of_node
169             || !of_get_next_child(client->dev.of_node, NULL))
170                 return -EINVAL;
171
172         for_each_child_of_node(client->dev.of_node, node) {
173                 const __be32 *property;
174                 int len;
175                 unsigned int channel;
176                 unsigned int pga = ADS1015_DEFAULT_PGA;
177                 unsigned int data_rate = ADS1015_DEFAULT_DATA_RATE;
178
179                 property = of_get_property(node, "reg", &len);
180                 if (!property || len != sizeof(int)) {
181                         dev_err(&client->dev, "invalid reg on %s\n",
182                                 node->full_name);
183                         continue;
184                 }
185
186                 channel = be32_to_cpup(property);
187                 if (channel >= ADS1015_CHANNELS) {
188                         dev_err(&client->dev,
189                                 "invalid channel index %d on %s\n",
190                                 channel, node->full_name);
191                         continue;
192                 }
193
194                 property = of_get_property(node, "ti,gain", &len);
195                 if (property && len == sizeof(int)) {
196                         pga = be32_to_cpup(property);
197                         if (pga > 6) {
198                                 dev_err(&client->dev,
199                                         "invalid gain on %s\n",
200                                         node->full_name);
201                                 return -EINVAL;
202                         }
203                 }
204
205                 property = of_get_property(node, "ti,datarate", &len);
206                 if (property && len == sizeof(int)) {
207                         data_rate = be32_to_cpup(property);
208                         if (data_rate > 7) {
209                                 dev_err(&client->dev,
210                                         "invalid data_rate on %s\n",
211                                         node->full_name);
212                                 return -EINVAL;
213                         }
214                 }
215
216                 data->channel_data[channel].enabled = true;
217                 data->channel_data[channel].pga = pga;
218                 data->channel_data[channel].data_rate = data_rate;
219         }
220
221         return 0;
222 }
223 #endif
224
225 static void ads1015_get_channels_config(struct i2c_client *client)
226 {
227         unsigned int k;
228         struct ads1015_data *data = i2c_get_clientdata(client);
229         struct ads1015_platform_data *pdata = dev_get_platdata(&client->dev);
230
231         /* prefer platform data */
232         if (pdata) {
233                 memcpy(data->channel_data, pdata->channel_data,
234                        sizeof(data->channel_data));
235                 return;
236         }
237
238 #ifdef CONFIG_OF
239         if (!ads1015_get_channels_config_of(client))
240                 return;
241 #endif
242
243         /* fallback on default configuration */
244         for (k = 0; k < ADS1015_CHANNELS; ++k) {
245                 data->channel_data[k].enabled = true;
246                 data->channel_data[k].pga = ADS1015_DEFAULT_PGA;
247                 data->channel_data[k].data_rate = ADS1015_DEFAULT_DATA_RATE;
248         }
249 }
250
251 static int ads1015_probe(struct i2c_client *client,
252                          const struct i2c_device_id *id)
253 {
254         struct ads1015_data *data;
255         int err;
256         unsigned int k;
257
258         data = devm_kzalloc(&client->dev, sizeof(struct ads1015_data),
259                             GFP_KERNEL);
260         if (!data)
261                 return -ENOMEM;
262
263         i2c_set_clientdata(client, data);
264         mutex_init(&data->update_lock);
265
266         /* build sysfs attribute group */
267         ads1015_get_channels_config(client);
268         for (k = 0; k < ADS1015_CHANNELS; ++k) {
269                 if (!data->channel_data[k].enabled)
270                         continue;
271                 err = device_create_file(&client->dev, &ads1015_in[k].dev_attr);
272                 if (err)
273                         goto exit_remove;
274         }
275
276         data->hwmon_dev = hwmon_device_register(&client->dev);
277         if (IS_ERR(data->hwmon_dev)) {
278                 err = PTR_ERR(data->hwmon_dev);
279                 goto exit_remove;
280         }
281
282         return 0;
283
284 exit_remove:
285         for (k = 0; k < ADS1015_CHANNELS; ++k)
286                 device_remove_file(&client->dev, &ads1015_in[k].dev_attr);
287         return err;
288 }
289
290 static const struct i2c_device_id ads1015_id[] = {
291         { "ads1015", 0 },
292         { }
293 };
294 MODULE_DEVICE_TABLE(i2c, ads1015_id);
295
296 static struct i2c_driver ads1015_driver = {
297         .driver = {
298                 .name = "ads1015",
299         },
300         .probe = ads1015_probe,
301         .remove = ads1015_remove,
302         .id_table = ads1015_id,
303 };
304
305 module_i2c_driver(ads1015_driver);
306
307 MODULE_AUTHOR("Dirk Eibach <eibach@gdsys.de>");
308 MODULE_DESCRIPTION("ADS1015 driver");
309 MODULE_LICENSE("GPL");