1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * apds9960.c - Support for Avago APDS9960 gesture/RGB/ALS/proximity sensor 4 * 5 * Copyright (C) 2015, 2018 6 * Author: Matt Ranostay <matt.ranostay@konsulko.com> 7 * 8 * TODO: gesture + proximity calib offsets 9 */ 10 11 #include <linux/module.h> 12 #include <linux/init.h> 13 #include <linux/interrupt.h> 14 #include <linux/delay.h> 15 #include <linux/mutex.h> 16 #include <linux/err.h> 17 #include <linux/irq.h> 18 #include <linux/gpio.h> 19 #include <linux/i2c.h> 20 #include <linux/pm_runtime.h> 21 #include <linux/regmap.h> 22 #include <linux/iio/iio.h> 23 #include <linux/iio/buffer.h> 24 #include <linux/iio/events.h> 25 #include <linux/iio/kfifo_buf.h> 26 #include <linux/iio/sysfs.h> 27 #include <linux/of_gpio.h> 28 29 #define APDS9960_REGMAP_NAME "apds9960_regmap" 30 #define APDS9960_DRV_NAME "apds9960" 31 32 #define APDS9960_REG_RAM_START 0x00 33 #define APDS9960_REG_RAM_END 0x7f 34 35 #define APDS9960_REG_ENABLE 0x80 36 #define APDS9960_REG_ATIME 0x81 37 #define APDS9960_REG_WTIME 0x83 38 39 #define APDS9960_REG_AILTL 0x84 40 #define APDS9960_REG_AILTH 0x85 41 #define APDS9960_REG_AIHTL 0x86 42 #define APDS9960_REG_AIHTH 0x87 43 44 #define APDS9960_REG_PILT 0x89 45 #define APDS9960_REG_PIHT 0x8b 46 #define APDS9960_REG_PERS 0x8c 47 48 #define APDS9960_REG_CONFIG_1 0x8d 49 #define APDS9960_REG_PPULSE 0x8e 50 51 #define APDS9960_REG_CONTROL 0x8f 52 #define APDS9960_REG_CONTROL_AGAIN_MASK 0x03 53 #define APDS9960_REG_CONTROL_PGAIN_MASK 0x0c 54 #define APDS9960_REG_CONTROL_AGAIN_MASK_SHIFT 0 55 #define APDS9960_REG_CONTROL_PGAIN_MASK_SHIFT 2 56 57 #define APDS9960_REG_CONFIG_2 0x90 58 #define APDS9960_REG_CONFIG_2_GGAIN_MASK 0x60 59 #define APDS9960_REG_CONFIG_2_GGAIN_MASK_SHIFT 5 60 61 #define APDS9960_REG_ID 0x92 62 63 #define APDS9960_REG_STATUS 0x93 64 #define APDS9960_REG_STATUS_PS_INT BIT(5) 65 #define APDS9960_REG_STATUS_ALS_INT BIT(4) 66 #define APDS9960_REG_STATUS_GINT BIT(2) 67 68 #define APDS9960_REG_PDATA 0x9c 69 #define APDS9960_REG_POFFSET_UR 0x9d 70 #define APDS9960_REG_POFFSET_DL 0x9e 71 #define APDS9960_REG_CONFIG_3 0x9f 72 73 #define APDS9960_REG_GPENTH 0xa0 74 #define APDS9960_REG_GEXTH 0xa1 75 76 #define APDS9960_REG_GCONF_1 0xa2 77 #define APDS9960_REG_GCONF_1_GFIFO_THRES_MASK 0xc0 78 #define APDS9960_REG_GCONF_1_GFIFO_THRES_MASK_SHIFT 6 79 80 #define APDS9960_REG_GCONF_2 0xa3 81 #define APDS9960_REG_GOFFSET_U 0xa4 82 #define APDS9960_REG_GOFFSET_D 0xa5 83 #define APDS9960_REG_GPULSE 0xa6 84 #define APDS9960_REG_GOFFSET_L 0xa7 85 #define APDS9960_REG_GOFFSET_R 0xa9 86 #define APDS9960_REG_GCONF_3 0xaa 87 88 #define APDS9960_REG_GCONF_4 0xab 89 #define APDS9960_REG_GFLVL 0xae 90 #define APDS9960_REG_GSTATUS 0xaf 91 92 #define APDS9960_REG_IFORCE 0xe4 93 #define APDS9960_REG_PICLEAR 0xe5 94 #define APDS9960_REG_CICLEAR 0xe6 95 #define APDS9960_REG_AICLEAR 0xe7 96 97 #define APDS9960_DEFAULT_PERS 0x33 98 #define APDS9960_DEFAULT_GPENTH 0x50 99 #define APDS9960_DEFAULT_GEXTH 0x40 100 101 #define APDS9960_MAX_PXS_THRES_VAL 255 102 #define APDS9960_MAX_ALS_THRES_VAL 0xffff 103 #define APDS9960_MAX_INT_TIME_IN_US 1000000 104 105 enum apds9960_als_channel_idx { 106 IDX_ALS_CLEAR, IDX_ALS_RED, IDX_ALS_GREEN, IDX_ALS_BLUE, 107 }; 108 109 #define APDS9960_REG_ALS_BASE 0x94 110 #define APDS9960_REG_ALS_CHANNEL(_colour) \ 111 (APDS9960_REG_ALS_BASE + (IDX_ALS_##_colour * 2)) 112 113 enum apds9960_gesture_channel_idx { 114 IDX_DIR_UP, IDX_DIR_DOWN, IDX_DIR_LEFT, IDX_DIR_RIGHT, 115 }; 116 117 #define APDS9960_REG_GFIFO_BASE 0xfc 118 #define APDS9960_REG_GFIFO_DIR(_dir) \ 119 (APDS9960_REG_GFIFO_BASE + IDX_DIR_##_dir) 120 121 struct apds9960_data { 122 struct i2c_client *client; 123 struct iio_dev *indio_dev; 124 struct mutex lock; 125 126 /* regmap fields */ 127 struct regmap *regmap; 128 struct regmap_field *reg_int_als; 129 struct regmap_field *reg_int_ges; 130 struct regmap_field *reg_int_pxs; 131 132 struct regmap_field *reg_enable_als; 133 struct regmap_field *reg_enable_ges; 134 struct regmap_field *reg_enable_pxs; 135 136 /* state */ 137 int als_int; 138 int pxs_int; 139 int gesture_mode_running; 140 141 /* gain values */ 142 int als_gain; 143 int pxs_gain; 144 145 /* integration time value in us */ 146 int als_adc_int_us; 147 148 /* gesture buffer */ 149 u8 buffer[4]; /* 4 8-bit channels */ 150 }; 151 152 static const struct reg_default apds9960_reg_defaults[] = { 153 /* Default ALS integration time = 2.48ms */ 154 { APDS9960_REG_ATIME, 0xff }, 155 }; 156 157 static const struct regmap_range apds9960_volatile_ranges[] = { 158 regmap_reg_range(APDS9960_REG_STATUS, 159 APDS9960_REG_PDATA), 160 regmap_reg_range(APDS9960_REG_GFLVL, 161 APDS9960_REG_GSTATUS), 162 regmap_reg_range(APDS9960_REG_GFIFO_DIR(UP), 163 APDS9960_REG_GFIFO_DIR(RIGHT)), 164 regmap_reg_range(APDS9960_REG_IFORCE, 165 APDS9960_REG_AICLEAR), 166 }; 167 168 static const struct regmap_access_table apds9960_volatile_table = { 169 .yes_ranges = apds9960_volatile_ranges, 170 .n_yes_ranges = ARRAY_SIZE(apds9960_volatile_ranges), 171 }; 172 173 static const struct regmap_range apds9960_precious_ranges[] = { 174 regmap_reg_range(APDS9960_REG_RAM_START, APDS9960_REG_RAM_END), 175 }; 176 177 static const struct regmap_access_table apds9960_precious_table = { 178 .yes_ranges = apds9960_precious_ranges, 179 .n_yes_ranges = ARRAY_SIZE(apds9960_precious_ranges), 180 }; 181 182 static const struct regmap_range apds9960_readable_ranges[] = { 183 regmap_reg_range(APDS9960_REG_ENABLE, 184 APDS9960_REG_GSTATUS), 185 regmap_reg_range(APDS9960_REG_GFIFO_DIR(UP), 186 APDS9960_REG_GFIFO_DIR(RIGHT)), 187 }; 188 189 static const struct regmap_access_table apds9960_readable_table = { 190 .yes_ranges = apds9960_readable_ranges, 191 .n_yes_ranges = ARRAY_SIZE(apds9960_readable_ranges), 192 }; 193 194 static const struct regmap_range apds9960_writeable_ranges[] = { 195 regmap_reg_range(APDS9960_REG_ENABLE, APDS9960_REG_CONFIG_2), 196 regmap_reg_range(APDS9960_REG_POFFSET_UR, APDS9960_REG_GCONF_4), 197 regmap_reg_range(APDS9960_REG_IFORCE, APDS9960_REG_AICLEAR), 198 }; 199 200 static const struct regmap_access_table apds9960_writeable_table = { 201 .yes_ranges = apds9960_writeable_ranges, 202 .n_yes_ranges = ARRAY_SIZE(apds9960_writeable_ranges), 203 }; 204 205 static const struct regmap_config apds9960_regmap_config = { 206 .name = APDS9960_REGMAP_NAME, 207 .reg_bits = 8, 208 .val_bits = 8, 209 .use_single_rw = 1, 210 211 .volatile_table = &apds9960_volatile_table, 212 .precious_table = &apds9960_precious_table, 213 .rd_table = &apds9960_readable_table, 214 .wr_table = &apds9960_writeable_table, 215 216 .reg_defaults = apds9960_reg_defaults, 217 .num_reg_defaults = ARRAY_SIZE(apds9960_reg_defaults), 218 .max_register = APDS9960_REG_GFIFO_DIR(RIGHT), 219 .cache_type = REGCACHE_RBTREE, 220 }; 221 222 static const struct iio_event_spec apds9960_pxs_event_spec[] = { 223 { 224 .type = IIO_EV_TYPE_THRESH, 225 .dir = IIO_EV_DIR_RISING, 226 .mask_separate = BIT(IIO_EV_INFO_VALUE) | 227 BIT(IIO_EV_INFO_ENABLE), 228 }, 229 { 230 .type = IIO_EV_TYPE_THRESH, 231 .dir = IIO_EV_DIR_FALLING, 232 .mask_separate = BIT(IIO_EV_INFO_VALUE) | 233 BIT(IIO_EV_INFO_ENABLE), 234 }, 235 }; 236 237 static const struct iio_event_spec apds9960_als_event_spec[] = { 238 { 239 .type = IIO_EV_TYPE_THRESH, 240 .dir = IIO_EV_DIR_RISING, 241 .mask_separate = BIT(IIO_EV_INFO_VALUE) | 242 BIT(IIO_EV_INFO_ENABLE), 243 }, 244 { 245 .type = IIO_EV_TYPE_THRESH, 246 .dir = IIO_EV_DIR_FALLING, 247 .mask_separate = BIT(IIO_EV_INFO_VALUE) | 248 BIT(IIO_EV_INFO_ENABLE), 249 }, 250 }; 251 252 #define APDS9960_GESTURE_CHANNEL(_dir, _si) { \ 253 .type = IIO_PROXIMITY, \ 254 .channel = _si + 1, \ 255 .scan_index = _si, \ 256 .indexed = 1, \ 257 .scan_type = { \ 258 .sign = 'u', \ 259 .realbits = 8, \ 260 .storagebits = 8, \ 261 }, \ 262 } 263 264 #define APDS9960_INTENSITY_CHANNEL(_colour) { \ 265 .type = IIO_INTENSITY, \ 266 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 267 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \ 268 BIT(IIO_CHAN_INFO_INT_TIME), \ 269 .channel2 = IIO_MOD_LIGHT_##_colour, \ 270 .address = APDS9960_REG_ALS_CHANNEL(_colour), \ 271 .modified = 1, \ 272 .scan_index = -1, \ 273 } 274 275 static const unsigned long apds9960_scan_masks[] = {0xf, 0}; 276 277 static const struct iio_chan_spec apds9960_channels[] = { 278 { 279 .type = IIO_PROXIMITY, 280 .address = APDS9960_REG_PDATA, 281 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 282 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), 283 .channel = 0, 284 .indexed = 0, 285 .scan_index = -1, 286 287 .event_spec = apds9960_pxs_event_spec, 288 .num_event_specs = ARRAY_SIZE(apds9960_pxs_event_spec), 289 }, 290 /* Gesture Sensor */ 291 APDS9960_GESTURE_CHANNEL(UP, 0), 292 APDS9960_GESTURE_CHANNEL(DOWN, 1), 293 APDS9960_GESTURE_CHANNEL(LEFT, 2), 294 APDS9960_GESTURE_CHANNEL(RIGHT, 3), 295 /* ALS */ 296 { 297 .type = IIO_INTENSITY, 298 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 299 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | 300 BIT(IIO_CHAN_INFO_INT_TIME), 301 .channel2 = IIO_MOD_LIGHT_CLEAR, 302 .address = APDS9960_REG_ALS_CHANNEL(CLEAR), 303 .modified = 1, 304 .scan_index = -1, 305 306 .event_spec = apds9960_als_event_spec, 307 .num_event_specs = ARRAY_SIZE(apds9960_als_event_spec), 308 }, 309 /* RGB Sensor */ 310 APDS9960_INTENSITY_CHANNEL(RED), 311 APDS9960_INTENSITY_CHANNEL(GREEN), 312 APDS9960_INTENSITY_CHANNEL(BLUE), 313 }; 314 315 /* integration time in us */ 316 static const int apds9960_int_time[][2] = { 317 { 28000, 246}, 318 {100000, 219}, 319 {200000, 182}, 320 {700000, 0} 321 }; 322 323 /* gain mapping */ 324 static const int apds9960_pxs_gain_map[] = {1, 2, 4, 8}; 325 static const int apds9960_als_gain_map[] = {1, 4, 16, 64}; 326 327 static IIO_CONST_ATTR(proximity_scale_available, "1 2 4 8"); 328 static IIO_CONST_ATTR(intensity_scale_available, "1 4 16 64"); 329 static IIO_CONST_ATTR_INT_TIME_AVAIL("0.028 0.1 0.2 0.7"); 330 331 static struct attribute *apds9960_attributes[] = { 332 &iio_const_attr_proximity_scale_available.dev_attr.attr, 333 &iio_const_attr_intensity_scale_available.dev_attr.attr, 334 &iio_const_attr_integration_time_available.dev_attr.attr, 335 NULL, 336 }; 337 338 static const struct attribute_group apds9960_attribute_group = { 339 .attrs = apds9960_attributes, 340 }; 341 342 static const struct reg_field apds9960_reg_field_int_als = 343 REG_FIELD(APDS9960_REG_ENABLE, 4, 4); 344 345 static const struct reg_field apds9960_reg_field_int_ges = 346 REG_FIELD(APDS9960_REG_GCONF_4, 1, 1); 347 348 static const struct reg_field apds9960_reg_field_int_pxs = 349 REG_FIELD(APDS9960_REG_ENABLE, 5, 5); 350 351 static const struct reg_field apds9960_reg_field_enable_als = 352 REG_FIELD(APDS9960_REG_ENABLE, 1, 1); 353 354 static const struct reg_field apds9960_reg_field_enable_ges = 355 REG_FIELD(APDS9960_REG_ENABLE, 6, 6); 356 357 static const struct reg_field apds9960_reg_field_enable_pxs = 358 REG_FIELD(APDS9960_REG_ENABLE, 2, 2); 359 360 static int apds9960_set_it_time(struct apds9960_data *data, int val2) 361 { 362 int ret = -EINVAL; 363 int idx; 364 365 for (idx = 0; idx < ARRAY_SIZE(apds9960_int_time); idx++) { 366 if (apds9960_int_time[idx][0] == val2) { 367 mutex_lock(&data->lock); 368 ret = regmap_write(data->regmap, APDS9960_REG_ATIME, 369 apds9960_int_time[idx][1]); 370 if (!ret) 371 data->als_adc_int_us = val2; 372 mutex_unlock(&data->lock); 373 break; 374 } 375 } 376 377 return ret; 378 } 379 380 static int apds9960_set_pxs_gain(struct apds9960_data *data, int val) 381 { 382 int ret = -EINVAL; 383 int idx; 384 385 for (idx = 0; idx < ARRAY_SIZE(apds9960_pxs_gain_map); idx++) { 386 if (apds9960_pxs_gain_map[idx] == val) { 387 /* pxs + gesture gains are mirrored */ 388 mutex_lock(&data->lock); 389 ret = regmap_update_bits(data->regmap, 390 APDS9960_REG_CONTROL, 391 APDS9960_REG_CONTROL_PGAIN_MASK, 392 idx << APDS9960_REG_CONTROL_PGAIN_MASK_SHIFT); 393 if (ret) { 394 mutex_unlock(&data->lock); 395 break; 396 } 397 398 ret = regmap_update_bits(data->regmap, 399 APDS9960_REG_CONFIG_2, 400 APDS9960_REG_CONFIG_2_GGAIN_MASK, 401 idx << APDS9960_REG_CONFIG_2_GGAIN_MASK_SHIFT); 402 if (!ret) 403 data->pxs_gain = idx; 404 mutex_unlock(&data->lock); 405 break; 406 } 407 } 408 409 return ret; 410 } 411 412 static int apds9960_set_als_gain(struct apds9960_data *data, int val) 413 { 414 int ret = -EINVAL; 415 int idx; 416 417 for (idx = 0; idx < ARRAY_SIZE(apds9960_als_gain_map); idx++) { 418 if (apds9960_als_gain_map[idx] == val) { 419 mutex_lock(&data->lock); 420 ret = regmap_update_bits(data->regmap, 421 APDS9960_REG_CONTROL, 422 APDS9960_REG_CONTROL_AGAIN_MASK, idx); 423 if (!ret) 424 data->als_gain = idx; 425 mutex_unlock(&data->lock); 426 break; 427 } 428 } 429 430 return ret; 431 } 432 433 #ifdef CONFIG_PM 434 static int apds9960_set_power_state(struct apds9960_data *data, bool on) 435 { 436 struct device *dev = &data->client->dev; 437 int ret = 0; 438 439 mutex_lock(&data->lock); 440 441 if (on) { 442 int suspended; 443 444 suspended = pm_runtime_suspended(dev); 445 ret = pm_runtime_get_sync(dev); 446 447 /* Allow one integration cycle before allowing a reading */ 448 if (suspended) 449 usleep_range(data->als_adc_int_us, 450 APDS9960_MAX_INT_TIME_IN_US); 451 } else { 452 pm_runtime_mark_last_busy(dev); 453 ret = pm_runtime_put_autosuspend(dev); 454 } 455 456 mutex_unlock(&data->lock); 457 458 return ret; 459 } 460 #else 461 static int apds9960_set_power_state(struct apds9960_data *data, bool on) 462 { 463 return 0; 464 } 465 #endif 466 467 static int apds9960_read_raw(struct iio_dev *indio_dev, 468 struct iio_chan_spec const *chan, 469 int *val, int *val2, long mask) 470 { 471 struct apds9960_data *data = iio_priv(indio_dev); 472 __le16 buf; 473 int ret = -EINVAL; 474 475 if (data->gesture_mode_running) 476 return -EBUSY; 477 478 switch (mask) { 479 case IIO_CHAN_INFO_RAW: 480 apds9960_set_power_state(data, true); 481 switch (chan->type) { 482 case IIO_PROXIMITY: 483 ret = regmap_read(data->regmap, chan->address, val); 484 if (!ret) 485 ret = IIO_VAL_INT; 486 break; 487 case IIO_INTENSITY: 488 ret = regmap_bulk_read(data->regmap, chan->address, 489 &buf, 2); 490 if (!ret) { 491 ret = IIO_VAL_INT; 492 *val = le16_to_cpu(buf); 493 } 494 break; 495 default: 496 ret = -EINVAL; 497 } 498 apds9960_set_power_state(data, false); 499 break; 500 case IIO_CHAN_INFO_INT_TIME: 501 /* RGB + ALS sensors only have integration time */ 502 mutex_lock(&data->lock); 503 switch (chan->type) { 504 case IIO_INTENSITY: 505 *val = 0; 506 *val2 = data->als_adc_int_us; 507 ret = IIO_VAL_INT_PLUS_MICRO; 508 break; 509 default: 510 ret = -EINVAL; 511 } 512 mutex_unlock(&data->lock); 513 break; 514 case IIO_CHAN_INFO_SCALE: 515 mutex_lock(&data->lock); 516 switch (chan->type) { 517 case IIO_PROXIMITY: 518 *val = apds9960_pxs_gain_map[data->pxs_gain]; 519 ret = IIO_VAL_INT; 520 break; 521 case IIO_INTENSITY: 522 *val = apds9960_als_gain_map[data->als_gain]; 523 ret = IIO_VAL_INT; 524 break; 525 default: 526 ret = -EINVAL; 527 } 528 mutex_unlock(&data->lock); 529 break; 530 } 531 532 return ret; 533 }; 534 535 static int apds9960_write_raw(struct iio_dev *indio_dev, 536 struct iio_chan_spec const *chan, 537 int val, int val2, long mask) 538 { 539 struct apds9960_data *data = iio_priv(indio_dev); 540 541 switch (mask) { 542 case IIO_CHAN_INFO_INT_TIME: 543 /* RGB + ALS sensors only have int time */ 544 switch (chan->type) { 545 case IIO_INTENSITY: 546 if (val != 0) 547 return -EINVAL; 548 return apds9960_set_it_time(data, val2); 549 default: 550 return -EINVAL; 551 } 552 case IIO_CHAN_INFO_SCALE: 553 if (val2 != 0) 554 return -EINVAL; 555 switch (chan->type) { 556 case IIO_PROXIMITY: 557 return apds9960_set_pxs_gain(data, val); 558 case IIO_INTENSITY: 559 return apds9960_set_als_gain(data, val); 560 default: 561 return -EINVAL; 562 } 563 default: 564 return -EINVAL; 565 }; 566 567 return 0; 568 } 569 570 static inline int apds9960_get_thres_reg(const struct iio_chan_spec *chan, 571 enum iio_event_direction dir, 572 u8 *reg) 573 { 574 switch (dir) { 575 case IIO_EV_DIR_RISING: 576 switch (chan->type) { 577 case IIO_PROXIMITY: 578 *reg = APDS9960_REG_PIHT; 579 break; 580 case IIO_INTENSITY: 581 *reg = APDS9960_REG_AIHTL; 582 break; 583 default: 584 return -EINVAL; 585 } 586 break; 587 case IIO_EV_DIR_FALLING: 588 switch (chan->type) { 589 case IIO_PROXIMITY: 590 *reg = APDS9960_REG_PILT; 591 break; 592 case IIO_INTENSITY: 593 *reg = APDS9960_REG_AILTL; 594 break; 595 default: 596 return -EINVAL; 597 } 598 break; 599 default: 600 return -EINVAL; 601 } 602 603 return 0; 604 } 605 606 static int apds9960_read_event(struct iio_dev *indio_dev, 607 const struct iio_chan_spec *chan, 608 enum iio_event_type type, 609 enum iio_event_direction dir, 610 enum iio_event_info info, 611 int *val, int *val2) 612 { 613 u8 reg; 614 __le16 buf; 615 int ret = 0; 616 struct apds9960_data *data = iio_priv(indio_dev); 617 618 if (info != IIO_EV_INFO_VALUE) 619 return -EINVAL; 620 621 ret = apds9960_get_thres_reg(chan, dir, ®); 622 if (ret < 0) 623 return ret; 624 625 if (chan->type == IIO_PROXIMITY) { 626 ret = regmap_read(data->regmap, reg, val); 627 if (ret < 0) 628 return ret; 629 } else if (chan->type == IIO_INTENSITY) { 630 ret = regmap_bulk_read(data->regmap, reg, &buf, 2); 631 if (ret < 0) 632 return ret; 633 *val = le16_to_cpu(buf); 634 } else 635 return -EINVAL; 636 637 *val2 = 0; 638 639 return IIO_VAL_INT; 640 } 641 642 static int apds9960_write_event(struct iio_dev *indio_dev, 643 const struct iio_chan_spec *chan, 644 enum iio_event_type type, 645 enum iio_event_direction dir, 646 enum iio_event_info info, 647 int val, int val2) 648 { 649 u8 reg; 650 __le16 buf; 651 int ret = 0; 652 struct apds9960_data *data = iio_priv(indio_dev); 653 654 if (info != IIO_EV_INFO_VALUE) 655 return -EINVAL; 656 657 ret = apds9960_get_thres_reg(chan, dir, ®); 658 if (ret < 0) 659 return ret; 660 661 if (chan->type == IIO_PROXIMITY) { 662 if (val < 0 || val > APDS9960_MAX_PXS_THRES_VAL) 663 return -EINVAL; 664 ret = regmap_write(data->regmap, reg, val); 665 if (ret < 0) 666 return ret; 667 } else if (chan->type == IIO_INTENSITY) { 668 if (val < 0 || val > APDS9960_MAX_ALS_THRES_VAL) 669 return -EINVAL; 670 buf = cpu_to_le16(val); 671 ret = regmap_bulk_write(data->regmap, reg, &buf, 2); 672 if (ret < 0) 673 return ret; 674 } else 675 return -EINVAL; 676 677 return 0; 678 } 679 680 static int apds9960_read_event_config(struct iio_dev *indio_dev, 681 const struct iio_chan_spec *chan, 682 enum iio_event_type type, 683 enum iio_event_direction dir) 684 { 685 struct apds9960_data *data = iio_priv(indio_dev); 686 687 switch (chan->type) { 688 case IIO_PROXIMITY: 689 return data->pxs_int; 690 case IIO_INTENSITY: 691 return data->als_int; 692 default: 693 return -EINVAL; 694 } 695 696 return 0; 697 } 698 699 static int apds9960_write_event_config(struct iio_dev *indio_dev, 700 const struct iio_chan_spec *chan, 701 enum iio_event_type type, 702 enum iio_event_direction dir, 703 int state) 704 { 705 struct apds9960_data *data = iio_priv(indio_dev); 706 int ret; 707 708 state = !!state; 709 710 switch (chan->type) { 711 case IIO_PROXIMITY: 712 if (data->pxs_int == state) 713 return -EINVAL; 714 715 ret = regmap_field_write(data->reg_int_pxs, state); 716 if (ret) 717 return ret; 718 data->pxs_int = state; 719 apds9960_set_power_state(data, state); 720 break; 721 case IIO_INTENSITY: 722 if (data->als_int == state) 723 return -EINVAL; 724 725 ret = regmap_field_write(data->reg_int_als, state); 726 if (ret) 727 return ret; 728 data->als_int = state; 729 apds9960_set_power_state(data, state); 730 break; 731 default: 732 return -EINVAL; 733 } 734 735 return 0; 736 } 737 738 static const struct iio_info apds9960_info = { 739 .attrs = &apds9960_attribute_group, 740 .read_raw = apds9960_read_raw, 741 .write_raw = apds9960_write_raw, 742 .read_event_value = apds9960_read_event, 743 .write_event_value = apds9960_write_event, 744 .read_event_config = apds9960_read_event_config, 745 .write_event_config = apds9960_write_event_config, 746 747 }; 748 749 static inline int apds9660_fifo_is_empty(struct apds9960_data *data) 750 { 751 int cnt; 752 int ret; 753 754 ret = regmap_read(data->regmap, APDS9960_REG_GFLVL, &cnt); 755 if (ret) 756 return ret; 757 758 return cnt; 759 } 760 761 static void apds9960_read_gesture_fifo(struct apds9960_data *data) 762 { 763 int ret, cnt = 0; 764 765 mutex_lock(&data->lock); 766 data->gesture_mode_running = 1; 767 768 while (cnt || (cnt = apds9660_fifo_is_empty(data) > 0)) { 769 ret = regmap_bulk_read(data->regmap, APDS9960_REG_GFIFO_BASE, 770 &data->buffer, 4); 771 772 if (ret) 773 goto err_read; 774 775 iio_push_to_buffers(data->indio_dev, data->buffer); 776 cnt--; 777 } 778 779 err_read: 780 data->gesture_mode_running = 0; 781 mutex_unlock(&data->lock); 782 } 783 784 static irqreturn_t apds9960_interrupt_handler(int irq, void *private) 785 { 786 struct iio_dev *indio_dev = private; 787 struct apds9960_data *data = iio_priv(indio_dev); 788 int ret, status; 789 790 ret = regmap_read(data->regmap, APDS9960_REG_STATUS, &status); 791 if (ret < 0) { 792 dev_err(&data->client->dev, "irq status reg read failed\n"); 793 return IRQ_HANDLED; 794 } 795 796 if ((status & APDS9960_REG_STATUS_ALS_INT) && data->als_int) { 797 iio_push_event(indio_dev, 798 IIO_UNMOD_EVENT_CODE(IIO_INTENSITY, 0, 799 IIO_EV_TYPE_THRESH, 800 IIO_EV_DIR_EITHER), 801 iio_get_time_ns(indio_dev)); 802 regmap_write(data->regmap, APDS9960_REG_CICLEAR, 1); 803 } 804 805 if ((status & APDS9960_REG_STATUS_PS_INT) && data->pxs_int) { 806 iio_push_event(indio_dev, 807 IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, 0, 808 IIO_EV_TYPE_THRESH, 809 IIO_EV_DIR_EITHER), 810 iio_get_time_ns(indio_dev)); 811 regmap_write(data->regmap, APDS9960_REG_PICLEAR, 1); 812 } 813 814 if (status & APDS9960_REG_STATUS_GINT) 815 apds9960_read_gesture_fifo(data); 816 817 return IRQ_HANDLED; 818 } 819 820 static int apds9960_set_powermode(struct apds9960_data *data, bool state) 821 { 822 return regmap_update_bits(data->regmap, APDS9960_REG_ENABLE, 1, state); 823 } 824 825 static int apds9960_buffer_postenable(struct iio_dev *indio_dev) 826 { 827 struct apds9960_data *data = iio_priv(indio_dev); 828 int ret; 829 830 ret = regmap_field_write(data->reg_int_ges, 1); 831 if (ret) 832 return ret; 833 834 ret = regmap_field_write(data->reg_enable_ges, 1); 835 if (ret) 836 return ret; 837 838 pm_runtime_get_sync(&data->client->dev); 839 840 return 0; 841 } 842 843 static int apds9960_buffer_predisable(struct iio_dev *indio_dev) 844 { 845 struct apds9960_data *data = iio_priv(indio_dev); 846 int ret; 847 848 ret = regmap_field_write(data->reg_enable_ges, 0); 849 if (ret) 850 return ret; 851 852 ret = regmap_field_write(data->reg_int_ges, 0); 853 if (ret) 854 return ret; 855 856 pm_runtime_put_autosuspend(&data->client->dev); 857 858 return 0; 859 } 860 861 static const struct iio_buffer_setup_ops apds9960_buffer_setup_ops = { 862 .postenable = apds9960_buffer_postenable, 863 .predisable = apds9960_buffer_predisable, 864 }; 865 866 static int apds9960_regfield_init(struct apds9960_data *data) 867 { 868 struct device *dev = &data->client->dev; 869 struct regmap *regmap = data->regmap; 870 871 data->reg_int_als = devm_regmap_field_alloc(dev, regmap, 872 apds9960_reg_field_int_als); 873 if (IS_ERR(data->reg_int_als)) { 874 dev_err(dev, "INT ALS reg field init failed\n"); 875 return PTR_ERR(data->reg_int_als); 876 } 877 878 data->reg_int_ges = devm_regmap_field_alloc(dev, regmap, 879 apds9960_reg_field_int_ges); 880 if (IS_ERR(data->reg_int_ges)) { 881 dev_err(dev, "INT gesture reg field init failed\n"); 882 return PTR_ERR(data->reg_int_ges); 883 } 884 885 data->reg_int_pxs = devm_regmap_field_alloc(dev, regmap, 886 apds9960_reg_field_int_pxs); 887 if (IS_ERR(data->reg_int_pxs)) { 888 dev_err(dev, "INT pxs reg field init failed\n"); 889 return PTR_ERR(data->reg_int_pxs); 890 } 891 892 data->reg_enable_als = devm_regmap_field_alloc(dev, regmap, 893 apds9960_reg_field_enable_als); 894 if (IS_ERR(data->reg_enable_als)) { 895 dev_err(dev, "Enable ALS reg field init failed\n"); 896 return PTR_ERR(data->reg_enable_als); 897 } 898 899 data->reg_enable_ges = devm_regmap_field_alloc(dev, regmap, 900 apds9960_reg_field_enable_ges); 901 if (IS_ERR(data->reg_enable_ges)) { 902 dev_err(dev, "Enable gesture reg field init failed\n"); 903 return PTR_ERR(data->reg_enable_ges); 904 } 905 906 data->reg_enable_pxs = devm_regmap_field_alloc(dev, regmap, 907 apds9960_reg_field_enable_pxs); 908 if (IS_ERR(data->reg_enable_pxs)) { 909 dev_err(dev, "Enable PXS reg field init failed\n"); 910 return PTR_ERR(data->reg_enable_pxs); 911 } 912 913 return 0; 914 } 915 916 static int apds9960_chip_init(struct apds9960_data *data) 917 { 918 int ret; 919 920 /* Default IT for ALS of 28 ms */ 921 ret = apds9960_set_it_time(data, 28000); 922 if (ret) 923 return ret; 924 925 /* Ensure gesture interrupt is OFF */ 926 ret = regmap_field_write(data->reg_int_ges, 0); 927 if (ret) 928 return ret; 929 930 /* Disable gesture sensor, since polling is useless from user-space */ 931 ret = regmap_field_write(data->reg_enable_ges, 0); 932 if (ret) 933 return ret; 934 935 /* Ensure proximity interrupt is OFF */ 936 ret = regmap_field_write(data->reg_int_pxs, 0); 937 if (ret) 938 return ret; 939 940 /* Enable proximity sensor for polling */ 941 ret = regmap_field_write(data->reg_enable_pxs, 1); 942 if (ret) 943 return ret; 944 945 /* Ensure ALS interrupt is OFF */ 946 ret = regmap_field_write(data->reg_int_als, 0); 947 if (ret) 948 return ret; 949 950 /* Enable ALS sensor for polling */ 951 ret = regmap_field_write(data->reg_enable_als, 1); 952 if (ret) 953 return ret; 954 /* 955 * When enabled trigger an interrupt after 3 readings 956 * outside threshold for ALS + PXS 957 */ 958 ret = regmap_write(data->regmap, APDS9960_REG_PERS, 959 APDS9960_DEFAULT_PERS); 960 if (ret) 961 return ret; 962 963 /* 964 * Wait for 4 event outside gesture threshold to prevent interrupt 965 * flooding. 966 */ 967 ret = regmap_update_bits(data->regmap, APDS9960_REG_GCONF_1, 968 APDS9960_REG_GCONF_1_GFIFO_THRES_MASK, 969 BIT(0) << APDS9960_REG_GCONF_1_GFIFO_THRES_MASK_SHIFT); 970 if (ret) 971 return ret; 972 973 /* Default ENTER and EXIT thresholds for the GESTURE engine. */ 974 ret = regmap_write(data->regmap, APDS9960_REG_GPENTH, 975 APDS9960_DEFAULT_GPENTH); 976 if (ret) 977 return ret; 978 979 ret = regmap_write(data->regmap, APDS9960_REG_GEXTH, 980 APDS9960_DEFAULT_GEXTH); 981 if (ret) 982 return ret; 983 984 return apds9960_set_powermode(data, 1); 985 } 986 987 static int apds9960_probe(struct i2c_client *client, 988 const struct i2c_device_id *id) 989 { 990 struct apds9960_data *data; 991 struct iio_buffer *buffer; 992 struct iio_dev *indio_dev; 993 int ret; 994 995 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 996 if (!indio_dev) 997 return -ENOMEM; 998 999 buffer = devm_iio_kfifo_allocate(&client->dev); 1000 if (!buffer) 1001 return -ENOMEM; 1002 1003 iio_device_attach_buffer(indio_dev, buffer); 1004 1005 indio_dev->dev.parent = &client->dev; 1006 indio_dev->info = &apds9960_info; 1007 indio_dev->name = APDS9960_DRV_NAME; 1008 indio_dev->channels = apds9960_channels; 1009 indio_dev->num_channels = ARRAY_SIZE(apds9960_channels); 1010 indio_dev->available_scan_masks = apds9960_scan_masks; 1011 indio_dev->modes = (INDIO_BUFFER_SOFTWARE | INDIO_DIRECT_MODE); 1012 indio_dev->setup_ops = &apds9960_buffer_setup_ops; 1013 1014 data = iio_priv(indio_dev); 1015 i2c_set_clientdata(client, indio_dev); 1016 1017 data->regmap = devm_regmap_init_i2c(client, &apds9960_regmap_config); 1018 if (IS_ERR(data->regmap)) { 1019 dev_err(&client->dev, "regmap initialization failed.\n"); 1020 return PTR_ERR(data->regmap); 1021 } 1022 1023 data->client = client; 1024 data->indio_dev = indio_dev; 1025 mutex_init(&data->lock); 1026 1027 ret = pm_runtime_set_active(&client->dev); 1028 if (ret) 1029 goto error_power_down; 1030 1031 pm_runtime_enable(&client->dev); 1032 pm_runtime_set_autosuspend_delay(&client->dev, 5000); 1033 pm_runtime_use_autosuspend(&client->dev); 1034 1035 apds9960_set_power_state(data, true); 1036 1037 ret = apds9960_regfield_init(data); 1038 if (ret) 1039 goto error_power_down; 1040 1041 ret = apds9960_chip_init(data); 1042 if (ret) 1043 goto error_power_down; 1044 1045 if (client->irq <= 0) { 1046 dev_err(&client->dev, "no valid irq defined\n"); 1047 ret = -EINVAL; 1048 goto error_power_down; 1049 } 1050 ret = devm_request_threaded_irq(&client->dev, client->irq, 1051 NULL, apds9960_interrupt_handler, 1052 IRQF_TRIGGER_FALLING | IRQF_ONESHOT, 1053 "apds9960_event", 1054 indio_dev); 1055 if (ret) { 1056 dev_err(&client->dev, "request irq (%d) failed\n", client->irq); 1057 goto error_power_down; 1058 } 1059 1060 ret = iio_device_register(indio_dev); 1061 if (ret) 1062 goto error_power_down; 1063 1064 apds9960_set_power_state(data, false); 1065 1066 return 0; 1067 1068 error_power_down: 1069 apds9960_set_power_state(data, false); 1070 1071 return ret; 1072 } 1073 1074 static int apds9960_remove(struct i2c_client *client) 1075 { 1076 struct iio_dev *indio_dev = i2c_get_clientdata(client); 1077 struct apds9960_data *data = iio_priv(indio_dev); 1078 1079 iio_device_unregister(indio_dev); 1080 pm_runtime_disable(&client->dev); 1081 pm_runtime_set_suspended(&client->dev); 1082 apds9960_set_powermode(data, 0); 1083 1084 return 0; 1085 } 1086 1087 #ifdef CONFIG_PM 1088 static int apds9960_runtime_suspend(struct device *dev) 1089 { 1090 struct apds9960_data *data = 1091 iio_priv(i2c_get_clientdata(to_i2c_client(dev))); 1092 1093 return apds9960_set_powermode(data, 0); 1094 } 1095 1096 static int apds9960_runtime_resume(struct device *dev) 1097 { 1098 struct apds9960_data *data = 1099 iio_priv(i2c_get_clientdata(to_i2c_client(dev))); 1100 1101 return apds9960_set_powermode(data, 1); 1102 } 1103 #endif 1104 1105 static const struct dev_pm_ops apds9960_pm_ops = { 1106 SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, 1107 pm_runtime_force_resume) 1108 SET_RUNTIME_PM_OPS(apds9960_runtime_suspend, 1109 apds9960_runtime_resume, NULL) 1110 }; 1111 1112 static const struct i2c_device_id apds9960_id[] = { 1113 { "apds9960", 0 }, 1114 {} 1115 }; 1116 MODULE_DEVICE_TABLE(i2c, apds9960_id); 1117 1118 static const struct of_device_id apds9960_of_match[] = { 1119 { .compatible = "avago,apds9960" }, 1120 { } 1121 }; 1122 MODULE_DEVICE_TABLE(of, apds9960_of_match); 1123 1124 static struct i2c_driver apds9960_driver = { 1125 .driver = { 1126 .name = APDS9960_DRV_NAME, 1127 .of_match_table = apds9960_of_match, 1128 .pm = &apds9960_pm_ops, 1129 }, 1130 .probe = apds9960_probe, 1131 .remove = apds9960_remove, 1132 .id_table = apds9960_id, 1133 }; 1134 module_i2c_driver(apds9960_driver); 1135 1136 MODULE_AUTHOR("Matt Ranostay <matt.ranostay@konsulko.com>"); 1137 MODULE_DESCRIPTION("ADPS9960 Gesture/RGB/ALS/Proximity sensor"); 1138 MODULE_LICENSE("GPL"); 1139