?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge branch 'upstream' of git://git.linux-mips.org/pub/scm/upstream-linus
[linux-btrfs-devel.git] / drivers / staging / iio / light / tsl2563.c
blobf25243b08472d89188736f52f2f93725609e7c7f
1 /*
2 * drivers/i2c/chips/tsl2563.c
3 *
4 * Copyright (C) 2008 Nokia Corporation
5 *
6 * Written by Timo O. Karjalainen <timo.o.karjalainen@nokia.com>
7 * Contact: Amit Kucheria <amit.kucheria@verdurent.com>
8 *
9 * Converted to IIO driver
10 * Amit Kucheria <amit.kucheria@verdurent.com>
11 *
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * version 2 as published by the Free Software Foundation.
15 *
16 * This program is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
19 * General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
24 * 02110-1301 USA
25 */
26
27 #include <linux/module.h>
28 #include <linux/i2c.h>
29 #include <linux/interrupt.h>
30 #include <linux/irq.h>
31 #include <linux/sched.h>
32 #include <linux/mutex.h>
33 #include <linux/delay.h>
34 #include <linux/platform_device.h>
35 #include <linux/pm.h>
36 #include <linux/hwmon.h>
37 #include <linux/err.h>
38 #include <linux/slab.h>
39
40 #include "../iio.h"
41 #include "tsl2563.h"
42
43 /* Use this many bits for fraction part. */
44 #define ADC_FRAC_BITS (14)
45
46 /* Given number of 1/10000's in ADC_FRAC_BITS precision. */
47 #define FRAC10K(f) (((f) * (1L << (ADC_FRAC_BITS))) / (10000))
48
49 /* Bits used for fraction in calibration coefficients.*/
50 #define CALIB_FRAC_BITS (10)
51 /* 0.5 in CALIB_FRAC_BITS precision */
52 #define CALIB_FRAC_HALF (1 << (CALIB_FRAC_BITS - 1))
53 /* Make a fraction from a number n that was multiplied with b. */
54 #define CALIB_FRAC(n, b) (((n) << CALIB_FRAC_BITS) / (b))
55 /* Decimal 10^(digits in sysfs presentation) */
56 #define CALIB_BASE_SYSFS (1000)
57
58 #define TSL2563_CMD (0x80)
59 #define TSL2563_CLEARINT (0x40)
60
61 #define TSL2563_REG_CTRL (0x00)
62 #define TSL2563_REG_TIMING (0x01)
63 #define TSL2563_REG_LOWLOW (0x02) /* data0 low threshold, 2 bytes */
64 #define TSL2563_REG_LOWHIGH (0x03)
65 #define TSL2563_REG_HIGHLOW (0x04) /* data0 high threshold, 2 bytes */
66 #define TSL2563_REG_HIGHHIGH (0x05)
67 #define TSL2563_REG_INT (0x06)
68 #define TSL2563_REG_ID (0x0a)
69 #define TSL2563_REG_DATA0LOW (0x0c) /* broadband sensor value, 2 bytes */
70 #define TSL2563_REG_DATA0HIGH (0x0d)
71 #define TSL2563_REG_DATA1LOW (0x0e) /* infrared sensor value, 2 bytes */
72 #define TSL2563_REG_DATA1HIGH (0x0f)
73
74 #define TSL2563_CMD_POWER_ON (0x03)
75 #define TSL2563_CMD_POWER_OFF (0x00)
76 #define TSL2563_CTRL_POWER_MASK (0x03)
77
78 #define TSL2563_TIMING_13MS (0x00)
79 #define TSL2563_TIMING_100MS (0x01)
80 #define TSL2563_TIMING_400MS (0x02)
81 #define TSL2563_TIMING_MASK (0x03)
82 #define TSL2563_TIMING_GAIN16 (0x10)
83 #define TSL2563_TIMING_GAIN1 (0x00)
84
85 #define TSL2563_INT_DISBLED (0x00)
86 #define TSL2563_INT_LEVEL (0x10)
87 #define TSL2563_INT_PERSIST(n) ((n) & 0x0F)
88
89 struct tsl2563_gainlevel_coeff {
90 u8 gaintime;
91 u16 min;
92 u16 max;
93 };
94
95 static const struct tsl2563_gainlevel_coeff tsl2563_gainlevel_table[] = {
96 {
97 .gaintime = TSL2563_TIMING_400MS | TSL2563_TIMING_GAIN16,
98 .min = 0,
99 .max = 65534,
100 }, {
101 .gaintime = TSL2563_TIMING_400MS | TSL2563_TIMING_GAIN1,
102 .min = 2048,
103 .max = 65534,
104 }, {
105 .gaintime = TSL2563_TIMING_100MS | TSL2563_TIMING_GAIN1,
106 .min = 4095,
107 .max = 37177,
108 }, {
109 .gaintime = TSL2563_TIMING_13MS | TSL2563_TIMING_GAIN1,
110 .min = 3000,
111 .max = 65535,
112 },
113 };
114
115 struct tsl2563_chip {
116 struct mutex lock;
117 struct i2c_client *client;
118 struct delayed_work poweroff_work;
119
120 /* Remember state for suspend and resume functions */
121 pm_message_t state;
122
123 struct tsl2563_gainlevel_coeff const *gainlevel;
124
125 u16 low_thres;
126 u16 high_thres;
127 u8 intr;
128 bool int_enabled;
129
130 /* Calibration coefficients */
131 u32 calib0;
132 u32 calib1;
133 int cover_comp_gain;
134
135 /* Cache current values, to be returned while suspended */
136 u32 data0;
137 u32 data1;
138 };
139
140 static int tsl2563_set_power(struct tsl2563_chip *chip, int on)
141 {
142 struct i2c_client *client = chip->client;
143 u8 cmd;
144
145 cmd = on ? TSL2563_CMD_POWER_ON : TSL2563_CMD_POWER_OFF;
146 return i2c_smbus_write_byte_data(client,
147 TSL2563_CMD | TSL2563_REG_CTRL, cmd);
148 }
149
150 /*
151 * Return value is 0 for off, 1 for on, or a negative error
152 * code if reading failed.
153 */
154 static int tsl2563_get_power(struct tsl2563_chip *chip)
155 {
156 struct i2c_client *client = chip->client;
157 int ret;
158
159 ret = i2c_smbus_read_byte_data(client, TSL2563_CMD | TSL2563_REG_CTRL);
160 if (ret < 0)
161 return ret;
162
163 return (ret & TSL2563_CTRL_POWER_MASK) == TSL2563_CMD_POWER_ON;
164 }
165
166 static int tsl2563_configure(struct tsl2563_chip *chip)
167 {
168 int ret;
169
170 ret = i2c_smbus_write_byte_data(chip->client,
171 TSL2563_CMD | TSL2563_REG_TIMING,
172 chip->gainlevel->gaintime);
173 if (ret)
174 goto error_ret;
175 ret = i2c_smbus_write_byte_data(chip->client,
176 TSL2563_CMD | TSL2563_REG_HIGHLOW,
177 chip->high_thres & 0xFF);
178 if (ret)
179 goto error_ret;
180 ret = i2c_smbus_write_byte_data(chip->client,
181 TSL2563_CMD | TSL2563_REG_HIGHHIGH,
182 (chip->high_thres >> 8) & 0xFF);
183 if (ret)
184 goto error_ret;
185 ret = i2c_smbus_write_byte_data(chip->client,
186 TSL2563_CMD | TSL2563_REG_LOWLOW,
187 chip->low_thres & 0xFF);
188 if (ret)
189 goto error_ret;
190 ret = i2c_smbus_write_byte_data(chip->client,
191 TSL2563_CMD | TSL2563_REG_LOWHIGH,
192 (chip->low_thres >> 8) & 0xFF);
193 /* Interrupt register is automatically written anyway if it is relevant
194 so is not here */
195 error_ret:
196 return ret;
197 }
198
199 static void tsl2563_poweroff_work(struct work_struct *work)
200 {
201 struct tsl2563_chip *chip =
202 container_of(work, struct tsl2563_chip, poweroff_work.work);
203 tsl2563_set_power(chip, 0);
204 }
205
206 static int tsl2563_detect(struct tsl2563_chip *chip)
207 {
208 int ret;
209
210 ret = tsl2563_set_power(chip, 1);
211 if (ret)
212 return ret;
213
214 ret = tsl2563_get_power(chip);
215 if (ret < 0)
216 return ret;
217
218 return ret ? 0 : -ENODEV;
219 }
220
221 static int tsl2563_read_id(struct tsl2563_chip *chip, u8 *id)
222 {
223 struct i2c_client *client = chip->client;
224 int ret;
225
226 ret = i2c_smbus_read_byte_data(client, TSL2563_CMD | TSL2563_REG_ID);
227 if (ret < 0)
228 return ret;
229
230 return 0;
231 }
232
233 /*
234 * "Normalized" ADC value is one obtained with 400ms of integration time and
235 * 16x gain. This function returns the number of bits of shift needed to
236 * convert between normalized values and HW values obtained using given
237 * timing and gain settings.
238 */
239 static int adc_shiftbits(u8 timing)
240 {
241 int shift = 0;
242
243 switch (timing & TSL2563_TIMING_MASK) {
244 case TSL2563_TIMING_13MS:
245 shift += 5;
246 break;
247 case TSL2563_TIMING_100MS:
248 shift += 2;
249 break;
250 case TSL2563_TIMING_400MS:
251 /* no-op */
252 break;
253 }
254
255 if (!(timing & TSL2563_TIMING_GAIN16))
256 shift += 4;
257
258 return shift;
259 }
260
261 /* Convert a HW ADC value to normalized scale. */
262 static u32 normalize_adc(u16 adc, u8 timing)
263 {
264 return adc << adc_shiftbits(timing);
265 }
266
267 static void tsl2563_wait_adc(struct tsl2563_chip *chip)
268 {
269 unsigned int delay;
270
271 switch (chip->gainlevel->gaintime & TSL2563_TIMING_MASK) {
272 case TSL2563_TIMING_13MS:
273 delay = 14;
274 break;
275 case TSL2563_TIMING_100MS:
276 delay = 101;
277 break;
278 default:
279 delay = 402;
280 }
281 /*
282 * TODO: Make sure that we wait at least required delay but why we
283 * have to extend it one tick more?
284 */
285 schedule_timeout_interruptible(msecs_to_jiffies(delay) + 2);
286 }
287
288 static int tsl2563_adjust_gainlevel(struct tsl2563_chip *chip, u16 adc)
289 {
290 struct i2c_client *client = chip->client;
291
292 if (adc > chip->gainlevel->max || adc < chip->gainlevel->min) {
293
294 (adc > chip->gainlevel->max) ?
295 chip->gainlevel++ : chip->gainlevel--;
296
297 i2c_smbus_write_byte_data(client,
298 TSL2563_CMD | TSL2563_REG_TIMING,
299 chip->gainlevel->gaintime);
300
301 tsl2563_wait_adc(chip);
302 tsl2563_wait_adc(chip);
303
304 return 1;
305 } else
306 return 0;
307 }
308
309 static int tsl2563_get_adc(struct tsl2563_chip *chip)
310 {
311 struct i2c_client *client = chip->client;
312 u16 adc0, adc1;
313 int retry = 1;
314 int ret = 0;
315
316 if (chip->state.event != PM_EVENT_ON)
317 goto out;
318
319 if (!chip->int_enabled) {
320 cancel_delayed_work(&chip->poweroff_work);
321
322 if (!tsl2563_get_power(chip)) {
323 ret = tsl2563_set_power(chip, 1);
324 if (ret)
325 goto out;
326 ret = tsl2563_configure(chip);
327 if (ret)
328 goto out;
329 tsl2563_wait_adc(chip);
330 }
331 }
332
333 while (retry) {
334 ret = i2c_smbus_read_word_data(client,
335 TSL2563_CMD | TSL2563_REG_DATA0LOW);
336 if (ret < 0)
337 goto out;
338 adc0 = ret;
339
340 ret = i2c_smbus_read_word_data(client,
341 TSL2563_CMD | TSL2563_REG_DATA1LOW);
342 if (ret < 0)
343 goto out;
344 adc1 = ret;
345
346 retry = tsl2563_adjust_gainlevel(chip, adc0);
347 }
348
349 chip->data0 = normalize_adc(adc0, chip->gainlevel->gaintime);
350 chip->data1 = normalize_adc(adc1, chip->gainlevel->gaintime);
351
352 if (!chip->int_enabled)
353 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
354
355 ret = 0;
356 out:
357 return ret;
358 }
359
360 static inline int calib_to_sysfs(u32 calib)
361 {
362 return (int) (((calib * CALIB_BASE_SYSFS) +
363 CALIB_FRAC_HALF) >> CALIB_FRAC_BITS);
364 }
365
366 static inline u32 calib_from_sysfs(int value)
367 {
368 return (((u32) value) << CALIB_FRAC_BITS) / CALIB_BASE_SYSFS;
369 }
370
371 /*
372 * Conversions between lux and ADC values.
373 *
374 * The basic formula is lux = c0 * adc0 - c1 * adc1, where c0 and c1 are
375 * appropriate constants. Different constants are needed for different
376 * kinds of light, determined by the ratio adc1/adc0 (basically the ratio
377 * of the intensities in infrared and visible wavelengths). lux_table below
378 * lists the upper threshold of the adc1/adc0 ratio and the corresponding
379 * constants.
380 */
381
382 struct tsl2563_lux_coeff {
383 unsigned long ch_ratio;
384 unsigned long ch0_coeff;
385 unsigned long ch1_coeff;
386 };
387
388 static const struct tsl2563_lux_coeff lux_table[] = {
389 {
390 .ch_ratio = FRAC10K(1300),
391 .ch0_coeff = FRAC10K(315),
392 .ch1_coeff = FRAC10K(262),
393 }, {
394 .ch_ratio = FRAC10K(2600),
395 .ch0_coeff = FRAC10K(337),
396 .ch1_coeff = FRAC10K(430),
397 }, {
398 .ch_ratio = FRAC10K(3900),
399 .ch0_coeff = FRAC10K(363),
400 .ch1_coeff = FRAC10K(529),
401 }, {
402 .ch_ratio = FRAC10K(5200),
403 .ch0_coeff = FRAC10K(392),
404 .ch1_coeff = FRAC10K(605),
405 }, {
406 .ch_ratio = FRAC10K(6500),
407 .ch0_coeff = FRAC10K(229),
408 .ch1_coeff = FRAC10K(291),
409 }, {
410 .ch_ratio = FRAC10K(8000),
411 .ch0_coeff = FRAC10K(157),
412 .ch1_coeff = FRAC10K(180),
413 }, {
414 .ch_ratio = FRAC10K(13000),
415 .ch0_coeff = FRAC10K(34),
416 .ch1_coeff = FRAC10K(26),
417 }, {
418 .ch_ratio = ULONG_MAX,
419 .ch0_coeff = 0,
420 .ch1_coeff = 0,
421 },
422 };
423
424 /*
425 * Convert normalized, scaled ADC values to lux.
426 */
427 static unsigned int adc_to_lux(u32 adc0, u32 adc1)
428 {
429 const struct tsl2563_lux_coeff *lp = lux_table;
430 unsigned long ratio, lux, ch0 = adc0, ch1 = adc1;
431
432 ratio = ch0 ? ((ch1 << ADC_FRAC_BITS) / ch0) : ULONG_MAX;
433
434 while (lp->ch_ratio < ratio)
435 lp++;
436
437 lux = ch0 * lp->ch0_coeff - ch1 * lp->ch1_coeff;
438
439 return (unsigned int) (lux >> ADC_FRAC_BITS);
440 }
441
442 /*--------------------------------------------------------------*/
443 /* Sysfs interface */
444 /*--------------------------------------------------------------*/
445
446
447 /* Apply calibration coefficient to ADC count. */
448 static u32 calib_adc(u32 adc, u32 calib)
449 {
450 unsigned long scaled = adc;
451
452 scaled *= calib;
453 scaled >>= CALIB_FRAC_BITS;
454
455 return (u32) scaled;
456 }
457
458 static int tsl2563_write_raw(struct iio_dev *indio_dev,
459 struct iio_chan_spec const *chan,
460 int val,
461 int val2,
462 long mask)
463 {
464 struct tsl2563_chip *chip = iio_priv(indio_dev);
465
466 if (chan->channel == 0)
467 chip->calib0 = calib_from_sysfs(val);
468 else
469 chip->calib1 = calib_from_sysfs(val);
470
471 return 0;
472 }
473
474 static int tsl2563_read_raw(struct iio_dev *indio_dev,
475 struct iio_chan_spec const *chan,
476 int *val,
477 int *val2,
478 long m)
479 {
480 int ret = -EINVAL;
481 u32 calib0, calib1;
482 struct tsl2563_chip *chip = iio_priv(indio_dev);
483
484 mutex_lock(&chip->lock);
485 switch (m) {
486 case 0:
487 switch (chan->type) {
488 case IIO_LIGHT:
489 ret = tsl2563_get_adc(chip);
490 if (ret)
491 goto error_ret;
492 calib0 = calib_adc(chip->data0, chip->calib0) *
493 chip->cover_comp_gain;
494 calib1 = calib_adc(chip->data1, chip->calib1) *
495 chip->cover_comp_gain;
496 *val = adc_to_lux(calib0, calib1);
497 ret = IIO_VAL_INT;
498 break;
499 case IIO_INTENSITY:
500 ret = tsl2563_get_adc(chip);
501 if (ret)
502 goto error_ret;
503 if (chan->channel == 0)
504 *val = chip->data0;
505 else
506 *val = chip->data1;
507 ret = IIO_VAL_INT;
508 break;
509 default:
510 break;
511 }
512 break;
513
514 case (1 << IIO_CHAN_INFO_CALIBSCALE_SEPARATE):
515 if (chan->channel == 0)
516 *val = calib_to_sysfs(chip->calib0);
517 else
518 *val = calib_to_sysfs(chip->calib1);
519 ret = IIO_VAL_INT;
520 break;
521 default:
522 return -EINVAL;
523 }
524
525 error_ret:
526 mutex_unlock(&chip->lock);
527 return ret;
528 }
529
530 #define INFO_MASK (1 << IIO_CHAN_INFO_CALIBSCALE_SEPARATE)
531 #define EVENT_MASK (IIO_EV_BIT(IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING) | \
532 IIO_EV_BIT(IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING))
533 #define IIO_CHAN_2563(type, mod, proc, chan, imask, emask) \
534 IIO_CHAN(type, mod, 1, proc, NULL, chan, 0, imask, 0, 0, {}, emask)
535
536 static const struct iio_chan_spec tsl2563_channels[] = {
537 IIO_CHAN_2563(IIO_LIGHT, 0, 1, 0, 0, 0),
538 IIO_CHAN_2563(IIO_INTENSITY, 1, 0, 0, INFO_MASK, EVENT_MASK),
539 IIO_CHAN_2563(IIO_INTENSITY, 1, 0, 1, INFO_MASK, 0),
540 };
541
542 static int tsl2563_read_thresh(struct iio_dev *indio_dev,
543 int event_code,
544 int *val)
545 {
546 struct tsl2563_chip *chip = iio_priv(indio_dev);
547
548 switch (IIO_EVENT_CODE_EXTRACT_DIR(event_code)) {
549 case IIO_EV_DIR_RISING:
550 *val = chip->high_thres;
551 break;
552 case IIO_EV_DIR_FALLING:
553 *val = chip->low_thres;
554 break;
555 default:
556 return -EINVAL;
557 }
558
559 return 0;
560 }
561
562 static ssize_t tsl2563_write_thresh(struct iio_dev *indio_dev,
563 int event_code,
564 int val)
565 {
566 struct tsl2563_chip *chip = iio_priv(indio_dev);
567 int ret;
568 u8 address;
569
570 if (IIO_EVENT_CODE_EXTRACT_DIR(event_code) == IIO_EV_DIR_RISING)
571 address = TSL2563_REG_HIGHLOW;
572 else
573 address = TSL2563_REG_LOWLOW;
574 mutex_lock(&chip->lock);
575 ret = i2c_smbus_write_byte_data(chip->client, TSL2563_CMD | address,
576 val & 0xFF);
577 if (ret)
578 goto error_ret;
579 ret = i2c_smbus_write_byte_data(chip->client,
580 TSL2563_CMD | (address + 1),
581 (val >> 8) & 0xFF);
582 if (IIO_EVENT_CODE_EXTRACT_DIR(event_code) == IIO_EV_DIR_RISING)
583 chip->high_thres = val;
584 else
585 chip->low_thres = val;
586
587 error_ret:
588 mutex_unlock(&chip->lock);
589
590 return ret;
591 }
592
593 static irqreturn_t tsl2563_event_handler(int irq, void *private)
594 {
595 struct iio_dev *dev_info = private;
596 struct tsl2563_chip *chip = iio_priv(dev_info);
597
598 iio_push_event(dev_info, 0,
599 IIO_UNMOD_EVENT_CODE(IIO_EV_CLASS_LIGHT,
600 0,
601 IIO_EV_TYPE_THRESH,
602 IIO_EV_DIR_EITHER),
603 iio_get_time_ns());
604
605 /* clear the interrupt and push the event */
606 i2c_smbus_write_byte(chip->client, TSL2563_CMD | TSL2563_CLEARINT);
607 return IRQ_HANDLED;
608 }
609
610 static int tsl2563_write_interrupt_config(struct iio_dev *indio_dev,
611 int event_code,
612 int state)
613 {
614 struct tsl2563_chip *chip = iio_priv(indio_dev);
615 int ret = 0;
616
617 mutex_lock(&chip->lock);
618 if (state && !(chip->intr & 0x30)) {
619 chip->intr &= ~0x30;
620 chip->intr |= 0x10;
621 /* ensure the chip is actually on */
622 cancel_delayed_work(&chip->poweroff_work);
623 if (!tsl2563_get_power(chip)) {
624 ret = tsl2563_set_power(chip, 1);
625 if (ret)
626 goto out;
627 ret = tsl2563_configure(chip);
628 if (ret)
629 goto out;
630 }
631 ret = i2c_smbus_write_byte_data(chip->client,
632 TSL2563_CMD | TSL2563_REG_INT,
633 chip->intr);
634 chip->int_enabled = true;
635 }
636
637 if (!state && (chip->intr & 0x30)) {
638 chip->intr |= ~0x30;
639 ret = i2c_smbus_write_byte_data(chip->client,
640 TSL2563_CMD | TSL2563_REG_INT,
641 chip->intr);
642 chip->int_enabled = false;
643 /* now the interrupt is not enabled, we can go to sleep */
644 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
645 }
646 out:
647 mutex_unlock(&chip->lock);
648
649 return ret;
650 }
651
652 static int tsl2563_read_interrupt_config(struct iio_dev *indio_dev,
653 int event_code)
654 {
655 struct tsl2563_chip *chip = iio_priv(indio_dev);
656 int ret;
657
658 mutex_lock(&chip->lock);
659 ret = i2c_smbus_read_byte_data(chip->client,
660 TSL2563_CMD | TSL2563_REG_INT);
661 mutex_unlock(&chip->lock);
662 if (ret < 0)
663 goto error_ret;
664 ret = !!(ret & 0x30);
665 error_ret:
666
667 return ret;
668 }
669
670 /*--------------------------------------------------------------*/
671 /* Probe, Attach, Remove */
672 /*--------------------------------------------------------------*/
673 static struct i2c_driver tsl2563_i2c_driver;
674
675 static const struct iio_info tsl2563_info_no_irq = {
676 .driver_module = THIS_MODULE,
677 .read_raw = &tsl2563_read_raw,
678 .write_raw = &tsl2563_write_raw,
679 };
680
681 static const struct iio_info tsl2563_info = {
682 .driver_module = THIS_MODULE,
683 .num_interrupt_lines = 1,
684 .read_raw = &tsl2563_read_raw,
685 .write_raw = &tsl2563_write_raw,
686 .read_event_value = &tsl2563_read_thresh,
687 .write_event_value = &tsl2563_write_thresh,
688 .read_event_config = &tsl2563_read_interrupt_config,
689 .write_event_config = &tsl2563_write_interrupt_config,
690 };
691
692 static int __devinit tsl2563_probe(struct i2c_client *client,
693 const struct i2c_device_id *device_id)
694 {
695 struct iio_dev *indio_dev;
696 struct tsl2563_chip *chip;
697 struct tsl2563_platform_data *pdata = client->dev.platform_data;
698 int err = 0;
699 int ret;
700 u8 id;
701
702 indio_dev = iio_allocate_device(sizeof(*chip));
703 if (!indio_dev)
704 return -ENOMEM;
705
706 chip = iio_priv(indio_dev);
707
708 i2c_set_clientdata(client, chip);
709 chip->client = client;
710
711 err = tsl2563_detect(chip);
712 if (err) {
713 dev_err(&client->dev, "device not found, error %d\n", -err);
714 goto fail1;
715 }
716
717 err = tsl2563_read_id(chip, &id);
718 if (err)
719 goto fail1;
720
721 mutex_init(&chip->lock);
722
723 /* Default values used until userspace says otherwise */
724 chip->low_thres = 0x0;
725 chip->high_thres = 0xffff;
726 chip->gainlevel = tsl2563_gainlevel_table;
727 chip->intr = TSL2563_INT_PERSIST(4);
728 chip->calib0 = calib_from_sysfs(CALIB_BASE_SYSFS);
729 chip->calib1 = calib_from_sysfs(CALIB_BASE_SYSFS);
730
731 if (pdata)
732 chip->cover_comp_gain = pdata->cover_comp_gain;
733 else
734 chip->cover_comp_gain = 1;
735
736 dev_info(&client->dev, "model %d, rev. %d\n", id >> 4, id & 0x0f);
737 indio_dev->name = client->name;
738 indio_dev->channels = tsl2563_channels;
739 indio_dev->num_channels = ARRAY_SIZE(tsl2563_channels);
740 indio_dev->dev.parent = &client->dev;
741 indio_dev->modes = INDIO_DIRECT_MODE;
742 if (client->irq)
743 indio_dev->info = &tsl2563_info;
744 else
745 indio_dev->info = &tsl2563_info_no_irq;
746 ret = iio_device_register(indio_dev);
747 if (ret)
748 goto fail1;
749 if (client->irq) {
750 ret = request_threaded_irq(client->irq,
751 NULL,
752 &tsl2563_event_handler,
753 IRQF_TRIGGER_RISING | IRQF_ONESHOT,
754 "tsl2563_event",
755 indio_dev);
756 if (ret)
757 goto fail2;
758 }
759 err = tsl2563_configure(chip);
760 if (err)
761 goto fail3;
762
763 INIT_DELAYED_WORK(&chip->poweroff_work, tsl2563_poweroff_work);
764 /* The interrupt cannot yet be enabled so this is fine without lock */
765 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
766
767 return 0;
768 fail3:
769 if (client->irq)
770 free_irq(client->irq, indio_dev);
771 fail2:
772 iio_device_unregister(indio_dev);
773 fail1:
774 kfree(chip);
775 return err;
776 }
777
778 static int tsl2563_remove(struct i2c_client *client)
779 {
780 struct tsl2563_chip *chip = i2c_get_clientdata(client);
781 struct iio_dev *indio_dev = iio_priv_to_dev(chip);
782 if (!chip->int_enabled)
783 cancel_delayed_work(&chip->poweroff_work);
784 /* Ensure that interrupts are disabled - then flush any bottom halves */
785 chip->intr |= ~0x30;
786 i2c_smbus_write_byte_data(chip->client, TSL2563_CMD | TSL2563_REG_INT,
787 chip->intr);
788 flush_scheduled_work();
789 tsl2563_set_power(chip, 0);
790 if (client->irq)
791 free_irq(client->irq, indio_dev);
792 iio_device_unregister(indio_dev);
793
794 return 0;
795 }
796
797 static int tsl2563_suspend(struct i2c_client *client, pm_message_t state)
798 {
799 struct tsl2563_chip *chip = i2c_get_clientdata(client);
800 int ret;
801
802 mutex_lock(&chip->lock);
803
804 ret = tsl2563_set_power(chip, 0);
805 if (ret)
806 goto out;
807
808 chip->state = state;
809
810 out:
811 mutex_unlock(&chip->lock);
812 return ret;
813 }
814
815 static int tsl2563_resume(struct i2c_client *client)
816 {
817 struct tsl2563_chip *chip = i2c_get_clientdata(client);
818 int ret;
819
820 mutex_lock(&chip->lock);
821
822 ret = tsl2563_set_power(chip, 1);
823 if (ret)
824 goto out;
825
826 ret = tsl2563_configure(chip);
827 if (ret)
828 goto out;
829
830 chip->state.event = PM_EVENT_ON;
831
832 out:
833 mutex_unlock(&chip->lock);
834 return ret;
835 }
836
837 static const struct i2c_device_id tsl2563_id[] = {
838 { "tsl2560", 0 },
839 { "tsl2561", 1 },
840 { "tsl2562", 2 },
841 { "tsl2563", 3 },
842 {}
843 };
844 MODULE_DEVICE_TABLE(i2c, tsl2563_id);
845
846 static struct i2c_driver tsl2563_i2c_driver = {
847 .driver = {
848 .name = "tsl2563",
849 },
850 .suspend = tsl2563_suspend,
851 .resume = tsl2563_resume,
852 .probe = tsl2563_probe,
853 .remove = __devexit_p(tsl2563_remove),
854 .id_table = tsl2563_id,
855 };
856
857 static int __init tsl2563_init(void)
858 {
859 return i2c_add_driver(&tsl2563_i2c_driver);
860 }
861
862 static void __exit tsl2563_exit(void)
863 {
864 i2c_del_driver(&tsl2563_i2c_driver);
865 }
866
867 MODULE_AUTHOR("Nokia Corporation");
868 MODULE_DESCRIPTION("tsl2563 light sensor driver");
869 MODULE_LICENSE("GPL");
870
871 module_init(tsl2563_init);
872 module_exit(tsl2563_exit);
Linux Btrfs Development