1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/module.h>
23#include <linux/slab.h>
24#include <linux/i2c.h>
25#include <linux/mutex.h>
26
27#define TSL2550_DRV_NAME "tsl2550"
28#define DRIVER_VERSION "1.2"
29
30
31
32
33
34#define TSL2550_POWER_DOWN 0x00
35#define TSL2550_POWER_UP 0x03
36#define TSL2550_STANDARD_RANGE 0x18
37#define TSL2550_EXTENDED_RANGE 0x1d
38#define TSL2550_READ_ADC0 0x43
39#define TSL2550_READ_ADC1 0x83
40
41
42
43
44
45struct tsl2550_data {
46 struct i2c_client *client;
47 struct mutex update_lock;
48
49 unsigned int power_state:1;
50 unsigned int operating_mode:1;
51};
52
53
54
55
56
57static const u8 TSL2550_MODE_RANGE[2] = {
58 TSL2550_STANDARD_RANGE, TSL2550_EXTENDED_RANGE,
59};
60
61
62
63
64
65static int tsl2550_set_operating_mode(struct i2c_client *client, int mode)
66{
67 struct tsl2550_data *data = i2c_get_clientdata(client);
68
69 int ret = i2c_smbus_write_byte(client, TSL2550_MODE_RANGE[mode]);
70
71 data->operating_mode = mode;
72
73 return ret;
74}
75
76static int tsl2550_set_power_state(struct i2c_client *client, int state)
77{
78 struct tsl2550_data *data = i2c_get_clientdata(client);
79 int ret;
80
81 if (state == 0)
82 ret = i2c_smbus_write_byte(client, TSL2550_POWER_DOWN);
83 else {
84 ret = i2c_smbus_write_byte(client, TSL2550_POWER_UP);
85
86
87 tsl2550_set_operating_mode(client, data->operating_mode);
88 }
89
90 data->power_state = state;
91
92 return ret;
93}
94
95static int tsl2550_get_adc_value(struct i2c_client *client, u8 cmd)
96{
97 int ret;
98
99 ret = i2c_smbus_read_byte_data(client, cmd);
100 if (ret < 0)
101 return ret;
102 if (!(ret & 0x80))
103 return -EAGAIN;
104 return ret & 0x7f;
105}
106
107
108
109
110
111#define TSL2550_MAX_LUX 1846
112
113static const u8 ratio_lut[] = {
114 100, 100, 100, 100, 100, 100, 100, 100,
115 100, 100, 100, 100, 100, 100, 99, 99,
116 99, 99, 99, 99, 99, 99, 99, 99,
117 99, 99, 99, 98, 98, 98, 98, 98,
118 98, 98, 97, 97, 97, 97, 97, 96,
119 96, 96, 96, 95, 95, 95, 94, 94,
120 93, 93, 93, 92, 92, 91, 91, 90,
121 89, 89, 88, 87, 87, 86, 85, 84,
122 83, 82, 81, 80, 79, 78, 77, 75,
123 74, 73, 71, 69, 68, 66, 64, 62,
124 60, 58, 56, 54, 52, 49, 47, 44,
125 42, 41, 40, 40, 39, 39, 38, 38,
126 37, 37, 37, 36, 36, 36, 35, 35,
127 35, 35, 34, 34, 34, 34, 33, 33,
128 33, 33, 32, 32, 32, 32, 32, 31,
129 31, 31, 31, 31, 30, 30, 30, 30,
130 30,
131};
132
133static const u16 count_lut[] = {
134 0, 1, 2, 3, 4, 5, 6, 7,
135 8, 9, 10, 11, 12, 13, 14, 15,
136 16, 18, 20, 22, 24, 26, 28, 30,
137 32, 34, 36, 38, 40, 42, 44, 46,
138 49, 53, 57, 61, 65, 69, 73, 77,
139 81, 85, 89, 93, 97, 101, 105, 109,
140 115, 123, 131, 139, 147, 155, 163, 171,
141 179, 187, 195, 203, 211, 219, 227, 235,
142 247, 263, 279, 295, 311, 327, 343, 359,
143 375, 391, 407, 423, 439, 455, 471, 487,
144 511, 543, 575, 607, 639, 671, 703, 735,
145 767, 799, 831, 863, 895, 927, 959, 991,
146 1039, 1103, 1167, 1231, 1295, 1359, 1423, 1487,
147 1551, 1615, 1679, 1743, 1807, 1871, 1935, 1999,
148 2095, 2223, 2351, 2479, 2607, 2735, 2863, 2991,
149 3119, 3247, 3375, 3503, 3631, 3759, 3887, 4015,
150};
151
152
153
154
155
156static int tsl2550_calculate_lux(u8 ch0, u8 ch1)
157{
158 unsigned int lux;
159
160
161 u16 c0 = count_lut[ch0];
162 u16 c1 = count_lut[ch1];
163
164
165
166
167
168 u8 r = 128;
169
170
171 if (c1 <= c0)
172 if (c0) {
173 r = c1 * 128 / c0;
174
175
176 lux = ((c0 - c1) * ratio_lut[r]) / 256;
177 } else
178 lux = 0;
179 else
180 return -EAGAIN;
181
182
183 return lux > TSL2550_MAX_LUX ? TSL2550_MAX_LUX : lux;
184}
185
186
187
188
189
190static ssize_t tsl2550_show_power_state(struct device *dev,
191 struct device_attribute *attr, char *buf)
192{
193 struct tsl2550_data *data = i2c_get_clientdata(to_i2c_client(dev));
194
195 return sprintf(buf, "%u\n", data->power_state);
196}
197
198static ssize_t tsl2550_store_power_state(struct device *dev,
199 struct device_attribute *attr, const char *buf, size_t count)
200{
201 struct i2c_client *client = to_i2c_client(dev);
202 struct tsl2550_data *data = i2c_get_clientdata(client);
203 unsigned long val = simple_strtoul(buf, NULL, 10);
204 int ret;
205
206 if (val > 1)
207 return -EINVAL;
208
209 mutex_lock(&data->update_lock);
210 ret = tsl2550_set_power_state(client, val);
211 mutex_unlock(&data->update_lock);
212
213 if (ret < 0)
214 return ret;
215
216 return count;
217}
218
219static DEVICE_ATTR(power_state, S_IWUSR | S_IRUGO,
220 tsl2550_show_power_state, tsl2550_store_power_state);
221
222static ssize_t tsl2550_show_operating_mode(struct device *dev,
223 struct device_attribute *attr, char *buf)
224{
225 struct tsl2550_data *data = i2c_get_clientdata(to_i2c_client(dev));
226
227 return sprintf(buf, "%u\n", data->operating_mode);
228}
229
230static ssize_t tsl2550_store_operating_mode(struct device *dev,
231 struct device_attribute *attr, const char *buf, size_t count)
232{
233 struct i2c_client *client = to_i2c_client(dev);
234 struct tsl2550_data *data = i2c_get_clientdata(client);
235 unsigned long val = simple_strtoul(buf, NULL, 10);
236 int ret;
237
238 if (val > 1)
239 return -EINVAL;
240
241 if (data->power_state == 0)
242 return -EBUSY;
243
244 mutex_lock(&data->update_lock);
245 ret = tsl2550_set_operating_mode(client, val);
246 mutex_unlock(&data->update_lock);
247
248 if (ret < 0)
249 return ret;
250
251 return count;
252}
253
254static DEVICE_ATTR(operating_mode, S_IWUSR | S_IRUGO,
255 tsl2550_show_operating_mode, tsl2550_store_operating_mode);
256
257static ssize_t __tsl2550_show_lux(struct i2c_client *client, char *buf)
258{
259 struct tsl2550_data *data = i2c_get_clientdata(client);
260 u8 ch0, ch1;
261 int ret;
262
263 ret = tsl2550_get_adc_value(client, TSL2550_READ_ADC0);
264 if (ret < 0)
265 return ret;
266 ch0 = ret;
267
268 ret = tsl2550_get_adc_value(client, TSL2550_READ_ADC1);
269 if (ret < 0)
270 return ret;
271 ch1 = ret;
272
273
274 ret = tsl2550_calculate_lux(ch0, ch1);
275 if (ret < 0)
276 return ret;
277 if (data->operating_mode == 1)
278 ret *= 5;
279
280 return sprintf(buf, "%d\n", ret);
281}
282
283static ssize_t tsl2550_show_lux1_input(struct device *dev,
284 struct device_attribute *attr, char *buf)
285{
286 struct i2c_client *client = to_i2c_client(dev);
287 struct tsl2550_data *data = i2c_get_clientdata(client);
288 int ret;
289
290
291 if (!data->power_state)
292 return -EBUSY;
293
294 mutex_lock(&data->update_lock);
295 ret = __tsl2550_show_lux(client, buf);
296 mutex_unlock(&data->update_lock);
297
298 return ret;
299}
300
301static DEVICE_ATTR(lux1_input, S_IRUGO,
302 tsl2550_show_lux1_input, NULL);
303
304static struct attribute *tsl2550_attributes[] = {
305 &dev_attr_power_state.attr,
306 &dev_attr_operating_mode.attr,
307 &dev_attr_lux1_input.attr,
308 NULL
309};
310
311static const struct attribute_group tsl2550_attr_group = {
312 .attrs = tsl2550_attributes,
313};
314
315
316
317
318
319static int tsl2550_init_client(struct i2c_client *client)
320{
321 struct tsl2550_data *data = i2c_get_clientdata(client);
322 int err;
323
324
325
326
327
328 err = i2c_smbus_read_byte_data(client, TSL2550_POWER_UP);
329 if (err < 0)
330 return err;
331 if (err != TSL2550_POWER_UP)
332 return -ENODEV;
333 data->power_state = 1;
334
335
336 err = i2c_smbus_write_byte(client,
337 TSL2550_MODE_RANGE[data->operating_mode]);
338 if (err < 0)
339 return err;
340
341 return 0;
342}
343
344
345
346
347
348static struct i2c_driver tsl2550_driver;
349static int tsl2550_probe(struct i2c_client *client,
350 const struct i2c_device_id *id)
351{
352 struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
353 struct tsl2550_data *data;
354 int *opmode, err = 0;
355
356 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WRITE_BYTE
357 | I2C_FUNC_SMBUS_READ_BYTE_DATA)) {
358 err = -EIO;
359 goto exit;
360 }
361
362 data = kzalloc(sizeof(struct tsl2550_data), GFP_KERNEL);
363 if (!data) {
364 err = -ENOMEM;
365 goto exit;
366 }
367 data->client = client;
368 i2c_set_clientdata(client, data);
369
370
371 opmode = client->dev.platform_data;
372 if (opmode) {
373 if (*opmode < 0 || *opmode > 1) {
374 dev_err(&client->dev, "invalid operating_mode (%d)\n",
375 *opmode);
376 err = -EINVAL;
377 goto exit_kfree;
378 }
379 data->operating_mode = *opmode;
380 } else
381 data->operating_mode = 0;
382 dev_info(&client->dev, "%s operating mode\n",
383 data->operating_mode ? "extended" : "standard");
384
385 mutex_init(&data->update_lock);
386
387
388 err = tsl2550_init_client(client);
389 if (err)
390 goto exit_kfree;
391
392
393 err = sysfs_create_group(&client->dev.kobj, &tsl2550_attr_group);
394 if (err)
395 goto exit_kfree;
396
397 dev_info(&client->dev, "support ver. %s enabled\n", DRIVER_VERSION);
398
399 return 0;
400
401exit_kfree:
402 kfree(data);
403exit:
404 return err;
405}
406
407static int tsl2550_remove(struct i2c_client *client)
408{
409 sysfs_remove_group(&client->dev.kobj, &tsl2550_attr_group);
410
411
412 tsl2550_set_power_state(client, 0);
413
414 kfree(i2c_get_clientdata(client));
415
416 return 0;
417}
418
419#ifdef CONFIG_PM_SLEEP
420
421static int tsl2550_suspend(struct device *dev)
422{
423 return tsl2550_set_power_state(to_i2c_client(dev), 0);
424}
425
426static int tsl2550_resume(struct device *dev)
427{
428 return tsl2550_set_power_state(to_i2c_client(dev), 1);
429}
430
431static SIMPLE_DEV_PM_OPS(tsl2550_pm_ops, tsl2550_suspend, tsl2550_resume);
432#define TSL2550_PM_OPS (&tsl2550_pm_ops)
433
434#else
435
436#define TSL2550_PM_OPS NULL
437
438#endif
439
440static const struct i2c_device_id tsl2550_id[] = {
441 { "tsl2550", 0 },
442 { }
443};
444MODULE_DEVICE_TABLE(i2c, tsl2550_id);
445
446static struct i2c_driver tsl2550_driver = {
447 .driver = {
448 .name = TSL2550_DRV_NAME,
449 .pm = TSL2550_PM_OPS,
450 },
451 .probe = tsl2550_probe,
452 .remove = tsl2550_remove,
453 .id_table = tsl2550_id,
454};
455
456module_i2c_driver(tsl2550_driver);
457
458MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>");
459MODULE_DESCRIPTION("TSL2550 ambient light sensor driver");
460MODULE_LICENSE("GPL");
461MODULE_VERSION(DRIVER_VERSION);
462