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
51static bool se_input = 1;
52static bool int_vref = 1;
53static int vref_mv = ADS7828_INT_VREF_MV;
54module_param(se_input, bool, S_IRUGO);
55module_param(int_vref, bool, S_IRUGO);
56module_param(vref_mv, int, S_IRUGO);
57
58
59static u8 ads7828_cmd_byte;
60static unsigned int ads7828_lsb_resol;
61
62
63struct ads7828_data {
64 struct device *hwmon_dev;
65 struct mutex update_lock;
66 char valid;
67 unsigned long last_updated;
68 u16 adc_input[ADS7828_NCH];
69};
70
71
72static int ads7828_detect(struct i2c_client *client,
73 struct i2c_board_info *info);
74static int ads7828_probe(struct i2c_client *client,
75 const struct i2c_device_id *id);
76
77static inline u8 channel_cmd_byte(int ch)
78{
79
80 u8 cmd = (((ch>>1) | (ch&0x01)<<2)<<4);
81 cmd |= ads7828_cmd_byte;
82 return cmd;
83}
84
85
86static struct ads7828_data *ads7828_update_device(struct device *dev)
87{
88 struct i2c_client *client = to_i2c_client(dev);
89 struct ads7828_data *data = i2c_get_clientdata(client);
90
91 mutex_lock(&data->update_lock);
92
93 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
94 || !data->valid) {
95 unsigned int ch;
96 dev_dbg(&client->dev, "Starting ads7828 update\n");
97
98 for (ch = 0; ch < ADS7828_NCH; ch++) {
99 u8 cmd = channel_cmd_byte(ch);
100 data->adc_input[ch] =
101 i2c_smbus_read_word_swapped(client, cmd);
102 }
103 data->last_updated = jiffies;
104 data->valid = 1;
105 }
106
107 mutex_unlock(&data->update_lock);
108
109 return data;
110}
111
112
113static ssize_t show_in(struct device *dev, struct device_attribute *da,
114 char *buf)
115{
116 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
117 struct ads7828_data *data = ads7828_update_device(dev);
118
119 return sprintf(buf, "%d\n", (data->adc_input[attr->index] *
120 ads7828_lsb_resol)/1000);
121}
122
123#define in_reg(offset)\
124static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, show_in,\
125 NULL, offset)
126
127in_reg(0);
128in_reg(1);
129in_reg(2);
130in_reg(3);
131in_reg(4);
132in_reg(5);
133in_reg(6);
134in_reg(7);
135
136static struct attribute *ads7828_attributes[] = {
137 &sensor_dev_attr_in0_input.dev_attr.attr,
138 &sensor_dev_attr_in1_input.dev_attr.attr,
139 &sensor_dev_attr_in2_input.dev_attr.attr,
140 &sensor_dev_attr_in3_input.dev_attr.attr,
141 &sensor_dev_attr_in4_input.dev_attr.attr,
142 &sensor_dev_attr_in5_input.dev_attr.attr,
143 &sensor_dev_attr_in6_input.dev_attr.attr,
144 &sensor_dev_attr_in7_input.dev_attr.attr,
145 NULL
146};
147
148static const struct attribute_group ads7828_group = {
149 .attrs = ads7828_attributes,
150};
151
152static int ads7828_remove(struct i2c_client *client)
153{
154 struct ads7828_data *data = i2c_get_clientdata(client);
155 hwmon_device_unregister(data->hwmon_dev);
156 sysfs_remove_group(&client->dev.kobj, &ads7828_group);
157 return 0;
158}
159
160static const struct i2c_device_id ads7828_id[] = {
161 { "ads7828", 0 },
162 { }
163};
164MODULE_DEVICE_TABLE(i2c, ads7828_id);
165
166
167static struct i2c_driver ads7828_driver = {
168 .class = I2C_CLASS_HWMON,
169 .driver = {
170 .name = "ads7828",
171 },
172 .probe = ads7828_probe,
173 .remove = ads7828_remove,
174 .id_table = ads7828_id,
175 .detect = ads7828_detect,
176 .address_list = normal_i2c,
177};
178
179
180static int ads7828_detect(struct i2c_client *client,
181 struct i2c_board_info *info)
182{
183 struct i2c_adapter *adapter = client->adapter;
184 int ch;
185
186
187 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_READ_WORD_DATA))
188 return -ENODEV;
189
190
191
192
193
194
195
196
197 for (ch = 0; ch < ADS7828_NCH; ch++) {
198 u16 in_data;
199 u8 cmd = channel_cmd_byte(ch);
200 in_data = i2c_smbus_read_word_swapped(client, cmd);
201 if (in_data & 0xF000) {
202 pr_debug("%s : Doesn't look like an ads7828 device\n",
203 __func__);
204 return -ENODEV;
205 }
206 }
207
208 strlcpy(info->type, "ads7828", I2C_NAME_SIZE);
209
210 return 0;
211}
212
213static int ads7828_probe(struct i2c_client *client,
214 const struct i2c_device_id *id)
215{
216 struct ads7828_data *data;
217 int err;
218
219 data = devm_kzalloc(&client->dev, sizeof(struct ads7828_data),
220 GFP_KERNEL);
221 if (!data)
222 return -ENOMEM;
223
224 i2c_set_clientdata(client, data);
225 mutex_init(&data->update_lock);
226
227
228 err = sysfs_create_group(&client->dev.kobj, &ads7828_group);
229 if (err)
230 return err;
231
232 data->hwmon_dev = hwmon_device_register(&client->dev);
233 if (IS_ERR(data->hwmon_dev)) {
234 err = PTR_ERR(data->hwmon_dev);
235 goto exit_remove;
236 }
237
238 return 0;
239
240exit_remove:
241 sysfs_remove_group(&client->dev.kobj, &ads7828_group);
242 return err;
243}
244
245static int __init sensors_ads7828_init(void)
246{
247
248 ads7828_cmd_byte = se_input ?
249 ADS7828_CMD_SD_SE : ADS7828_CMD_SD_DIFF;
250 ads7828_cmd_byte |= int_vref ?
251 ADS7828_CMD_PD3 : ADS7828_CMD_PD1;
252
253
254 ads7828_lsb_resol = (vref_mv*1000)/4096;
255
256 return i2c_add_driver(&ads7828_driver);
257}
258
259static void __exit sensors_ads7828_exit(void)
260{
261 i2c_del_driver(&ads7828_driver);
262}
263
264MODULE_AUTHOR("Steve Hardy <shardy@redhat.com>");
265MODULE_DESCRIPTION("ADS7828 driver");
266MODULE_LICENSE("GPL");
267
268module_init(sensors_ads7828_init);
269module_exit(sensors_ads7828_exit);
270