Commit | Line | Data |
---|---|---|
8c22a8f5 DE |
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 | ||
c0046867 DE |
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 | ||
8c22a8f5 | 52 | #define ADS1015_DEFAULT_CHANNELS 0xff |
c0046867 DE |
53 | #define ADS1015_DEFAULT_PGA 2 |
54 | #define ADS1015_DEFAULT_DATA_RATE 4 | |
8c22a8f5 DE |
55 | |
56 | struct ads1015_data { | |
57 | struct device *hwmon_dev; | |
58 | struct mutex update_lock; /* mutex protect updates */ | |
c0046867 | 59 | struct ads1015_channel_data channel_data[ADS1015_CHANNELS]; |
8c22a8f5 DE |
60 | }; |
61 | ||
1196573f | 62 | static int ads1015_read_adc(struct i2c_client *client, unsigned int channel) |
8c22a8f5 DE |
63 | { |
64 | u16 config; | |
8c22a8f5 | 65 | struct ads1015_data *data = i2c_get_clientdata(client); |
c0046867 | 66 | unsigned int pga = data->channel_data[channel].pga; |
c0046867 DE |
67 | unsigned int data_rate = data->channel_data[channel].data_rate; |
68 | unsigned int conversion_time_ms; | |
8c22a8f5 DE |
69 | int res; |
70 | ||
71 | mutex_lock(&data->update_lock); | |
72 | ||
c0046867 | 73 | /* get channel parameters */ |
90f4102c | 74 | res = i2c_smbus_read_word_swapped(client, ADS1015_CONFIG); |
8c22a8f5 DE |
75 | if (res < 0) |
76 | goto err_unlock; | |
77 | config = res; | |
c0046867 | 78 | conversion_time_ms = DIV_ROUND_UP(1000, data_rate_table[data_rate]); |
8c22a8f5 | 79 | |
c0046867 DE |
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; | |
8c22a8f5 | 86 | |
90f4102c | 87 | res = i2c_smbus_write_word_swapped(client, ADS1015_CONFIG, config); |
8c22a8f5 DE |
88 | if (res < 0) |
89 | goto err_unlock; | |
c0046867 DE |
90 | |
91 | /* wait until conversion finished */ | |
92 | msleep(conversion_time_ms); | |
90f4102c | 93 | res = i2c_smbus_read_word_swapped(client, ADS1015_CONFIG); |
c0046867 DE |
94 | if (res < 0) |
95 | goto err_unlock; | |
96 | config = res; | |
97 | if (!(config & (1 << 15))) { | |
98 | /* conversion not finished in time */ | |
8c22a8f5 DE |
99 | res = -EIO; |
100 | goto err_unlock; | |
101 | } | |
102 | ||
90f4102c | 103 | res = i2c_smbus_read_word_swapped(client, ADS1015_CONVERSION); |
8c22a8f5 DE |
104 | |
105 | err_unlock: | |
106 | mutex_unlock(&data->update_lock); | |
107 | return res; | |
108 | } | |
109 | ||
1196573f GR |
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 | ||
8c22a8f5 DE |
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); | |
8c22a8f5 | 126 | int res; |
1196573f | 127 | int index = attr->index; |
8c22a8f5 | 128 | |
1196573f GR |
129 | res = ads1015_read_adc(client, index); |
130 | if (res < 0) | |
131 | return res; | |
8c22a8f5 | 132 | |
1196573f | 133 | return sprintf(buf, "%d\n", ads1015_reg_to_mv(client, index, res)); |
8c22a8f5 DE |
134 | } |
135 | ||
fdf241a8 JD |
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), | |
8c22a8f5 DE |
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); | |
fdf241a8 JD |
154 | int k; |
155 | ||
8c22a8f5 | 156 | hwmon_device_unregister(data->hwmon_dev); |
c0046867 | 157 | for (k = 0; k < ADS1015_CHANNELS; ++k) |
fdf241a8 | 158 | device_remove_file(&client->dev, &ads1015_in[k].dev_attr); |
8c22a8f5 DE |
159 | return 0; |
160 | } | |
161 | ||
8c22a8f5 | 162 | #ifdef CONFIG_OF |
c0046867 DE |
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 | } | |
202 | } | |
203 | ||
204 | property = of_get_property(node, "ti,datarate", &len); | |
205 | if (property && len == sizeof(int)) { | |
206 | data_rate = be32_to_cpup(property); | |
207 | if (data_rate > 7) { | |
208 | dev_err(&client->dev, | |
209 | "invalid data_rate on %s\n", | |
210 | node->full_name); | |
211 | } | |
212 | } | |
213 | ||
214 | data->channel_data[channel].enabled = true; | |
215 | data->channel_data[channel].pga = pga; | |
216 | data->channel_data[channel].data_rate = data_rate; | |
217 | } | |
218 | ||
219 | return 0; | |
220 | } | |
8c22a8f5 DE |
221 | #endif |
222 | ||
c0046867 DE |
223 | static void ads1015_get_channels_config(struct i2c_client *client) |
224 | { | |
225 | unsigned int k; | |
226 | struct ads1015_data *data = i2c_get_clientdata(client); | |
227 | struct ads1015_platform_data *pdata = dev_get_platdata(&client->dev); | |
228 | ||
8c22a8f5 | 229 | /* prefer platform data */ |
c0046867 DE |
230 | if (pdata) { |
231 | memcpy(data->channel_data, pdata->channel_data, | |
232 | sizeof(data->channel_data)); | |
233 | return; | |
234 | } | |
8c22a8f5 DE |
235 | |
236 | #ifdef CONFIG_OF | |
c0046867 DE |
237 | if (!ads1015_get_channels_config_of(client)) |
238 | return; | |
8c22a8f5 DE |
239 | #endif |
240 | ||
241 | /* fallback on default configuration */ | |
c0046867 DE |
242 | for (k = 0; k < ADS1015_CHANNELS; ++k) { |
243 | data->channel_data[k].enabled = true; | |
244 | data->channel_data[k].pga = ADS1015_DEFAULT_PGA; | |
245 | data->channel_data[k].data_rate = ADS1015_DEFAULT_DATA_RATE; | |
246 | } | |
8c22a8f5 DE |
247 | } |
248 | ||
249 | static int ads1015_probe(struct i2c_client *client, | |
250 | const struct i2c_device_id *id) | |
251 | { | |
252 | struct ads1015_data *data; | |
253 | int err; | |
8c22a8f5 | 254 | unsigned int k; |
8c22a8f5 | 255 | |
57457e31 GR |
256 | data = devm_kzalloc(&client->dev, sizeof(struct ads1015_data), |
257 | GFP_KERNEL); | |
258 | if (!data) | |
259 | return -ENOMEM; | |
8c22a8f5 DE |
260 | |
261 | i2c_set_clientdata(client, data); | |
262 | mutex_init(&data->update_lock); | |
263 | ||
264 | /* build sysfs attribute group */ | |
c0046867 DE |
265 | ads1015_get_channels_config(client); |
266 | for (k = 0; k < ADS1015_CHANNELS; ++k) { | |
267 | if (!data->channel_data[k].enabled) | |
8c22a8f5 | 268 | continue; |
fdf241a8 JD |
269 | err = device_create_file(&client->dev, &ads1015_in[k].dev_attr); |
270 | if (err) | |
363434b5 | 271 | goto exit_remove; |
8c22a8f5 | 272 | } |
8c22a8f5 DE |
273 | |
274 | data->hwmon_dev = hwmon_device_register(&client->dev); | |
275 | if (IS_ERR(data->hwmon_dev)) { | |
276 | err = PTR_ERR(data->hwmon_dev); | |
277 | goto exit_remove; | |
278 | } | |
279 | ||
280 | return 0; | |
281 | ||
282 | exit_remove: | |
c0046867 | 283 | for (k = 0; k < ADS1015_CHANNELS; ++k) |
fdf241a8 | 284 | device_remove_file(&client->dev, &ads1015_in[k].dev_attr); |
8c22a8f5 DE |
285 | return err; |
286 | } | |
287 | ||
288 | static const struct i2c_device_id ads1015_id[] = { | |
289 | { "ads1015", 0 }, | |
290 | { } | |
291 | }; | |
292 | MODULE_DEVICE_TABLE(i2c, ads1015_id); | |
293 | ||
294 | static struct i2c_driver ads1015_driver = { | |
295 | .driver = { | |
296 | .name = "ads1015", | |
297 | }, | |
298 | .probe = ads1015_probe, | |
299 | .remove = ads1015_remove, | |
300 | .id_table = ads1015_id, | |
301 | }; | |
302 | ||
f0967eea | 303 | module_i2c_driver(ads1015_driver); |
8c22a8f5 DE |
304 | |
305 | MODULE_AUTHOR("Dirk Eibach <eibach@gdsys.de>"); | |
306 | MODULE_DESCRIPTION("ADS1015 driver"); | |
307 | MODULE_LICENSE("GPL"); |