1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/module.h>
27#include <linux/init.h>
28#include <linux/slab.h>
29#include <linux/jiffies.h>
30#include <linux/i2c.h>
31#include <linux/hwmon.h>
32#include <linux/hwmon-sysfs.h>
33#include <linux/err.h>
34#include <linux/mutex.h>
35
36
37#define ADS7828_NCH 8
38#define ADS7828_CMD_SD_SE 0x80
39#define ADS7828_CMD_SD_DIFF 0x00
40#define ADS7828_CMD_PD0 0x0
41#define ADS7828_CMD_PD1 0x04
42#define ADS7828_CMD_PD2 0x08
43#define ADS7828_CMD_PD3 0x0C
44#define ADS7828_INT_VREF_MV 2500
45
46
47static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b,
48 I2C_CLIENT_END };
49
50
51I2C_CLIENT_INSMOD_1(ads7828);
52
53
54static int se_input = 1;
55static int int_vref = 1;
56static int vref_mv = ADS7828_INT_VREF_MV;
57module_param(se_input, bool, S_IRUGO);
58module_param(int_vref, bool, S_IRUGO);
59module_param(vref_mv, int, S_IRUGO);
60
61
62static u8 ads7828_cmd_byte;
63static unsigned int ads7828_lsb_resol;
64
65
66struct ads7828_data {
67 struct device *hwmon_dev;
68 struct mutex update_lock;
69 char valid;
70 unsigned long last_updated;
71 u16 adc_input[ADS7828_NCH];
72};
73
74
75static int ads7828_detect(struct i2c_client *client, int kind,
76 struct i2c_board_info *info);
77static int ads7828_probe(struct i2c_client *client,
78 const struct i2c_device_id *id);
79
80
81
82static u16 ads7828_read_value(struct i2c_client *client, u8 reg)
83{
84 return swab16(i2c_smbus_read_word_data(client, reg));
85}
86
87static inline u8 channel_cmd_byte(int ch)
88{
89
90 u8 cmd = (((ch>>1) | (ch&0x01)<<2)<<4);
91 cmd |= ads7828_cmd_byte;
92 return cmd;
93}
94
95
96static struct ads7828_data *ads7828_update_device(struct device *dev)
97{
98 struct i2c_client *client = to_i2c_client(dev);
99 struct ads7828_data *data = i2c_get_clientdata(client);
100
101 mutex_lock(&data->update_lock);
102
103 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
104 || !data->valid) {
105 unsigned int ch;
106 dev_dbg(&client->dev, "Starting ads7828 update\n");
107
108 for (ch = 0; ch < ADS7828_NCH; ch++) {
109 u8 cmd = channel_cmd_byte(ch);
110 data->adc_input[ch] = ads7828_read_value(client, cmd);
111 }
112 data->last_updated = jiffies;
113 data->valid = 1;
114 }
115
116 mutex_unlock(&data->update_lock);
117
118 return data;
119}
120
121
122static ssize_t show_in(struct device *dev, struct device_attribute *da,
123 char *buf)
124{
125 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
126 struct ads7828_data *data = ads7828_update_device(dev);
127
128 return sprintf(buf, "%d\n", (data->adc_input[attr->index] *
129 ads7828_lsb_resol)/1000);
130}
131
132#define in_reg(offset)\
133static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, show_in,\
134 NULL, offset)
135
136in_reg(0);
137in_reg(1);
138in_reg(2);
139in_reg(3);
140in_reg(4);
141in_reg(5);
142in_reg(6);
143in_reg(7);
144
145static struct attribute *ads7828_attributes[] = {
146 &sensor_dev_attr_in0_input.dev_attr.attr,
147 &sensor_dev_attr_in1_input.dev_attr.attr,
148 &sensor_dev_attr_in2_input.dev_attr.attr,
149 &sensor_dev_attr_in3_input.dev_attr.attr,
150 &sensor_dev_attr_in4_input.dev_attr.attr,
151 &sensor_dev_attr_in5_input.dev_attr.attr,
152 &sensor_dev_attr_in6_input.dev_attr.attr,
153 &sensor_dev_attr_in7_input.dev_attr.attr,
154 NULL
155};
156
157static const struct attribute_group ads7828_group = {
158 .attrs = ads7828_attributes,
159};
160
161static int ads7828_remove(struct i2c_client *client)
162{
163 struct ads7828_data *data = i2c_get_clientdata(client);
164 hwmon_device_unregister(data->hwmon_dev);
165 sysfs_remove_group(&client->dev.kobj, &ads7828_group);
166 kfree(i2c_get_clientdata(client));
167 return 0;
168}
169
170static const struct i2c_device_id ads7828_id[] = {
171 { "ads7828", ads7828 },
172 { }
173};
174MODULE_DEVICE_TABLE(i2c, ads7828_id);
175
176
177static struct i2c_driver ads7828_driver = {
178 .class = I2C_CLASS_HWMON,
179 .driver = {
180 .name = "ads7828",
181 },
182 .probe = ads7828_probe,
183 .remove = ads7828_remove,
184 .id_table = ads7828_id,
185 .detect = ads7828_detect,
186 .address_data = &addr_data,
187};
188
189
190static int ads7828_detect(struct i2c_client *client, int kind,
191 struct i2c_board_info *info)
192{
193 struct i2c_adapter *adapter = client->adapter;
194
195
196 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_READ_WORD_DATA))
197 return -ENODEV;
198
199
200
201
202
203
204
205 if (kind < 0) {
206 int ch;
207 for (ch = 0; ch < ADS7828_NCH; ch++) {
208 u16 in_data;
209 u8 cmd = channel_cmd_byte(ch);
210 in_data = ads7828_read_value(client, cmd);
211 if (in_data & 0xF000) {
212 printk(KERN_DEBUG
213 "%s : Doesn't look like an ads7828 device\n",
214 __func__);
215 return -ENODEV;
216 }
217 }
218 }
219 strlcpy(info->type, "ads7828", I2C_NAME_SIZE);
220
221 return 0;
222}
223
224static int ads7828_probe(struct i2c_client *client,
225 const struct i2c_device_id *id)
226{
227 struct ads7828_data *data;
228 int err;
229
230 data = kzalloc(sizeof(struct ads7828_data), GFP_KERNEL);
231 if (!data) {
232 err = -ENOMEM;
233 goto exit;
234 }
235
236 i2c_set_clientdata(client, data);
237 mutex_init(&data->update_lock);
238
239
240 err = sysfs_create_group(&client->dev.kobj, &ads7828_group);
241 if (err)
242 goto exit_free;
243
244 data->hwmon_dev = hwmon_device_register(&client->dev);
245 if (IS_ERR(data->hwmon_dev)) {
246 err = PTR_ERR(data->hwmon_dev);
247 goto exit_remove;
248 }
249
250 return 0;
251
252exit_remove:
253 sysfs_remove_group(&client->dev.kobj, &ads7828_group);
254exit_free:
255 kfree(data);
256exit:
257 return err;
258}
259
260static int __init sensors_ads7828_init(void)
261{
262
263 ads7828_cmd_byte = se_input ?
264 ADS7828_CMD_SD_SE : ADS7828_CMD_SD_DIFF;
265 ads7828_cmd_byte |= int_vref ?
266 ADS7828_CMD_PD3 : ADS7828_CMD_PD1;
267
268
269 ads7828_lsb_resol = (vref_mv*1000)/4096;
270
271 return i2c_add_driver(&ads7828_driver);
272}
273
274static void __exit sensors_ads7828_exit(void)
275{
276 i2c_del_driver(&ads7828_driver);
277}
278
279MODULE_AUTHOR("Steve Hardy <steve@linuxrealtime.co.uk>");
280MODULE_DESCRIPTION("ADS7828 driver");
281MODULE_LICENSE("GPL");
282
283module_init(sensors_ads7828_init);
284module_exit(sensors_ads7828_exit);
285