drivers/iio/light/tsl2563.c

   1 /*
   2  * drivers/iio/light/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 <linux/platform_data/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 /*
 194  * Interrupt register is automatically written anyway if it is relevant
 195  * so is not here.
 196  */
 197 error_ret:
 198         return ret;
 199 }
 200
 201 static void tsl2563_poweroff_work(struct work_struct *work)
 202 {
 203         struct tsl2563_chip *chip =
 204                 container_of(work, struct tsl2563_chip, poweroff_work.work);
 205         tsl2563_set_power(chip, 0);
 206 }
 207
 208 static int tsl2563_detect(struct tsl2563_chip *chip)
 209 {
 210         int ret;
 211
 212         ret = tsl2563_set_power(chip, 1);
 213         if (ret)
 214                 return ret;
 215
 216         ret = tsl2563_get_power(chip);
 217         if (ret < 0)
 218                 return ret;
 219
 220         return ret ? 0 : -ENODEV;
 221 }
 222
 223 static int tsl2563_read_id(struct tsl2563_chip *chip, u8 *id)
 224 {
 225         struct i2c_client *client = chip->client;
 226         int ret;
 227
 228         ret = i2c_smbus_read_byte_data(client, TSL2563_CMD | TSL2563_REG_ID);
 229         if (ret < 0)
 230                 return ret;
 231
 232         *id = ret;
 233
 234         return 0;
 235 }
 236
 237 /*
 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.
 242  */
 243 static int adc_shiftbits(u8 timing)
 244 {
 245         int shift = 0;
 246
 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;
 257         }
 258
 259         if (!(timing & TSL2563_TIMING_GAIN16))
 260                 shift += 4;
 261
 262         return shift;
 263 }
 264
 265 /* Convert a HW ADC value to normalized scale. */
 266 static u32 normalize_adc(u16 adc, u8 timing)
 267 {
 268         return adc << adc_shiftbits(timing);
 269 }
 270
 271 static void tsl2563_wait_adc(struct tsl2563_chip *chip)
 272 {
 273         unsigned int delay;
 274
 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;
 284         }
 285         /*
 286          * TODO: Make sure that we wait at least required delay but why we
 287          * have to extend it one tick more?
 288          */
 289         schedule_timeout_interruptible(msecs_to_jiffies(delay) + 2);
 290 }
 291
 292 static int tsl2563_adjust_gainlevel(struct tsl2563_chip *chip, u16 adc)
 293 {
 294         struct i2c_client *client = chip->client;
 295
 296         if (adc > chip->gainlevel->max || adc < chip->gainlevel->min) {
 297
 298                 (adc > chip->gainlevel->max) ?
 299                         chip->gainlevel++ : chip->gainlevel--;
 300
 301                 i2c_smbus_write_byte_data(client,
 302                                           TSL2563_CMD | TSL2563_REG_TIMING,
 303                                           chip->gainlevel->gaintime);
 304
 305                 tsl2563_wait_adc(chip);
 306                 tsl2563_wait_adc(chip);
 307
 308                 return 1;
 309         } else
 310                 return 0;
 311 }
 312
 313 static int tsl2563_get_adc(struct tsl2563_chip *chip)
 314 {
 315         struct i2c_client *client = chip->client;
 316         u16 adc0, adc1;
 317         int retry = 1;
 318         int ret = 0;
 319
 320         if (chip->suspended)
 321                 goto out;
 322
 323         if (!chip->int_enabled) {
 324                 cancel_delayed_work(&chip->poweroff_work);
 325
 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);
 334                 }
 335         }
 336
 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;
 343
 344                 ret = i2c_smbus_read_word_data(client,
 345                                 TSL2563_CMD | TSL2563_REG_DATA1LOW);
 346                 if (ret < 0)
 347                         goto out;
 348                 adc1 = ret;
 349
 350                 retry = tsl2563_adjust_gainlevel(chip, adc0);
 351         }
 352
 353         chip->data0 = normalize_adc(adc0, chip->gainlevel->gaintime);
 354         chip->data1 = normalize_adc(adc1, chip->gainlevel->gaintime);
 355
 356         if (!chip->int_enabled)
 357                 schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
 358
 359         ret = 0;
 360 out:
 361         return ret;
 362 }
 363
 364 static inline int calib_to_sysfs(u32 calib)
 365 {
 366         return (int) (((calib * CALIB_BASE_SYSFS) +
 367                        CALIB_FRAC_HALF) >> CALIB_FRAC_BITS);
 368 }
 369
 370 static inline u32 calib_from_sysfs(int value)
 371 {
 372         return (((u32) value) << CALIB_FRAC_BITS) / CALIB_BASE_SYSFS;
 373 }
 374
 375 /*
 376  * Conversions between lux and ADC values.
 377  *
 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.
 384  */
 385
 386 struct tsl2563_lux_coeff {
 387         unsigned long ch_ratio;
 388         unsigned long ch0_coeff;
 389         unsigned long ch1_coeff;
 390 };
 391
 392 static const struct tsl2563_lux_coeff lux_table[] = {
 393         {
 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,
 425         },
 426 };
 427
 428 /* Convert normalized, scaled ADC values to lux. */
 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 /* Apply calibration coefficient to ADC count. */
 445 static u32 calib_adc(u32 adc, u32 calib)
 446 {
 447         unsigned long scaled = adc;
 448
 449         scaled *= calib;
 450         scaled >>= CALIB_FRAC_BITS;
 451
 452         return (u32) scaled;
 453 }
 454
 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)
 460 {
 461         struct tsl2563_chip *chip = iio_priv(indio_dev);
 462
 463         if (mask != IIO_CHAN_INFO_CALIBSCALE)
 464                 return -EINVAL;
 465         if (chan->channel2 == IIO_MOD_LIGHT_BOTH)
 466                 chip->calib0 = calib_from_sysfs(val);
 467         else if (chan->channel2 == IIO_MOD_LIGHT_IR)
 468                 chip->calib1 = calib_from_sysfs(val);
 469         else
 470                 return -EINVAL;
 471
 472         return 0;
 473 }
 474
 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)
 480 {
 481         int ret = -EINVAL;
 482         u32 calib0, calib1;
 483         struct tsl2563_chip *chip = iio_priv(indio_dev);
 484
 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 = calib_adc(chip->data0, chip->calib0) *
 495                                 chip->cover_comp_gain;
 496                         calib1 = calib_adc(chip->data1, chip->calib1) *
 497                                 chip->cover_comp_gain;
 498                         *val = 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;
 513                 }
 514                 break;
 515
 516         case IIO_CHAN_INFO_CALIBSCALE:
 517                 if (chan->channel2 == IIO_MOD_LIGHT_BOTH)
 518                         *val = calib_to_sysfs(chip->calib0);
 519                 else
 520                         *val = calib_to_sysfs(chip->calib1);
 521                 ret = IIO_VAL_INT;
 522                 break;
 523         default:
 524                 ret = -EINVAL;
 525                 goto error_ret;
 526         }
 527
 528 error_ret:
 529         mutex_unlock(&chip->lock);
 530         return ret;
 531 }
 532
 533 static const struct iio_event_spec tsl2563_events[] = {
 534         {
 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),
 544         },
 545 };
 546
 547 static const struct iio_chan_spec tsl2563_channels[] = {
 548         {
 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),
 567         }
 568 };
 569
 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)
 574 {
 575         struct tsl2563_chip *chip = iio_priv(indio_dev);
 576
 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;
 586         }
 587
 588         return IIO_VAL_INT;
 589 }
 590
 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)
 595 {
 596         struct tsl2563_chip *chip = iio_priv(indio_dev);
 597         int ret;
 598         u8 address;
 599
 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;
 616
 617 error_ret:
 618         mutex_unlock(&chip->lock);
 619
 620         return ret;
 621 }
 622
 623 static irqreturn_t tsl2563_event_handler(int irq, void *private)
 624 {
 625         struct iio_dev *dev_info = private;
 626         struct tsl2563_chip *chip = iio_priv(dev_info);
 627
 628         iio_push_event(dev_info,
 629                        IIO_UNMOD_EVENT_CODE(IIO_LIGHT,
 630                                             0,
 631                                             IIO_EV_TYPE_THRESH,
 632                                             IIO_EV_DIR_EITHER),
 633                        iio_get_time_ns());
 634
 635         /* clear the interrupt and push the event */
 636         i2c_smbus_write_byte(chip->client, TSL2563_CMD | TSL2563_CLEARINT);
 637         return IRQ_HANDLED;
 638 }
 639
 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)
 643 {
 644         struct tsl2563_chip *chip = iio_priv(indio_dev);
 645         int ret = 0;
 646
 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;
 660                 }
 661                 ret = i2c_smbus_write_byte_data(chip->client,
 662                                                 TSL2563_CMD | TSL2563_REG_INT,
 663                                                 chip->intr);
 664                 chip->int_enabled = true;
 665         }
 666
 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);
 675         }
 676 out:
 677         mutex_unlock(&chip->lock);
 678
 679         return ret;
 680 }
 681
 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)
 685 {
 686         struct tsl2563_chip *chip = iio_priv(indio_dev);
 687         int ret;
 688
 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;
 695
 696         return !!(ret & 0x30);
 697 }
 698
 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,
 703 };
 704
 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,
 713 };
 714
 715 static int tsl2563_probe(struct i2c_client *client,
 716                                 const struct i2c_device_id *device_id)
 717 {
 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;
 724
 725         indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*chip));
 726         if (!indio_dev)
 727                 return -ENOMEM;
 728
 729         chip = iio_priv(indio_dev);
 730
 731         i2c_set_clientdata(client, chip);
 732         chip->client = client;
 733
 734         err = tsl2563_detect(chip);
 735         if (err) {
 736                 dev_err(&client->dev, "detect error %d\n", -err);
 737                 return err;
 738         }
 739
 740         err = tsl2563_read_id(chip, &id);
 741         if (err) {
 742                 dev_err(&client->dev, "read id error %d\n", -err);
 743                 return err;
 744         }
 745
 746         mutex_init(&chip->lock);
 747
 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 = calib_from_sysfs(CALIB_BASE_SYSFS);
 754         chip->calib1 = calib_from_sysfs(CALIB_BASE_SYSFS);
 755
 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;
 763
 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;
 770
 771         if (client->irq)
 772                 indio_dev->info = &tsl2563_info;
 773         else
 774                 indio_dev->info = &tsl2563_info_no_irq;
 775
 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;
 786                 }
 787         }
 788
 789         err = tsl2563_configure(chip);
 790         if (err) {
 791                 dev_err(&client->dev, "configure error %d\n", -err);
 792                 return err;
 793         }
 794
 795         INIT_DELAYED_WORK(&chip->poweroff_work, tsl2563_poweroff_work);
 796
 797         /* The interrupt cannot yet be enabled so this is fine without lock */
 798         schedule_delayed_work(&chip->poweroff_work, 5 * HZ);
 799
 800         err = iio_device_register(indio_dev);
 801         if (err) {
 802                 dev_err(&client->dev, "iio registration error %d\n", -err);
 803                 goto fail;
 804         }
 805
 806         return 0;
 807
 808 fail:
 809         cancel_delayed_work(&chip->poweroff_work);
 810         flush_scheduled_work();
 811         return err;
 812 }
 813
 814 static int tsl2563_remove(struct i2c_client *client)
 815 {
 816         struct tsl2563_chip *chip = i2c_get_clientdata(client);
 817         struct iio_dev *indio_dev = iio_priv_to_dev(chip);
 818
 819         iio_device_unregister(indio_dev);
 820         if (!chip->int_enabled)
 821                 cancel_delayed_work(&chip->poweroff_work);
 822         /* Ensure that interrupts are disabled - then flush any bottom halves */
 823         chip->intr &= ~0x30;
 824         i2c_smbus_write_byte_data(chip->client, TSL2563_CMD | TSL2563_REG_INT,
 825                                   chip->intr);
 826         flush_scheduled_work();
 827         tsl2563_set_power(chip, 0);
 828
 829         return 0;
 830 }
 831
 832 #ifdef CONFIG_PM_SLEEP
 833 static int tsl2563_suspend(struct device *dev)
 834 {
 835         struct tsl2563_chip *chip = i2c_get_clientdata(to_i2c_client(dev));
 836         int ret;
 837
 838         mutex_lock(&chip->lock);
 839
 840         ret = tsl2563_set_power(chip, 0);
 841         if (ret)
 842                 goto out;
 843
 844         chip->suspended = true;
 845
 846 out:
 847         mutex_unlock(&chip->lock);
 848         return ret;
 849 }
 850
 851 static int tsl2563_resume(struct device *dev)
 852 {
 853         struct tsl2563_chip *chip = i2c_get_clientdata(to_i2c_client(dev));
 854         int ret;
 855
 856         mutex_lock(&chip->lock);
 857
 858         ret = tsl2563_set_power(chip, 1);
 859         if (ret)
 860                 goto out;
 861
 862         ret = tsl2563_configure(chip);
 863         if (ret)
 864                 goto out;
 865
 866         chip->suspended = false;
 867
 868 out:
 869         mutex_unlock(&chip->lock);
 870         return ret;
 871 }
 872
 873 static SIMPLE_DEV_PM_OPS(tsl2563_pm_ops, tsl2563_suspend, tsl2563_resume);
 874 #define TSL2563_PM_OPS (&tsl2563_pm_ops)
 875 #else
 876 #define TSL2563_PM_OPS NULL
 877 #endif
 878
 879 static const struct i2c_device_id tsl2563_id[] = {
 880         { "tsl2560", 0 },
 881         { "tsl2561", 1 },
 882         { "tsl2562", 2 },
 883         { "tsl2563", 3 },
 884         {}
 885 };
 886 MODULE_DEVICE_TABLE(i2c, tsl2563_id);
 887
 888 static struct i2c_driver tsl2563_i2c_driver = {
 889         .driver = {
 890                 .name    = "tsl2563",
 891                 .pm     = TSL2563_PM_OPS,
 892         },
 893         .probe          = tsl2563_probe,
 894         .remove         = tsl2563_remove,
 895         .id_table       = tsl2563_id,
 896 };
 897 module_i2c_driver(tsl2563_i2c_driver);
 898
 899 MODULE_AUTHOR("Nokia Corporation");
 900 MODULE_DESCRIPTION("tsl2563 light sensor driver");
 901 MODULE_LICENSE("GPL");