inet: frag: enforce memory limits earlier
[linux/fpc-iii.git] / drivers / iio / light / tsl2563.c
blobf0d3f749aa01c8ed463bcf8d93fe04bc0b0eea58
1 /*
2 * drivers/iio/light/tsl2563.c
4 * Copyright (C) 2008 Nokia Corporation
6 * Written by Timo O. Karjalainen <timo.o.karjalainen@nokia.com>
7 * Contact: Amit Kucheria <amit.kucheria@verdurent.com>
9 * Converted to IIO driver
10 * Amit Kucheria <amit.kucheria@verdurent.com>
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.
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.
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
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/pm.h>
35 #include <linux/err.h>
36 #include <linux/slab.h>
38 #include <linux/iio/iio.h>
39 #include <linux/iio/sysfs.h>
40 #include <linux/iio/events.h>
41 #include <linux/platform_data/tsl2563.h>
43 /* Use this many bits for fraction part. */
44 #define ADC_FRAC_BITS 14
46 /* Given number of 1/10000's in ADC_FRAC_BITS precision. */
47 #define FRAC10K(f) (((f) * (1L << (ADC_FRAC_BITS))) / (10000))
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
58 #define TSL2563_CMD 0x80
59 #define TSL2563_CLEARINT 0x40
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
74 #define TSL2563_CMD_POWER_ON 0x03
75 #define TSL2563_CMD_POWER_OFF 0x00
76 #define TSL2563_CTRL_POWER_MASK 0x03
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
85 #define TSL2563_INT_DISBLED 0x00
86 #define TSL2563_INT_LEVEL 0x10
87 #define TSL2563_INT_PERSIST(n) ((n) & 0x0F)
89 struct tsl2563_gainlevel_coeff {
90 u8 gaintime;
91 u16 min;
92 u16 max;
95 static const struct tsl2563_gainlevel_coeff tsl2563_gainlevel_table[] = {
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,
115 struct tsl2563_chip {
116 struct mutex lock;
117 struct i2c_client *client;
118 struct delayed_work poweroff_work;
120 /* Remember state for suspend and resume functions */
121 bool suspended;
123 struct tsl2563_gainlevel_coeff const *gainlevel;
125 u16 low_thres;
126 u16 high_thres;
127 u8 intr;
128 bool int_enabled;
130 /* Calibration coefficients */
131 u32 calib0;
132 u32 calib1;
133 int cover_comp_gain;
135 /* Cache current values, to be returned while suspended */
136 u32 data0;
137 u32 data1;
140 static int tsl2563_set_power(struct tsl2563_chip *chip, int on)
142 struct i2c_client *client = chip->client;
143 u8 cmd;
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);
151 * Return value is 0 for off, 1 for on, or a negative error
152 * code if reading failed.
154 static int tsl2563_get_power(struct tsl2563_chip *chip)
156 struct i2c_client *client = chip->client;
157 int ret;
159 ret = i2c_smbus_read_byte_data(client, TSL2563_CMD | TSL2563_REG_CTRL);
160 if (ret < 0)
161 return ret;
163 return (ret & TSL2563_CTRL_POWER_MASK) == TSL2563_CMD_POWER_ON;
166 static int tsl2563_configure(struct tsl2563_chip *chip)
168 int ret;
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);
194 * Interrupt register is automatically written anyway if it is relevant
195 * so is not here.
197 error_ret:
198 return ret;
201 static void tsl2563_poweroff_work(struct work_struct *work)
203 struct tsl2563_chip *chip =
204 container_of(work, struct tsl2563_chip, poweroff_work.work);
205 tsl2563_set_power(chip, 0);
208 static int tsl2563_detect(struct tsl2563_chip *chip)
210 int ret;
212 ret = tsl2563_set_power(chip, 1);
213 if (ret)
214 return ret;
216 ret = tsl2563_get_power(chip);
217 if (ret < 0)
218 return ret;
220 return ret ? 0 : -ENODEV;
223 static int tsl2563_read_id(struct tsl2563_chip *chip, u8 *id)
225 struct i2c_client *client = chip->client;
226 int ret;
228 ret = i2c_smbus_read_byte_data(client, TSL2563_CMD | TSL2563_REG_ID);
229 if (ret < 0)
230 return ret;
232 *id = ret;
234 return 0;
238 * "Normalized" ADC value is one obtained with 400ms of integration time and
239 * 16x gain. This function returns the number of bits of shift needed to
240 * convert between normalized values and HW values obtained using given
241 * timing and gain settings.
243 static int tsl2563_adc_shiftbits(u8 timing)
245 int shift = 0;
247 switch (timing & TSL2563_TIMING_MASK) {
248 case TSL2563_TIMING_13MS:
249 shift += 5;
250 break;
251 case TSL2563_TIMING_100MS:
252 shift += 2;
253 break;
254 case TSL2563_TIMING_400MS:
255 /* no-op */
256 break;
259 if (!(timing & TSL2563_TIMING_GAIN16))
260 shift += 4;
262 return shift;
265 /* Convert a HW ADC value to normalized scale. */
266 static u32 tsl2563_normalize_adc(u16 adc, u8 timing)
268 return adc << tsl2563_adc_shiftbits(timing);
271 static void tsl2563_wait_adc(struct tsl2563_chip *chip)
273 unsigned int delay;
275 switch (chip->gainlevel->gaintime & TSL2563_TIMING_MASK) {
276 case TSL2563_TIMING_13MS:
277 delay = 14;
278 break;
279 case TSL2563_TIMING_100MS:
280 delay = 101;
281 break;
282 default:
283 delay = 402;
286 * TODO: Make sure that we wait at least required delay but why we
287 * have to extend it one tick more?
289 schedule_timeout_interruptible(msecs_to_jiffies(delay) + 2);
292 static int tsl2563_adjust_gainlevel(struct tsl2563_chip *chip, u16 adc)
294 struct i2c_client *client = chip->client;
296 if (adc > chip->gainlevel->max || adc < chip->gainlevel->min) {
298 (adc > chip->gainlevel->max) ?
299 chip->gainlevel++ : chip->gainlevel--;
301 i2c_smbus_write_byte_data(client,
302 TSL2563_CMD | TSL2563_REG_TIMING,
303 chip->gainlevel->gaintime);
305 tsl2563_wait_adc(chip);
306 tsl2563_wait_adc(chip);
308 return 1;
309 } else
310 return 0;
313 static int tsl2563_get_adc(struct tsl2563_chip *chip)
315 struct i2c_client *client = chip->client;
316 u16 adc0, adc1;
317 int retry = 1;
318 int ret = 0;
320 if (chip->suspended)
321 goto out;
323 if (!chip->int_enabled) {
324 cancel_delayed_work(&chip->poweroff_work);
326 if (!tsl2563_get_power(chip)) {
327 ret = tsl2563_set_power(chip, 1);
328 if (ret)
329 goto out;
330 ret = tsl2563_configure(chip);
331 if (ret)
332 goto out;
333 tsl2563_wait_adc(chip);
337 while (retry) {
338 ret = i2c_smbus_read_word_data(client,
339 TSL2563_CMD | TSL2563_REG_DATA0LOW);
340 if (ret < 0)
341 goto out;
342 adc0 = ret;
344 ret = i2c_smbus_read_word_data(client,
345 TSL2563_CMD | TSL2563_REG_DATA1LOW);
346 if (ret < 0)
347 goto out;
348 adc1 = ret;
350 retry = tsl2563_adjust_gainlevel(chip, adc0);
353 chip->data0 = tsl2563_normalize_adc(adc0, chip->gainlevel->gaintime);
354 chip->data1 = tsl2563_normalize_adc(adc1, chip->gainlevel->gaintime);
356 if (!chip->int_enabled)
357 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
359 ret = 0;
360 out:
361 return ret;
364 static inline int tsl2563_calib_to_sysfs(u32 calib)
366 return (int) (((calib * CALIB_BASE_SYSFS) +
367 CALIB_FRAC_HALF) >> CALIB_FRAC_BITS);
370 static inline u32 tsl2563_calib_from_sysfs(int value)
372 return (((u32) value) << CALIB_FRAC_BITS) / CALIB_BASE_SYSFS;
376 * Conversions between lux and ADC values.
378 * The basic formula is lux = c0 * adc0 - c1 * adc1, where c0 and c1 are
379 * appropriate constants. Different constants are needed for different
380 * kinds of light, determined by the ratio adc1/adc0 (basically the ratio
381 * of the intensities in infrared and visible wavelengths). lux_table below
382 * lists the upper threshold of the adc1/adc0 ratio and the corresponding
383 * constants.
386 struct tsl2563_lux_coeff {
387 unsigned long ch_ratio;
388 unsigned long ch0_coeff;
389 unsigned long ch1_coeff;
392 static const struct tsl2563_lux_coeff lux_table[] = {
394 .ch_ratio = FRAC10K(1300),
395 .ch0_coeff = FRAC10K(315),
396 .ch1_coeff = FRAC10K(262),
397 }, {
398 .ch_ratio = FRAC10K(2600),
399 .ch0_coeff = FRAC10K(337),
400 .ch1_coeff = FRAC10K(430),
401 }, {
402 .ch_ratio = FRAC10K(3900),
403 .ch0_coeff = FRAC10K(363),
404 .ch1_coeff = FRAC10K(529),
405 }, {
406 .ch_ratio = FRAC10K(5200),
407 .ch0_coeff = FRAC10K(392),
408 .ch1_coeff = FRAC10K(605),
409 }, {
410 .ch_ratio = FRAC10K(6500),
411 .ch0_coeff = FRAC10K(229),
412 .ch1_coeff = FRAC10K(291),
413 }, {
414 .ch_ratio = FRAC10K(8000),
415 .ch0_coeff = FRAC10K(157),
416 .ch1_coeff = FRAC10K(180),
417 }, {
418 .ch_ratio = FRAC10K(13000),
419 .ch0_coeff = FRAC10K(34),
420 .ch1_coeff = FRAC10K(26),
421 }, {
422 .ch_ratio = ULONG_MAX,
423 .ch0_coeff = 0,
424 .ch1_coeff = 0,
428 /* Convert normalized, scaled ADC values to lux. */
429 static unsigned int tsl2563_adc_to_lux(u32 adc0, u32 adc1)
431 const struct tsl2563_lux_coeff *lp = lux_table;
432 unsigned long ratio, lux, ch0 = adc0, ch1 = adc1;
434 ratio = ch0 ? ((ch1 << ADC_FRAC_BITS) / ch0) : ULONG_MAX;
436 while (lp->ch_ratio < ratio)
437 lp++;
439 lux = ch0 * lp->ch0_coeff - ch1 * lp->ch1_coeff;
441 return (unsigned int) (lux >> ADC_FRAC_BITS);
444 /* Apply calibration coefficient to ADC count. */
445 static u32 tsl2563_calib_adc(u32 adc, u32 calib)
447 unsigned long scaled = adc;
449 scaled *= calib;
450 scaled >>= CALIB_FRAC_BITS;
452 return (u32) scaled;
455 static int tsl2563_write_raw(struct iio_dev *indio_dev,
456 struct iio_chan_spec const *chan,
457 int val,
458 int val2,
459 long mask)
461 struct tsl2563_chip *chip = iio_priv(indio_dev);
463 if (mask != IIO_CHAN_INFO_CALIBSCALE)
464 return -EINVAL;
465 if (chan->channel2 == IIO_MOD_LIGHT_BOTH)
466 chip->calib0 = tsl2563_calib_from_sysfs(val);
467 else if (chan->channel2 == IIO_MOD_LIGHT_IR)
468 chip->calib1 = tsl2563_calib_from_sysfs(val);
469 else
470 return -EINVAL;
472 return 0;
475 static int tsl2563_read_raw(struct iio_dev *indio_dev,
476 struct iio_chan_spec const *chan,
477 int *val,
478 int *val2,
479 long mask)
481 int ret = -EINVAL;
482 u32 calib0, calib1;
483 struct tsl2563_chip *chip = iio_priv(indio_dev);
485 mutex_lock(&chip->lock);
486 switch (mask) {
487 case IIO_CHAN_INFO_RAW:
488 case IIO_CHAN_INFO_PROCESSED:
489 switch (chan->type) {
490 case IIO_LIGHT:
491 ret = tsl2563_get_adc(chip);
492 if (ret)
493 goto error_ret;
494 calib0 = tsl2563_calib_adc(chip->data0, chip->calib0) *
495 chip->cover_comp_gain;
496 calib1 = tsl2563_calib_adc(chip->data1, chip->calib1) *
497 chip->cover_comp_gain;
498 *val = tsl2563_adc_to_lux(calib0, calib1);
499 ret = IIO_VAL_INT;
500 break;
501 case IIO_INTENSITY:
502 ret = tsl2563_get_adc(chip);
503 if (ret)
504 goto error_ret;
505 if (chan->channel2 == IIO_MOD_LIGHT_BOTH)
506 *val = chip->data0;
507 else
508 *val = chip->data1;
509 ret = IIO_VAL_INT;
510 break;
511 default:
512 break;
514 break;
516 case IIO_CHAN_INFO_CALIBSCALE:
517 if (chan->channel2 == IIO_MOD_LIGHT_BOTH)
518 *val = tsl2563_calib_to_sysfs(chip->calib0);
519 else
520 *val = tsl2563_calib_to_sysfs(chip->calib1);
521 ret = IIO_VAL_INT;
522 break;
523 default:
524 ret = -EINVAL;
525 goto error_ret;
528 error_ret:
529 mutex_unlock(&chip->lock);
530 return ret;
533 static const struct iio_event_spec tsl2563_events[] = {
535 .type = IIO_EV_TYPE_THRESH,
536 .dir = IIO_EV_DIR_RISING,
537 .mask_separate = BIT(IIO_EV_INFO_VALUE) |
538 BIT(IIO_EV_INFO_ENABLE),
539 }, {
540 .type = IIO_EV_TYPE_THRESH,
541 .dir = IIO_EV_DIR_FALLING,
542 .mask_separate = BIT(IIO_EV_INFO_VALUE) |
543 BIT(IIO_EV_INFO_ENABLE),
547 static const struct iio_chan_spec tsl2563_channels[] = {
549 .type = IIO_LIGHT,
550 .indexed = 1,
551 .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
552 .channel = 0,
553 }, {
554 .type = IIO_INTENSITY,
555 .modified = 1,
556 .channel2 = IIO_MOD_LIGHT_BOTH,
557 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
558 BIT(IIO_CHAN_INFO_CALIBSCALE),
559 .event_spec = tsl2563_events,
560 .num_event_specs = ARRAY_SIZE(tsl2563_events),
561 }, {
562 .type = IIO_INTENSITY,
563 .modified = 1,
564 .channel2 = IIO_MOD_LIGHT_IR,
565 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
566 BIT(IIO_CHAN_INFO_CALIBSCALE),
570 static int tsl2563_read_thresh(struct iio_dev *indio_dev,
571 const struct iio_chan_spec *chan, enum iio_event_type type,
572 enum iio_event_direction dir, enum iio_event_info info, int *val,
573 int *val2)
575 struct tsl2563_chip *chip = iio_priv(indio_dev);
577 switch (dir) {
578 case IIO_EV_DIR_RISING:
579 *val = chip->high_thres;
580 break;
581 case IIO_EV_DIR_FALLING:
582 *val = chip->low_thres;
583 break;
584 default:
585 return -EINVAL;
588 return IIO_VAL_INT;
591 static int tsl2563_write_thresh(struct iio_dev *indio_dev,
592 const struct iio_chan_spec *chan, enum iio_event_type type,
593 enum iio_event_direction dir, enum iio_event_info info, int val,
594 int val2)
596 struct tsl2563_chip *chip = iio_priv(indio_dev);
597 int ret;
598 u8 address;
600 if (dir == IIO_EV_DIR_RISING)
601 address = TSL2563_REG_HIGHLOW;
602 else
603 address = TSL2563_REG_LOWLOW;
604 mutex_lock(&chip->lock);
605 ret = i2c_smbus_write_byte_data(chip->client, TSL2563_CMD | address,
606 val & 0xFF);
607 if (ret)
608 goto error_ret;
609 ret = i2c_smbus_write_byte_data(chip->client,
610 TSL2563_CMD | (address + 1),
611 (val >> 8) & 0xFF);
612 if (dir == IIO_EV_DIR_RISING)
613 chip->high_thres = val;
614 else
615 chip->low_thres = val;
617 error_ret:
618 mutex_unlock(&chip->lock);
620 return ret;
623 static irqreturn_t tsl2563_event_handler(int irq, void *private)
625 struct iio_dev *dev_info = private;
626 struct tsl2563_chip *chip = iio_priv(dev_info);
628 iio_push_event(dev_info,
629 IIO_UNMOD_EVENT_CODE(IIO_INTENSITY,
631 IIO_EV_TYPE_THRESH,
632 IIO_EV_DIR_EITHER),
633 iio_get_time_ns(dev_info));
635 /* clear the interrupt and push the event */
636 i2c_smbus_write_byte(chip->client, TSL2563_CMD | TSL2563_CLEARINT);
637 return IRQ_HANDLED;
640 static int tsl2563_write_interrupt_config(struct iio_dev *indio_dev,
641 const struct iio_chan_spec *chan, enum iio_event_type type,
642 enum iio_event_direction dir, int state)
644 struct tsl2563_chip *chip = iio_priv(indio_dev);
645 int ret = 0;
647 mutex_lock(&chip->lock);
648 if (state && !(chip->intr & 0x30)) {
649 chip->intr &= ~0x30;
650 chip->intr |= 0x10;
651 /* ensure the chip is actually on */
652 cancel_delayed_work(&chip->poweroff_work);
653 if (!tsl2563_get_power(chip)) {
654 ret = tsl2563_set_power(chip, 1);
655 if (ret)
656 goto out;
657 ret = tsl2563_configure(chip);
658 if (ret)
659 goto out;
661 ret = i2c_smbus_write_byte_data(chip->client,
662 TSL2563_CMD | TSL2563_REG_INT,
663 chip->intr);
664 chip->int_enabled = true;
667 if (!state && (chip->intr & 0x30)) {
668 chip->intr &= ~0x30;
669 ret = i2c_smbus_write_byte_data(chip->client,
670 TSL2563_CMD | TSL2563_REG_INT,
671 chip->intr);
672 chip->int_enabled = false;
673 /* now the interrupt is not enabled, we can go to sleep */
674 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
676 out:
677 mutex_unlock(&chip->lock);
679 return ret;
682 static int tsl2563_read_interrupt_config(struct iio_dev *indio_dev,
683 const struct iio_chan_spec *chan, enum iio_event_type type,
684 enum iio_event_direction dir)
686 struct tsl2563_chip *chip = iio_priv(indio_dev);
687 int ret;
689 mutex_lock(&chip->lock);
690 ret = i2c_smbus_read_byte_data(chip->client,
691 TSL2563_CMD | TSL2563_REG_INT);
692 mutex_unlock(&chip->lock);
693 if (ret < 0)
694 return ret;
696 return !!(ret & 0x30);
699 static const struct iio_info tsl2563_info_no_irq = {
700 .driver_module = THIS_MODULE,
701 .read_raw = &tsl2563_read_raw,
702 .write_raw = &tsl2563_write_raw,
705 static const struct iio_info tsl2563_info = {
706 .driver_module = THIS_MODULE,
707 .read_raw = &tsl2563_read_raw,
708 .write_raw = &tsl2563_write_raw,
709 .read_event_value = &tsl2563_read_thresh,
710 .write_event_value = &tsl2563_write_thresh,
711 .read_event_config = &tsl2563_read_interrupt_config,
712 .write_event_config = &tsl2563_write_interrupt_config,
715 static int tsl2563_probe(struct i2c_client *client,
716 const struct i2c_device_id *device_id)
718 struct iio_dev *indio_dev;
719 struct tsl2563_chip *chip;
720 struct tsl2563_platform_data *pdata = client->dev.platform_data;
721 struct device_node *np = client->dev.of_node;
722 int err = 0;
723 u8 id = 0;
725 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*chip));
726 if (!indio_dev)
727 return -ENOMEM;
729 chip = iio_priv(indio_dev);
731 i2c_set_clientdata(client, chip);
732 chip->client = client;
734 err = tsl2563_detect(chip);
735 if (err) {
736 dev_err(&client->dev, "detect error %d\n", -err);
737 return err;
740 err = tsl2563_read_id(chip, &id);
741 if (err) {
742 dev_err(&client->dev, "read id error %d\n", -err);
743 return err;
746 mutex_init(&chip->lock);
748 /* Default values used until userspace says otherwise */
749 chip->low_thres = 0x0;
750 chip->high_thres = 0xffff;
751 chip->gainlevel = tsl2563_gainlevel_table;
752 chip->intr = TSL2563_INT_PERSIST(4);
753 chip->calib0 = tsl2563_calib_from_sysfs(CALIB_BASE_SYSFS);
754 chip->calib1 = tsl2563_calib_from_sysfs(CALIB_BASE_SYSFS);
756 if (pdata)
757 chip->cover_comp_gain = pdata->cover_comp_gain;
758 else if (np)
759 of_property_read_u32(np, "amstaos,cover-comp-gain",
760 &chip->cover_comp_gain);
761 else
762 chip->cover_comp_gain = 1;
764 dev_info(&client->dev, "model %d, rev. %d\n", id >> 4, id & 0x0f);
765 indio_dev->name = client->name;
766 indio_dev->channels = tsl2563_channels;
767 indio_dev->num_channels = ARRAY_SIZE(tsl2563_channels);
768 indio_dev->dev.parent = &client->dev;
769 indio_dev->modes = INDIO_DIRECT_MODE;
771 if (client->irq)
772 indio_dev->info = &tsl2563_info;
773 else
774 indio_dev->info = &tsl2563_info_no_irq;
776 if (client->irq) {
777 err = devm_request_threaded_irq(&client->dev, client->irq,
778 NULL,
779 &tsl2563_event_handler,
780 IRQF_TRIGGER_RISING | IRQF_ONESHOT,
781 "tsl2563_event",
782 indio_dev);
783 if (err) {
784 dev_err(&client->dev, "irq request error %d\n", -err);
785 return err;
789 err = tsl2563_configure(chip);
790 if (err) {
791 dev_err(&client->dev, "configure error %d\n", -err);
792 return err;
795 INIT_DELAYED_WORK(&chip->poweroff_work, tsl2563_poweroff_work);
797 /* The interrupt cannot yet be enabled so this is fine without lock */
798 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
800 err = iio_device_register(indio_dev);
801 if (err) {
802 dev_err(&client->dev, "iio registration error %d\n", -err);
803 goto fail;
806 return 0;
808 fail:
809 cancel_delayed_work_sync(&chip->poweroff_work);
810 return err;
813 static int tsl2563_remove(struct i2c_client *client)
815 struct tsl2563_chip *chip = i2c_get_clientdata(client);
816 struct iio_dev *indio_dev = iio_priv_to_dev(chip);
818 iio_device_unregister(indio_dev);
819 if (!chip->int_enabled)
820 cancel_delayed_work(&chip->poweroff_work);
821 /* Ensure that interrupts are disabled - then flush any bottom halves */
822 chip->intr &= ~0x30;
823 i2c_smbus_write_byte_data(chip->client, TSL2563_CMD | TSL2563_REG_INT,
824 chip->intr);
825 flush_scheduled_work();
826 tsl2563_set_power(chip, 0);
828 return 0;
831 #ifdef CONFIG_PM_SLEEP
832 static int tsl2563_suspend(struct device *dev)
834 struct tsl2563_chip *chip = i2c_get_clientdata(to_i2c_client(dev));
835 int ret;
837 mutex_lock(&chip->lock);
839 ret = tsl2563_set_power(chip, 0);
840 if (ret)
841 goto out;
843 chip->suspended = true;
845 out:
846 mutex_unlock(&chip->lock);
847 return ret;
850 static int tsl2563_resume(struct device *dev)
852 struct tsl2563_chip *chip = i2c_get_clientdata(to_i2c_client(dev));
853 int ret;
855 mutex_lock(&chip->lock);
857 ret = tsl2563_set_power(chip, 1);
858 if (ret)
859 goto out;
861 ret = tsl2563_configure(chip);
862 if (ret)
863 goto out;
865 chip->suspended = false;
867 out:
868 mutex_unlock(&chip->lock);
869 return ret;
872 static SIMPLE_DEV_PM_OPS(tsl2563_pm_ops, tsl2563_suspend, tsl2563_resume);
873 #define TSL2563_PM_OPS (&tsl2563_pm_ops)
874 #else
875 #define TSL2563_PM_OPS NULL
876 #endif
878 static const struct i2c_device_id tsl2563_id[] = {
879 { "tsl2560", 0 },
880 { "tsl2561", 1 },
881 { "tsl2562", 2 },
882 { "tsl2563", 3 },
885 MODULE_DEVICE_TABLE(i2c, tsl2563_id);
887 static struct i2c_driver tsl2563_i2c_driver = {
888 .driver = {
889 .name = "tsl2563",
890 .pm = TSL2563_PM_OPS,
892 .probe = tsl2563_probe,
893 .remove = tsl2563_remove,
894 .id_table = tsl2563_id,
896 module_i2c_driver(tsl2563_i2c_driver);
898 MODULE_AUTHOR("Nokia Corporation");
899 MODULE_DESCRIPTION("tsl2563 light sensor driver");
900 MODULE_LICENSE("GPL");