drivers/staging/iio/light/tsl2563.c

   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/pm.h>
  35 #include <linux/err.h>
  36 #include <linux/slab.h>
  37
  38 #include <linux/iio/iio.h>
  39 #include <linux/iio/sysfs.h>
  40 #include <linux/iio/events.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         bool suspended;
 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         *id = ret;
 231
 232         return 0;
 233 }
 234
 235 /*
 236  * "Normalized" ADC value is one obtained with 400ms of integration time and
 237  * 16x gain. This function returns the number of bits of shift needed to
 238  * convert between normalized values and HW values obtained using given
 239  * timing and gain settings.
 240  */
 241 static int adc_shiftbits(u8 timing)
 242 {
 243         int shift = 0;
 244
 245         switch (timing & TSL2563_TIMING_MASK) {
 246         case TSL2563_TIMING_13MS:
 247                 shift += 5;
 248                 break;
 249         case TSL2563_TIMING_100MS:
 250                 shift += 2;
 251                 break;
 252         case TSL2563_TIMING_400MS:
 253                 /* no-op */
 254                 break;
 255         }
 256
 257         if (!(timing & TSL2563_TIMING_GAIN16))
 258                 shift += 4;
 259
 260         return shift;
 261 }
 262
 263 /* Convert a HW ADC value to normalized scale. */
 264 static u32 normalize_adc(u16 adc, u8 timing)
 265 {
 266         return adc << adc_shiftbits(timing);
 267 }
 268
 269 static void tsl2563_wait_adc(struct tsl2563_chip *chip)
 270 {
 271         unsigned int delay;
 272
 273         switch (chip->gainlevel->gaintime & TSL2563_TIMING_MASK) {
 274         case TSL2563_TIMING_13MS:
 275                 delay = 14;
 276                 break;
 277         case TSL2563_TIMING_100MS:
 278                 delay = 101;
 279                 break;
 280         default:
 281                 delay = 402;
 282         }
 283         /*
 284          * TODO: Make sure that we wait at least required delay but why we
 285          * have to extend it one tick more?
 286          */
 287         schedule_timeout_interruptible(msecs_to_jiffies(delay) + 2);
 288 }
 289
 290 static int tsl2563_adjust_gainlevel(struct tsl2563_chip *chip, u16 adc)
 291 {
 292         struct i2c_client *client = chip->client;
 293
 294         if (adc > chip->gainlevel->max || adc < chip->gainlevel->min) {
 295
 296                 (adc > chip->gainlevel->max) ?
 297                         chip->gainlevel++ : chip->gainlevel--;
 298
 299                 i2c_smbus_write_byte_data(client,
 300                                           TSL2563_CMD | TSL2563_REG_TIMING,
 301                                           chip->gainlevel->gaintime);
 302
 303                 tsl2563_wait_adc(chip);
 304                 tsl2563_wait_adc(chip);
 305
 306                 return 1;
 307         } else
 308                 return 0;
 309 }
 310
 311 static int tsl2563_get_adc(struct tsl2563_chip *chip)
 312 {
 313         struct i2c_client *client = chip->client;
 314         u16 adc0, adc1;
 315         int retry = 1;
 316         int ret = 0;
 317
 318         if (chip->suspended)
 319                 goto out;
 320
 321         if (!chip->int_enabled) {
 322                 cancel_delayed_work(&chip->poweroff_work);
 323
 324                 if (!tsl2563_get_power(chip)) {
 325                         ret = tsl2563_set_power(chip, 1);
 326                         if (ret)
 327                                 goto out;
 328                         ret = tsl2563_configure(chip);
 329                         if (ret)
 330                                 goto out;
 331                         tsl2563_wait_adc(chip);
 332                 }
 333         }
 334
 335         while (retry) {
 336                 ret = i2c_smbus_read_word_data(client,
 337                                 TSL2563_CMD | TSL2563_REG_DATA0LOW);
 338                 if (ret < 0)
 339                         goto out;
 340                 adc0 = ret;
 341
 342                 ret = i2c_smbus_read_word_data(client,
 343                                 TSL2563_CMD | TSL2563_REG_DATA1LOW);
 344                 if (ret < 0)
 345                         goto out;
 346                 adc1 = ret;
 347
 348                 retry = tsl2563_adjust_gainlevel(chip, adc0);
 349         }
 350
 351         chip->data0 = normalize_adc(adc0, chip->gainlevel->gaintime);
 352         chip->data1 = normalize_adc(adc1, chip->gainlevel->gaintime);
 353
 354         if (!chip->int_enabled)
 355                 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
 356
 357         ret = 0;
 358 out:
 359         return ret;
 360 }
 361
 362 static inline int calib_to_sysfs(u32 calib)
 363 {
 364         return (int) (((calib * CALIB_BASE_SYSFS) +
 365                        CALIB_FRAC_HALF) >> CALIB_FRAC_BITS);
 366 }
 367
 368 static inline u32 calib_from_sysfs(int value)
 369 {
 370         return (((u32) value) << CALIB_FRAC_BITS) / CALIB_BASE_SYSFS;
 371 }
 372
 373 /*
 374  * Conversions between lux and ADC values.
 375  *
 376  * The basic formula is lux = c0 * adc0 - c1 * adc1, where c0 and c1 are
 377  * appropriate constants. Different constants are needed for different
 378  * kinds of light, determined by the ratio adc1/adc0 (basically the ratio
 379  * of the intensities in infrared and visible wavelengths). lux_table below
 380  * lists the upper threshold of the adc1/adc0 ratio and the corresponding
 381  * constants.
 382  */
 383
 384 struct tsl2563_lux_coeff {
 385         unsigned long ch_ratio;
 386         unsigned long ch0_coeff;
 387         unsigned long ch1_coeff;
 388 };
 389
 390 static const struct tsl2563_lux_coeff lux_table[] = {
 391         {
 392                 .ch_ratio       = FRAC10K(1300),
 393                 .ch0_coeff      = FRAC10K(315),
 394                 .ch1_coeff      = FRAC10K(262),
 395         }, {
 396                 .ch_ratio       = FRAC10K(2600),
 397                 .ch0_coeff      = FRAC10K(337),
 398                 .ch1_coeff      = FRAC10K(430),
 399         }, {
 400                 .ch_ratio       = FRAC10K(3900),
 401                 .ch0_coeff      = FRAC10K(363),
 402                 .ch1_coeff      = FRAC10K(529),
 403         }, {
 404                 .ch_ratio       = FRAC10K(5200),
 405                 .ch0_coeff      = FRAC10K(392),
 406                 .ch1_coeff      = FRAC10K(605),
 407         }, {
 408                 .ch_ratio       = FRAC10K(6500),
 409                 .ch0_coeff      = FRAC10K(229),
 410                 .ch1_coeff      = FRAC10K(291),
 411         }, {
 412                 .ch_ratio       = FRAC10K(8000),
 413                 .ch0_coeff      = FRAC10K(157),
 414                 .ch1_coeff      = FRAC10K(180),
 415         }, {
 416                 .ch_ratio       = FRAC10K(13000),
 417                 .ch0_coeff      = FRAC10K(34),
 418                 .ch1_coeff      = FRAC10K(26),
 419         }, {
 420                 .ch_ratio       = ULONG_MAX,
 421                 .ch0_coeff      = 0,
 422                 .ch1_coeff      = 0,
 423         },
 424 };
 425
 426 /*
 427  * Convert normalized, scaled ADC values to lux.
 428  */
 429 static unsigned int adc_to_lux(u32 adc0, u32 adc1)
 430 {
 431         const struct tsl2563_lux_coeff *lp = lux_table;
 432         unsigned long ratio, lux, ch0 = adc0, ch1 = adc1;
 433
 434         ratio = ch0 ? ((ch1 << ADC_FRAC_BITS) / ch0) : ULONG_MAX;
 435
 436         while (lp->ch_ratio < ratio)
 437                 lp++;
 438
 439         lux = ch0 * lp->ch0_coeff - ch1 * lp->ch1_coeff;
 440
 441         return (unsigned int) (lux >> ADC_FRAC_BITS);
 442 }
 443
 444 /*--------------------------------------------------------------*/
 445 /*                      Sysfs interface                         */
 446 /*--------------------------------------------------------------*/
 447
 448
 449 /* Apply calibration coefficient to ADC count. */
 450 static u32 calib_adc(u32 adc, u32 calib)
 451 {
 452         unsigned long scaled = adc;
 453
 454         scaled *= calib;
 455         scaled >>= CALIB_FRAC_BITS;
 456
 457         return (u32) scaled;
 458 }
 459
 460 static int tsl2563_write_raw(struct iio_dev *indio_dev,
 461                                struct iio_chan_spec const *chan,
 462                                int val,
 463                                int val2,
 464                                long mask)
 465 {
 466         struct tsl2563_chip *chip = iio_priv(indio_dev);
 467
 468         if (chan->channel == IIO_MOD_LIGHT_BOTH)
 469                 chip->calib0 = calib_from_sysfs(val);
 470         else
 471                 chip->calib1 = calib_from_sysfs(val);
 472
 473         return 0;
 474 }
 475
 476 static int tsl2563_read_raw(struct iio_dev *indio_dev,
 477                             struct iio_chan_spec const *chan,
 478                             int *val,
 479                             int *val2,
 480                             long m)
 481 {
 482         int ret = -EINVAL;
 483         u32 calib0, calib1;
 484         struct tsl2563_chip *chip = iio_priv(indio_dev);
 485
 486         mutex_lock(&chip->lock);
 487         switch (m) {
 488         case IIO_CHAN_INFO_RAW:
 489         case IIO_CHAN_INFO_PROCESSED:
 490                 switch (chan->type) {
 491                 case IIO_LIGHT:
 492                         ret = tsl2563_get_adc(chip);
 493                         if (ret)
 494                                 goto error_ret;
 495                         calib0 = calib_adc(chip->data0, chip->calib0) *
 496                                 chip->cover_comp_gain;
 497                         calib1 = calib_adc(chip->data1, chip->calib1) *
 498                                 chip->cover_comp_gain;
 499                         *val = adc_to_lux(calib0, calib1);
 500                         ret = IIO_VAL_INT;
 501                         break;
 502                 case IIO_INTENSITY:
 503                         ret = tsl2563_get_adc(chip);
 504                         if (ret)
 505                                 goto error_ret;
 506                         if (chan->channel == 0)
 507                                 *val = chip->data0;
 508                         else
 509                                 *val = chip->data1;
 510                         ret = IIO_VAL_INT;
 511                         break;
 512                 default:
 513                         break;
 514                 }
 515                 break;
 516
 517         case IIO_CHAN_INFO_CALIBSCALE:
 518                 if (chan->channel == 0)
 519                         *val = calib_to_sysfs(chip->calib0);
 520                 else
 521                         *val = calib_to_sysfs(chip->calib1);
 522                 ret = IIO_VAL_INT;
 523                 break;
 524         default:
 525                 ret = -EINVAL;
 526                 goto error_ret;
 527         }
 528
 529 error_ret:
 530         mutex_unlock(&chip->lock);
 531         return ret;
 532 }
 533
 534 static const struct iio_chan_spec tsl2563_channels[] = {
 535         {
 536                 .type = IIO_LIGHT,
 537                 .indexed = 1,
 538                 .info_mask = IIO_CHAN_INFO_PROCESSED_SEPARATE_BIT,
 539                 .channel = 0,
 540         }, {
 541                 .type = IIO_INTENSITY,
 542                 .modified = 1,
 543                 .channel2 = IIO_MOD_LIGHT_BOTH,
 544                 .info_mask = IIO_CHAN_INFO_RAW_SEPARATE_BIT |
 545                 IIO_CHAN_INFO_CALIBSCALE_SEPARATE_BIT,
 546                 .event_mask = (IIO_EV_BIT(IIO_EV_TYPE_THRESH,
 547                                           IIO_EV_DIR_RISING) |
 548                                IIO_EV_BIT(IIO_EV_TYPE_THRESH,
 549                                           IIO_EV_DIR_FALLING)),
 550         }, {
 551                 .type = IIO_INTENSITY,
 552                 .modified = 1,
 553                 .channel2 = IIO_MOD_LIGHT_IR,
 554                 .info_mask = IIO_CHAN_INFO_RAW_SEPARATE_BIT |
 555                 IIO_CHAN_INFO_CALIBSCALE_SEPARATE_BIT,
 556         }
 557 };
 558
 559 static int tsl2563_read_thresh(struct iio_dev *indio_dev,
 560                                u64 event_code,
 561                                int *val)
 562 {
 563         struct tsl2563_chip *chip = iio_priv(indio_dev);
 564
 565         switch (IIO_EVENT_CODE_EXTRACT_DIR(event_code)) {
 566         case IIO_EV_DIR_RISING:
 567                 *val = chip->high_thres;
 568                 break;
 569         case IIO_EV_DIR_FALLING:
 570                 *val = chip->low_thres;
 571                 break;
 572         default:
 573                 return -EINVAL;
 574         }
 575
 576         return 0;
 577 }
 578
 579 static int tsl2563_write_thresh(struct iio_dev *indio_dev,
 580                                   u64 event_code,
 581                                   int val)
 582 {
 583         struct tsl2563_chip *chip = iio_priv(indio_dev);
 584         int ret;
 585         u8 address;
 586
 587         if (IIO_EVENT_CODE_EXTRACT_DIR(event_code) == IIO_EV_DIR_RISING)
 588                 address = TSL2563_REG_HIGHLOW;
 589         else
 590                 address = TSL2563_REG_LOWLOW;
 591         mutex_lock(&chip->lock);
 592         ret = i2c_smbus_write_byte_data(chip->client, TSL2563_CMD | address,
 593                                         val & 0xFF);
 594         if (ret)
 595                 goto error_ret;
 596         ret = i2c_smbus_write_byte_data(chip->client,
 597                                         TSL2563_CMD | (address + 1),
 598                                         (val >> 8) & 0xFF);
 599         if (IIO_EVENT_CODE_EXTRACT_DIR(event_code) == IIO_EV_DIR_RISING)
 600                 chip->high_thres = val;
 601         else
 602                 chip->low_thres = val;
 603
 604 error_ret:
 605         mutex_unlock(&chip->lock);
 606
 607         return ret;
 608 }
 609
 610 static irqreturn_t tsl2563_event_handler(int irq, void *private)
 611 {
 612         struct iio_dev *dev_info = private;
 613         struct tsl2563_chip *chip = iio_priv(dev_info);
 614
 615         iio_push_event(dev_info,
 616                        IIO_UNMOD_EVENT_CODE(IIO_LIGHT,
 617                                             0,
 618                                             IIO_EV_TYPE_THRESH,
 619                                             IIO_EV_DIR_EITHER),
 620                        iio_get_time_ns());
 621
 622         /* clear the interrupt and push the event */
 623         i2c_smbus_write_byte(chip->client, TSL2563_CMD | TSL2563_CLEARINT);
 624         return IRQ_HANDLED;
 625 }
 626
 627 static int tsl2563_write_interrupt_config(struct iio_dev *indio_dev,
 628                                           u64 event_code,
 629                                           int state)
 630 {
 631         struct tsl2563_chip *chip = iio_priv(indio_dev);
 632         int ret = 0;
 633
 634         mutex_lock(&chip->lock);
 635         if (state && !(chip->intr & 0x30)) {
 636                 chip->intr &= ~0x30;
 637                 chip->intr |= 0x10;
 638                 /* ensure the chip is actually on */
 639                 cancel_delayed_work(&chip->poweroff_work);
 640                 if (!tsl2563_get_power(chip)) {
 641                         ret = tsl2563_set_power(chip, 1);
 642                         if (ret)
 643                                 goto out;
 644                         ret = tsl2563_configure(chip);
 645                         if (ret)
 646                                 goto out;
 647                 }
 648                 ret = i2c_smbus_write_byte_data(chip->client,
 649                                                 TSL2563_CMD | TSL2563_REG_INT,
 650                                                 chip->intr);
 651                 chip->int_enabled = true;
 652         }
 653
 654         if (!state && (chip->intr & 0x30)) {
 655                 chip->intr |= ~0x30;
 656                 ret = i2c_smbus_write_byte_data(chip->client,
 657                                                 TSL2563_CMD | TSL2563_REG_INT,
 658                                                 chip->intr);
 659                 chip->int_enabled = false;
 660                 /* now the interrupt is not enabled, we can go to sleep */
 661                 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
 662         }
 663 out:
 664         mutex_unlock(&chip->lock);
 665
 666         return ret;
 667 }
 668
 669 static int tsl2563_read_interrupt_config(struct iio_dev *indio_dev,
 670                                          u64 event_code)
 671 {
 672         struct tsl2563_chip *chip = iio_priv(indio_dev);
 673         int ret;
 674
 675         mutex_lock(&chip->lock);
 676         ret = i2c_smbus_read_byte_data(chip->client,
 677                                        TSL2563_CMD | TSL2563_REG_INT);
 678         mutex_unlock(&chip->lock);
 679         if (ret < 0)
 680                 goto error_ret;
 681         ret = !!(ret & 0x30);
 682 error_ret:
 683
 684         return ret;
 685 }
 686
 687 /*--------------------------------------------------------------*/
 688 /*                      Probe, Attach, Remove                   */
 689 /*--------------------------------------------------------------*/
 690 static struct i2c_driver tsl2563_i2c_driver;
 691
 692 static const struct iio_info tsl2563_info_no_irq = {
 693         .driver_module = THIS_MODULE,
 694         .read_raw = &tsl2563_read_raw,
 695         .write_raw = &tsl2563_write_raw,
 696 };
 697
 698 static const struct iio_info tsl2563_info = {
 699         .driver_module = THIS_MODULE,
 700         .read_raw = &tsl2563_read_raw,
 701         .write_raw = &tsl2563_write_raw,
 702         .read_event_value = &tsl2563_read_thresh,
 703         .write_event_value = &tsl2563_write_thresh,
 704         .read_event_config = &tsl2563_read_interrupt_config,
 705         .write_event_config = &tsl2563_write_interrupt_config,
 706 };
 707
 708 static int __devinit tsl2563_probe(struct i2c_client *client,
 709                                 const struct i2c_device_id *device_id)
 710 {
 711         struct iio_dev *indio_dev;
 712         struct tsl2563_chip *chip;
 713         struct tsl2563_platform_data *pdata = client->dev.platform_data;
 714         int err = 0;
 715         u8 id = 0;
 716
 717         indio_dev = iio_device_alloc(sizeof(*chip));
 718         if (!indio_dev)
 719                 return -ENOMEM;
 720
 721         chip = iio_priv(indio_dev);
 722
 723         i2c_set_clientdata(client, chip);
 724         chip->client = client;
 725
 726         err = tsl2563_detect(chip);
 727         if (err) {
 728                 dev_err(&client->dev, "detect error %d\n", -err);
 729                 goto fail1;
 730         }
 731
 732         err = tsl2563_read_id(chip, &id);
 733         if (err) {
 734                 dev_err(&client->dev, "read id error %d\n", -err);
 735                 goto fail1;
 736         }
 737
 738         mutex_init(&chip->lock);
 739
 740         /* Default values used until userspace says otherwise */
 741         chip->low_thres = 0x0;
 742         chip->high_thres = 0xffff;
 743         chip->gainlevel = tsl2563_gainlevel_table;
 744         chip->intr = TSL2563_INT_PERSIST(4);
 745         chip->calib0 = calib_from_sysfs(CALIB_BASE_SYSFS);
 746         chip->calib1 = calib_from_sysfs(CALIB_BASE_SYSFS);
 747
 748         if (pdata)
 749                 chip->cover_comp_gain = pdata->cover_comp_gain;
 750         else
 751                 chip->cover_comp_gain = 1;
 752
 753         dev_info(&client->dev, "model %d, rev. %d\n", id >> 4, id & 0x0f);
 754         indio_dev->name = client->name;
 755         indio_dev->channels = tsl2563_channels;
 756         indio_dev->num_channels = ARRAY_SIZE(tsl2563_channels);
 757         indio_dev->dev.parent = &client->dev;
 758         indio_dev->modes = INDIO_DIRECT_MODE;
 759
 760         if (client->irq)
 761                 indio_dev->info = &tsl2563_info;
 762         else
 763                 indio_dev->info = &tsl2563_info_no_irq;
 764
 765         if (client->irq) {
 766                 err = request_threaded_irq(client->irq,
 767                                            NULL,
 768                                            &tsl2563_event_handler,
 769                                            IRQF_TRIGGER_RISING | IRQF_ONESHOT,
 770                                            "tsl2563_event",
 771                                            indio_dev);
 772                 if (err) {
 773                         dev_err(&client->dev, "irq request error %d\n", -err);
 774                         goto fail1;
 775                 }
 776         }
 777
 778         err = tsl2563_configure(chip);
 779         if (err) {
 780                 dev_err(&client->dev, "configure error %d\n", -err);
 781                 goto fail2;
 782         }
 783
 784         INIT_DELAYED_WORK(&chip->poweroff_work, tsl2563_poweroff_work);
 785
 786         /* The interrupt cannot yet be enabled so this is fine without lock */
 787         schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
 788
 789         err = iio_device_register(indio_dev);
 790         if (err) {
 791                 dev_err(&client->dev, "iio registration error %d\n", -err);
 792                 goto fail3;
 793         }
 794
 795         return 0;
 796
 797 fail3:
 798         cancel_delayed_work(&chip->poweroff_work);
 799         flush_scheduled_work();
 800 fail2:
 801         if (client->irq)
 802                 free_irq(client->irq, indio_dev);
 803 fail1:
 804         iio_device_free(indio_dev);
 805         return err;
 806 }
 807
 808 static int tsl2563_remove(struct i2c_client *client)
 809 {
 810         struct tsl2563_chip *chip = i2c_get_clientdata(client);
 811         struct iio_dev *indio_dev = iio_priv_to_dev(chip);
 812
 813         iio_device_unregister(indio_dev);
 814         if (!chip->int_enabled)
 815                 cancel_delayed_work(&chip->poweroff_work);
 816         /* Ensure that interrupts are disabled - then flush any bottom halves */
 817         chip->intr |= ~0x30;
 818         i2c_smbus_write_byte_data(chip->client, TSL2563_CMD | TSL2563_REG_INT,
 819                                   chip->intr);
 820         flush_scheduled_work();
 821         tsl2563_set_power(chip, 0);
 822         if (client->irq)
 823                 free_irq(client->irq, indio_dev);
 824
 825         iio_device_free(indio_dev);
 826
 827         return 0;
 828 }
 829
 830 #ifdef CONFIG_PM_SLEEP
 831 static int tsl2563_suspend(struct device *dev)
 832 {
 833         struct tsl2563_chip *chip = i2c_get_clientdata(to_i2c_client(dev));
 834         int ret;
 835
 836         mutex_lock(&chip->lock);
 837
 838         ret = tsl2563_set_power(chip, 0);
 839         if (ret)
 840                 goto out;
 841
 842         chip->suspended = true;
 843
 844 out:
 845         mutex_unlock(&chip->lock);
 846         return ret;
 847 }
 848
 849 static int tsl2563_resume(struct device *dev)
 850 {
 851         struct tsl2563_chip *chip = i2c_get_clientdata(to_i2c_client(dev));
 852         int ret;
 853
 854         mutex_lock(&chip->lock);
 855
 856         ret = tsl2563_set_power(chip, 1);
 857         if (ret)
 858                 goto out;
 859
 860         ret = tsl2563_configure(chip);
 861         if (ret)
 862                 goto out;
 863
 864         chip->suspended = false;
 865
 866 out:
 867         mutex_unlock(&chip->lock);
 868         return ret;
 869 }
 870
 871 static SIMPLE_DEV_PM_OPS(tsl2563_pm_ops, tsl2563_suspend, tsl2563_resume);
 872 #define TSL2563_PM_OPS (&tsl2563_pm_ops)
 873 #else
 874 #define TSL2563_PM_OPS NULL
 875 #endif
 876
 877 static const struct i2c_device_id tsl2563_id[] = {
 878         { "tsl2560", 0 },
 879         { "tsl2561", 1 },
 880         { "tsl2562", 2 },
 881         { "tsl2563", 3 },
 882         {}
 883 };
 884 MODULE_DEVICE_TABLE(i2c, tsl2563_id);
 885
 886 static struct i2c_driver tsl2563_i2c_driver = {
 887         .driver = {
 888                 .name    = "tsl2563",
 889                 .pm     = TSL2563_PM_OPS,
 890         },
 891         .probe          = tsl2563_probe,
 892         .remove         = __devexit_p(tsl2563_remove),
 893         .id_table       = tsl2563_id,
 894 };
 895 module_i2c_driver(tsl2563_i2c_driver);
 896
 897 MODULE_AUTHOR("Nokia Corporation");
 898 MODULE_DESCRIPTION("tsl2563 light sensor driver");
 899 MODULE_LICENSE("GPL");