14193c0f1SVlad Dogaru /* 24193c0f1SVlad Dogaru * Copyright (c) 2014 Intel Corporation 34193c0f1SVlad Dogaru * 44193c0f1SVlad Dogaru * Driver for Semtech's SX9500 capacitive proximity/button solution. 54193c0f1SVlad Dogaru * Datasheet available at 64193c0f1SVlad Dogaru * <http://www.semtech.com/images/datasheet/sx9500.pdf>. 74193c0f1SVlad Dogaru * 84193c0f1SVlad Dogaru * This program is free software; you can redistribute it and/or modify it 94193c0f1SVlad Dogaru * under the terms of the GNU General Public License version 2 as published by 104193c0f1SVlad Dogaru * the Free Software Foundation. 114193c0f1SVlad Dogaru */ 124193c0f1SVlad Dogaru 134193c0f1SVlad Dogaru #include <linux/kernel.h> 144193c0f1SVlad Dogaru #include <linux/slab.h> 154193c0f1SVlad Dogaru #include <linux/module.h> 164193c0f1SVlad Dogaru #include <linux/i2c.h> 174193c0f1SVlad Dogaru #include <linux/irq.h> 184193c0f1SVlad Dogaru #include <linux/acpi.h> 194193c0f1SVlad Dogaru #include <linux/gpio/consumer.h> 204193c0f1SVlad Dogaru #include <linux/regmap.h> 217840ffeeSVlad Dogaru #include <linux/pm.h> 224193c0f1SVlad Dogaru 234193c0f1SVlad Dogaru #include <linux/iio/iio.h> 244193c0f1SVlad Dogaru #include <linux/iio/buffer.h> 254193c0f1SVlad Dogaru #include <linux/iio/sysfs.h> 264193c0f1SVlad Dogaru #include <linux/iio/events.h> 274193c0f1SVlad Dogaru #include <linux/iio/trigger.h> 284193c0f1SVlad Dogaru #include <linux/iio/triggered_buffer.h> 294193c0f1SVlad Dogaru #include <linux/iio/trigger_consumer.h> 304193c0f1SVlad Dogaru 314193c0f1SVlad Dogaru #define SX9500_DRIVER_NAME "sx9500" 324193c0f1SVlad Dogaru #define SX9500_IRQ_NAME "sx9500_event" 33*63de9f92SVlad Dogaru 34*63de9f92SVlad Dogaru #define SX9500_GPIO_NAME "interrupt" 354193c0f1SVlad Dogaru 364193c0f1SVlad Dogaru /* Register definitions. */ 374193c0f1SVlad Dogaru #define SX9500_REG_IRQ_SRC 0x00 384193c0f1SVlad Dogaru #define SX9500_REG_STAT 0x01 394193c0f1SVlad Dogaru #define SX9500_REG_IRQ_MSK 0x03 404193c0f1SVlad Dogaru 414193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL0 0x06 424193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL1 0x07 434193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL2 0x08 444193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL3 0x09 454193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL4 0x0a 464193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL5 0x0b 474193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL6 0x0c 484193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL7 0x0d 494193c0f1SVlad Dogaru #define SX9500_REG_PROX_CTRL8 0x0e 504193c0f1SVlad Dogaru 514193c0f1SVlad Dogaru #define SX9500_REG_SENSOR_SEL 0x20 524193c0f1SVlad Dogaru #define SX9500_REG_USE_MSB 0x21 534193c0f1SVlad Dogaru #define SX9500_REG_USE_LSB 0x22 544193c0f1SVlad Dogaru #define SX9500_REG_AVG_MSB 0x23 554193c0f1SVlad Dogaru #define SX9500_REG_AVG_LSB 0x24 564193c0f1SVlad Dogaru #define SX9500_REG_DIFF_MSB 0x25 574193c0f1SVlad Dogaru #define SX9500_REG_DIFF_LSB 0x26 584193c0f1SVlad Dogaru #define SX9500_REG_OFFSET_MSB 0x27 594193c0f1SVlad Dogaru #define SX9500_REG_OFFSET_LSB 0x28 604193c0f1SVlad Dogaru 614193c0f1SVlad Dogaru #define SX9500_REG_RESET 0x7f 624193c0f1SVlad Dogaru 634193c0f1SVlad Dogaru /* Write this to REG_RESET to do a soft reset. */ 644193c0f1SVlad Dogaru #define SX9500_SOFT_RESET 0xde 654193c0f1SVlad Dogaru 664193c0f1SVlad Dogaru #define SX9500_SCAN_PERIOD_MASK GENMASK(6, 4) 674193c0f1SVlad Dogaru #define SX9500_SCAN_PERIOD_SHIFT 4 684193c0f1SVlad Dogaru 694193c0f1SVlad Dogaru /* 704193c0f1SVlad Dogaru * These serve for identifying IRQ source in the IRQ_SRC register, and 714193c0f1SVlad Dogaru * also for masking the IRQs in the IRQ_MSK register. 724193c0f1SVlad Dogaru */ 734193c0f1SVlad Dogaru #define SX9500_CLOSE_IRQ BIT(6) 744193c0f1SVlad Dogaru #define SX9500_FAR_IRQ BIT(5) 754193c0f1SVlad Dogaru #define SX9500_CONVDONE_IRQ BIT(3) 764193c0f1SVlad Dogaru 774193c0f1SVlad Dogaru #define SX9500_PROXSTAT_SHIFT 4 784193c0f1SVlad Dogaru 794193c0f1SVlad Dogaru #define SX9500_NUM_CHANNELS 4 804193c0f1SVlad Dogaru 814193c0f1SVlad Dogaru struct sx9500_data { 824193c0f1SVlad Dogaru struct mutex mutex; 834193c0f1SVlad Dogaru struct i2c_client *client; 844193c0f1SVlad Dogaru struct iio_trigger *trig; 854193c0f1SVlad Dogaru struct regmap *regmap; 864193c0f1SVlad Dogaru /* 874193c0f1SVlad Dogaru * Last reading of the proximity status for each channel. We 884193c0f1SVlad Dogaru * only send an event to user space when this changes. 894193c0f1SVlad Dogaru */ 904193c0f1SVlad Dogaru bool prox_stat[SX9500_NUM_CHANNELS]; 914193c0f1SVlad Dogaru bool event_enabled[SX9500_NUM_CHANNELS]; 924193c0f1SVlad Dogaru bool trigger_enabled; 934193c0f1SVlad Dogaru u16 *buffer; 947840ffeeSVlad Dogaru /* Remember enabled channels and sample rate during suspend. */ 957840ffeeSVlad Dogaru unsigned int suspend_ctrl0; 964193c0f1SVlad Dogaru }; 974193c0f1SVlad Dogaru 984193c0f1SVlad Dogaru static const struct iio_event_spec sx9500_events[] = { 994193c0f1SVlad Dogaru { 1004193c0f1SVlad Dogaru .type = IIO_EV_TYPE_THRESH, 1014193c0f1SVlad Dogaru .dir = IIO_EV_DIR_EITHER, 1024193c0f1SVlad Dogaru .mask_separate = BIT(IIO_EV_INFO_ENABLE), 1034193c0f1SVlad Dogaru }, 1044193c0f1SVlad Dogaru }; 1054193c0f1SVlad Dogaru 1064193c0f1SVlad Dogaru #define SX9500_CHANNEL(idx) \ 1074193c0f1SVlad Dogaru { \ 1084193c0f1SVlad Dogaru .type = IIO_PROXIMITY, \ 1094193c0f1SVlad Dogaru .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 1104193c0f1SVlad Dogaru .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \ 1114193c0f1SVlad Dogaru .indexed = 1, \ 1124193c0f1SVlad Dogaru .channel = idx, \ 1134193c0f1SVlad Dogaru .event_spec = sx9500_events, \ 1144193c0f1SVlad Dogaru .num_event_specs = ARRAY_SIZE(sx9500_events), \ 1154193c0f1SVlad Dogaru .scan_index = idx, \ 1164193c0f1SVlad Dogaru .scan_type = { \ 1174193c0f1SVlad Dogaru .sign = 'u', \ 1184193c0f1SVlad Dogaru .realbits = 16, \ 1194193c0f1SVlad Dogaru .storagebits = 16, \ 1204193c0f1SVlad Dogaru .shift = 0, \ 1214193c0f1SVlad Dogaru }, \ 1224193c0f1SVlad Dogaru } 1234193c0f1SVlad Dogaru 1244193c0f1SVlad Dogaru static const struct iio_chan_spec sx9500_channels[] = { 1254193c0f1SVlad Dogaru SX9500_CHANNEL(0), 1264193c0f1SVlad Dogaru SX9500_CHANNEL(1), 1274193c0f1SVlad Dogaru SX9500_CHANNEL(2), 1284193c0f1SVlad Dogaru SX9500_CHANNEL(3), 1294193c0f1SVlad Dogaru IIO_CHAN_SOFT_TIMESTAMP(4), 1304193c0f1SVlad Dogaru }; 1314193c0f1SVlad Dogaru 1324193c0f1SVlad Dogaru static const struct { 1334193c0f1SVlad Dogaru int val; 1344193c0f1SVlad Dogaru int val2; 1354193c0f1SVlad Dogaru } sx9500_samp_freq_table[] = { 1364193c0f1SVlad Dogaru {33, 333333}, 1374193c0f1SVlad Dogaru {16, 666666}, 1384193c0f1SVlad Dogaru {11, 111111}, 1394193c0f1SVlad Dogaru {8, 333333}, 1404193c0f1SVlad Dogaru {6, 666666}, 1414193c0f1SVlad Dogaru {5, 0}, 1424193c0f1SVlad Dogaru {3, 333333}, 1434193c0f1SVlad Dogaru {2, 500000}, 1444193c0f1SVlad Dogaru }; 1454193c0f1SVlad Dogaru 1464193c0f1SVlad Dogaru static const struct regmap_range sx9500_writable_reg_ranges[] = { 1474193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_IRQ_MSK, SX9500_REG_IRQ_MSK), 1484193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_PROX_CTRL0, SX9500_REG_PROX_CTRL8), 1494193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_SENSOR_SEL, SX9500_REG_SENSOR_SEL), 1504193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_OFFSET_MSB, SX9500_REG_OFFSET_LSB), 1514193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_RESET, SX9500_REG_RESET), 1524193c0f1SVlad Dogaru }; 1534193c0f1SVlad Dogaru 1544193c0f1SVlad Dogaru static const struct regmap_access_table sx9500_writeable_regs = { 1554193c0f1SVlad Dogaru .yes_ranges = sx9500_writable_reg_ranges, 1564193c0f1SVlad Dogaru .n_yes_ranges = ARRAY_SIZE(sx9500_writable_reg_ranges), 1574193c0f1SVlad Dogaru }; 1584193c0f1SVlad Dogaru 1594193c0f1SVlad Dogaru /* 1604193c0f1SVlad Dogaru * All allocated registers are readable, so we just list unallocated 1614193c0f1SVlad Dogaru * ones. 1624193c0f1SVlad Dogaru */ 1634193c0f1SVlad Dogaru static const struct regmap_range sx9500_non_readable_reg_ranges[] = { 1644193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_STAT + 1, SX9500_REG_STAT + 1), 1654193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_IRQ_MSK + 1, SX9500_REG_PROX_CTRL0 - 1), 1664193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_PROX_CTRL8 + 1, SX9500_REG_SENSOR_SEL - 1), 1674193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_OFFSET_LSB + 1, SX9500_REG_RESET - 1), 1684193c0f1SVlad Dogaru }; 1694193c0f1SVlad Dogaru 1704193c0f1SVlad Dogaru static const struct regmap_access_table sx9500_readable_regs = { 1714193c0f1SVlad Dogaru .no_ranges = sx9500_non_readable_reg_ranges, 1724193c0f1SVlad Dogaru .n_no_ranges = ARRAY_SIZE(sx9500_non_readable_reg_ranges), 1734193c0f1SVlad Dogaru }; 1744193c0f1SVlad Dogaru 1754193c0f1SVlad Dogaru static const struct regmap_range sx9500_volatile_reg_ranges[] = { 1764193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_IRQ_SRC, SX9500_REG_STAT), 1774193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_USE_MSB, SX9500_REG_OFFSET_LSB), 1784193c0f1SVlad Dogaru regmap_reg_range(SX9500_REG_RESET, SX9500_REG_RESET), 1794193c0f1SVlad Dogaru }; 1804193c0f1SVlad Dogaru 1814193c0f1SVlad Dogaru static const struct regmap_access_table sx9500_volatile_regs = { 1824193c0f1SVlad Dogaru .yes_ranges = sx9500_volatile_reg_ranges, 1834193c0f1SVlad Dogaru .n_yes_ranges = ARRAY_SIZE(sx9500_volatile_reg_ranges), 1844193c0f1SVlad Dogaru }; 1854193c0f1SVlad Dogaru 1864193c0f1SVlad Dogaru static const struct regmap_config sx9500_regmap_config = { 1874193c0f1SVlad Dogaru .reg_bits = 8, 1884193c0f1SVlad Dogaru .val_bits = 8, 1894193c0f1SVlad Dogaru 1904193c0f1SVlad Dogaru .max_register = SX9500_REG_RESET, 1914193c0f1SVlad Dogaru .cache_type = REGCACHE_RBTREE, 1924193c0f1SVlad Dogaru 1934193c0f1SVlad Dogaru .wr_table = &sx9500_writeable_regs, 1944193c0f1SVlad Dogaru .rd_table = &sx9500_readable_regs, 1954193c0f1SVlad Dogaru .volatile_table = &sx9500_volatile_regs, 1964193c0f1SVlad Dogaru }; 1974193c0f1SVlad Dogaru 1984193c0f1SVlad Dogaru static int sx9500_read_proximity(struct sx9500_data *data, 1994193c0f1SVlad Dogaru const struct iio_chan_spec *chan, 2004193c0f1SVlad Dogaru int *val) 2014193c0f1SVlad Dogaru { 2024193c0f1SVlad Dogaru int ret; 2034193c0f1SVlad Dogaru __be16 regval; 2044193c0f1SVlad Dogaru 2054193c0f1SVlad Dogaru ret = regmap_write(data->regmap, SX9500_REG_SENSOR_SEL, chan->channel); 2064193c0f1SVlad Dogaru if (ret < 0) 2074193c0f1SVlad Dogaru return ret; 2084193c0f1SVlad Dogaru 2094193c0f1SVlad Dogaru ret = regmap_bulk_read(data->regmap, SX9500_REG_USE_MSB, ®val, 2); 2104193c0f1SVlad Dogaru if (ret < 0) 2114193c0f1SVlad Dogaru return ret; 2124193c0f1SVlad Dogaru 2134193c0f1SVlad Dogaru *val = 32767 - (s16)be16_to_cpu(regval); 2144193c0f1SVlad Dogaru 2154193c0f1SVlad Dogaru return IIO_VAL_INT; 2164193c0f1SVlad Dogaru } 2174193c0f1SVlad Dogaru 2184193c0f1SVlad Dogaru static int sx9500_read_samp_freq(struct sx9500_data *data, 2194193c0f1SVlad Dogaru int *val, int *val2) 2204193c0f1SVlad Dogaru { 2214193c0f1SVlad Dogaru int ret; 2224193c0f1SVlad Dogaru unsigned int regval; 2234193c0f1SVlad Dogaru 2244193c0f1SVlad Dogaru mutex_lock(&data->mutex); 2254193c0f1SVlad Dogaru ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0, ®val); 2264193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 2274193c0f1SVlad Dogaru 2284193c0f1SVlad Dogaru if (ret < 0) 2294193c0f1SVlad Dogaru return ret; 2304193c0f1SVlad Dogaru 2314193c0f1SVlad Dogaru regval = (regval & SX9500_SCAN_PERIOD_MASK) >> SX9500_SCAN_PERIOD_SHIFT; 2324193c0f1SVlad Dogaru *val = sx9500_samp_freq_table[regval].val; 2334193c0f1SVlad Dogaru *val2 = sx9500_samp_freq_table[regval].val2; 2344193c0f1SVlad Dogaru 2354193c0f1SVlad Dogaru return IIO_VAL_INT_PLUS_MICRO; 2364193c0f1SVlad Dogaru } 2374193c0f1SVlad Dogaru 2384193c0f1SVlad Dogaru static int sx9500_read_raw(struct iio_dev *indio_dev, 2394193c0f1SVlad Dogaru const struct iio_chan_spec *chan, 2404193c0f1SVlad Dogaru int *val, int *val2, long mask) 2414193c0f1SVlad Dogaru { 2424193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 2434193c0f1SVlad Dogaru int ret; 2444193c0f1SVlad Dogaru 2454193c0f1SVlad Dogaru switch (chan->type) { 2464193c0f1SVlad Dogaru case IIO_PROXIMITY: 2474193c0f1SVlad Dogaru switch (mask) { 2484193c0f1SVlad Dogaru case IIO_CHAN_INFO_RAW: 2494193c0f1SVlad Dogaru if (iio_buffer_enabled(indio_dev)) 2504193c0f1SVlad Dogaru return -EBUSY; 2514193c0f1SVlad Dogaru mutex_lock(&data->mutex); 2524193c0f1SVlad Dogaru ret = sx9500_read_proximity(data, chan, val); 2534193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 2544193c0f1SVlad Dogaru return ret; 2554193c0f1SVlad Dogaru case IIO_CHAN_INFO_SAMP_FREQ: 2564193c0f1SVlad Dogaru return sx9500_read_samp_freq(data, val, val2); 2574193c0f1SVlad Dogaru default: 2584193c0f1SVlad Dogaru return -EINVAL; 2594193c0f1SVlad Dogaru } 2604193c0f1SVlad Dogaru default: 2614193c0f1SVlad Dogaru return -EINVAL; 2624193c0f1SVlad Dogaru } 2634193c0f1SVlad Dogaru } 2644193c0f1SVlad Dogaru 2654193c0f1SVlad Dogaru static int sx9500_set_samp_freq(struct sx9500_data *data, 2664193c0f1SVlad Dogaru int val, int val2) 2674193c0f1SVlad Dogaru { 2684193c0f1SVlad Dogaru int i, ret; 2694193c0f1SVlad Dogaru 2704193c0f1SVlad Dogaru for (i = 0; i < ARRAY_SIZE(sx9500_samp_freq_table); i++) 2714193c0f1SVlad Dogaru if (val == sx9500_samp_freq_table[i].val && 2724193c0f1SVlad Dogaru val2 == sx9500_samp_freq_table[i].val2) 2734193c0f1SVlad Dogaru break; 2744193c0f1SVlad Dogaru 2754193c0f1SVlad Dogaru if (i == ARRAY_SIZE(sx9500_samp_freq_table)) 2764193c0f1SVlad Dogaru return -EINVAL; 2774193c0f1SVlad Dogaru 2784193c0f1SVlad Dogaru mutex_lock(&data->mutex); 2794193c0f1SVlad Dogaru 2804193c0f1SVlad Dogaru ret = regmap_update_bits(data->regmap, SX9500_REG_PROX_CTRL0, 2814193c0f1SVlad Dogaru SX9500_SCAN_PERIOD_MASK, 2824193c0f1SVlad Dogaru i << SX9500_SCAN_PERIOD_SHIFT); 2834193c0f1SVlad Dogaru 2844193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 2854193c0f1SVlad Dogaru 2864193c0f1SVlad Dogaru return ret; 2874193c0f1SVlad Dogaru } 2884193c0f1SVlad Dogaru 2894193c0f1SVlad Dogaru static int sx9500_write_raw(struct iio_dev *indio_dev, 2904193c0f1SVlad Dogaru const struct iio_chan_spec *chan, 2914193c0f1SVlad Dogaru int val, int val2, long mask) 2924193c0f1SVlad Dogaru { 2934193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 2944193c0f1SVlad Dogaru 2954193c0f1SVlad Dogaru switch (chan->type) { 2964193c0f1SVlad Dogaru case IIO_PROXIMITY: 2974193c0f1SVlad Dogaru switch (mask) { 2984193c0f1SVlad Dogaru case IIO_CHAN_INFO_SAMP_FREQ: 2994193c0f1SVlad Dogaru return sx9500_set_samp_freq(data, val, val2); 3004193c0f1SVlad Dogaru default: 3014193c0f1SVlad Dogaru return -EINVAL; 3024193c0f1SVlad Dogaru } 3034193c0f1SVlad Dogaru default: 3044193c0f1SVlad Dogaru return -EINVAL; 3054193c0f1SVlad Dogaru } 3064193c0f1SVlad Dogaru } 3074193c0f1SVlad Dogaru 3084193c0f1SVlad Dogaru static irqreturn_t sx9500_irq_handler(int irq, void *private) 3094193c0f1SVlad Dogaru { 3104193c0f1SVlad Dogaru struct iio_dev *indio_dev = private; 3114193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 3124193c0f1SVlad Dogaru 3134193c0f1SVlad Dogaru if (data->trigger_enabled) 3144193c0f1SVlad Dogaru iio_trigger_poll(data->trig); 3154193c0f1SVlad Dogaru 3164193c0f1SVlad Dogaru /* 3174193c0f1SVlad Dogaru * Even if no event is enabled, we need to wake the thread to 3184193c0f1SVlad Dogaru * clear the interrupt state by reading SX9500_REG_IRQ_SRC. It 3194193c0f1SVlad Dogaru * is not possible to do that here because regmap_read takes a 3204193c0f1SVlad Dogaru * mutex. 3214193c0f1SVlad Dogaru */ 3224193c0f1SVlad Dogaru return IRQ_WAKE_THREAD; 3234193c0f1SVlad Dogaru } 3244193c0f1SVlad Dogaru 3254193c0f1SVlad Dogaru static irqreturn_t sx9500_irq_thread_handler(int irq, void *private) 3264193c0f1SVlad Dogaru { 3274193c0f1SVlad Dogaru struct iio_dev *indio_dev = private; 3284193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 3294193c0f1SVlad Dogaru int ret; 3304193c0f1SVlad Dogaru unsigned int val, chan; 3314193c0f1SVlad Dogaru 3324193c0f1SVlad Dogaru mutex_lock(&data->mutex); 3334193c0f1SVlad Dogaru 3344193c0f1SVlad Dogaru ret = regmap_read(data->regmap, SX9500_REG_IRQ_SRC, &val); 3354193c0f1SVlad Dogaru if (ret < 0) { 3364193c0f1SVlad Dogaru dev_err(&data->client->dev, "i2c transfer error in irq\n"); 3374193c0f1SVlad Dogaru goto out; 3384193c0f1SVlad Dogaru } 3394193c0f1SVlad Dogaru 3404193c0f1SVlad Dogaru if (!(val & (SX9500_CLOSE_IRQ | SX9500_FAR_IRQ))) 3414193c0f1SVlad Dogaru goto out; 3424193c0f1SVlad Dogaru 3434193c0f1SVlad Dogaru ret = regmap_read(data->regmap, SX9500_REG_STAT, &val); 3444193c0f1SVlad Dogaru if (ret < 0) { 3454193c0f1SVlad Dogaru dev_err(&data->client->dev, "i2c transfer error in irq\n"); 3464193c0f1SVlad Dogaru goto out; 3474193c0f1SVlad Dogaru } 3484193c0f1SVlad Dogaru 3494193c0f1SVlad Dogaru val >>= SX9500_PROXSTAT_SHIFT; 3504193c0f1SVlad Dogaru for (chan = 0; chan < SX9500_NUM_CHANNELS; chan++) { 3514193c0f1SVlad Dogaru int dir; 3524193c0f1SVlad Dogaru u64 ev; 3534193c0f1SVlad Dogaru bool new_prox = val & BIT(chan); 3544193c0f1SVlad Dogaru 3554193c0f1SVlad Dogaru if (!data->event_enabled[chan]) 3564193c0f1SVlad Dogaru continue; 3574193c0f1SVlad Dogaru if (new_prox == data->prox_stat[chan]) 3584193c0f1SVlad Dogaru /* No change on this channel. */ 3594193c0f1SVlad Dogaru continue; 3604193c0f1SVlad Dogaru 3614193c0f1SVlad Dogaru dir = new_prox ? IIO_EV_DIR_FALLING : 3624193c0f1SVlad Dogaru IIO_EV_DIR_RISING; 3634193c0f1SVlad Dogaru ev = IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, 3644193c0f1SVlad Dogaru chan, 3654193c0f1SVlad Dogaru IIO_EV_TYPE_THRESH, 3664193c0f1SVlad Dogaru dir); 3674193c0f1SVlad Dogaru iio_push_event(indio_dev, ev, iio_get_time_ns()); 3684193c0f1SVlad Dogaru data->prox_stat[chan] = new_prox; 3694193c0f1SVlad Dogaru } 3704193c0f1SVlad Dogaru 3714193c0f1SVlad Dogaru out: 3724193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 3734193c0f1SVlad Dogaru 3744193c0f1SVlad Dogaru return IRQ_HANDLED; 3754193c0f1SVlad Dogaru } 3764193c0f1SVlad Dogaru 3774193c0f1SVlad Dogaru static int sx9500_read_event_config(struct iio_dev *indio_dev, 3784193c0f1SVlad Dogaru const struct iio_chan_spec *chan, 3794193c0f1SVlad Dogaru enum iio_event_type type, 3804193c0f1SVlad Dogaru enum iio_event_direction dir) 3814193c0f1SVlad Dogaru { 3824193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 3834193c0f1SVlad Dogaru 3844193c0f1SVlad Dogaru if (chan->type != IIO_PROXIMITY || type != IIO_EV_TYPE_THRESH || 3854193c0f1SVlad Dogaru dir != IIO_EV_DIR_EITHER) 3864193c0f1SVlad Dogaru return -EINVAL; 3874193c0f1SVlad Dogaru 3884193c0f1SVlad Dogaru return data->event_enabled[chan->channel]; 3894193c0f1SVlad Dogaru } 3904193c0f1SVlad Dogaru 3914193c0f1SVlad Dogaru static int sx9500_write_event_config(struct iio_dev *indio_dev, 3924193c0f1SVlad Dogaru const struct iio_chan_spec *chan, 3934193c0f1SVlad Dogaru enum iio_event_type type, 3944193c0f1SVlad Dogaru enum iio_event_direction dir, 3954193c0f1SVlad Dogaru int state) 3964193c0f1SVlad Dogaru { 3974193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 3984193c0f1SVlad Dogaru int ret, i; 3994193c0f1SVlad Dogaru bool any_active = false; 4004193c0f1SVlad Dogaru unsigned int irqmask; 4014193c0f1SVlad Dogaru 4024193c0f1SVlad Dogaru if (chan->type != IIO_PROXIMITY || type != IIO_EV_TYPE_THRESH || 4034193c0f1SVlad Dogaru dir != IIO_EV_DIR_EITHER) 4044193c0f1SVlad Dogaru return -EINVAL; 4054193c0f1SVlad Dogaru 4064193c0f1SVlad Dogaru mutex_lock(&data->mutex); 4074193c0f1SVlad Dogaru 4084193c0f1SVlad Dogaru data->event_enabled[chan->channel] = state; 4094193c0f1SVlad Dogaru 4104193c0f1SVlad Dogaru for (i = 0; i < SX9500_NUM_CHANNELS; i++) 4114193c0f1SVlad Dogaru if (data->event_enabled[i]) { 4124193c0f1SVlad Dogaru any_active = true; 4134193c0f1SVlad Dogaru break; 4144193c0f1SVlad Dogaru } 4154193c0f1SVlad Dogaru 4164193c0f1SVlad Dogaru irqmask = SX9500_CLOSE_IRQ | SX9500_FAR_IRQ; 4174193c0f1SVlad Dogaru if (any_active) 4184193c0f1SVlad Dogaru ret = regmap_update_bits(data->regmap, SX9500_REG_IRQ_MSK, 4194193c0f1SVlad Dogaru irqmask, irqmask); 4204193c0f1SVlad Dogaru else 4214193c0f1SVlad Dogaru ret = regmap_update_bits(data->regmap, SX9500_REG_IRQ_MSK, 4224193c0f1SVlad Dogaru irqmask, 0); 4234193c0f1SVlad Dogaru 4244193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 4254193c0f1SVlad Dogaru 4264193c0f1SVlad Dogaru return ret; 4274193c0f1SVlad Dogaru } 4284193c0f1SVlad Dogaru 4294193c0f1SVlad Dogaru static int sx9500_update_scan_mode(struct iio_dev *indio_dev, 4304193c0f1SVlad Dogaru const unsigned long *scan_mask) 4314193c0f1SVlad Dogaru { 4324193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 4334193c0f1SVlad Dogaru 4344193c0f1SVlad Dogaru mutex_lock(&data->mutex); 4354193c0f1SVlad Dogaru kfree(data->buffer); 4364193c0f1SVlad Dogaru data->buffer = kzalloc(indio_dev->scan_bytes, GFP_KERNEL); 4374193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 4384193c0f1SVlad Dogaru 4394193c0f1SVlad Dogaru if (data->buffer == NULL) 4404193c0f1SVlad Dogaru return -ENOMEM; 4414193c0f1SVlad Dogaru 4424193c0f1SVlad Dogaru return 0; 4434193c0f1SVlad Dogaru } 4444193c0f1SVlad Dogaru 4454193c0f1SVlad Dogaru static IIO_CONST_ATTR_SAMP_FREQ_AVAIL( 4464193c0f1SVlad Dogaru "2.500000 3.333333 5 6.666666 8.333333 11.111111 16.666666 33.333333"); 4474193c0f1SVlad Dogaru 4484193c0f1SVlad Dogaru static struct attribute *sx9500_attributes[] = { 4494193c0f1SVlad Dogaru &iio_const_attr_sampling_frequency_available.dev_attr.attr, 4504193c0f1SVlad Dogaru NULL, 4514193c0f1SVlad Dogaru }; 4524193c0f1SVlad Dogaru 4534193c0f1SVlad Dogaru static const struct attribute_group sx9500_attribute_group = { 4544193c0f1SVlad Dogaru .attrs = sx9500_attributes, 4554193c0f1SVlad Dogaru }; 4564193c0f1SVlad Dogaru 4574193c0f1SVlad Dogaru static const struct iio_info sx9500_info = { 4584193c0f1SVlad Dogaru .driver_module = THIS_MODULE, 4594193c0f1SVlad Dogaru .attrs = &sx9500_attribute_group, 4604193c0f1SVlad Dogaru .read_raw = &sx9500_read_raw, 4614193c0f1SVlad Dogaru .write_raw = &sx9500_write_raw, 4624193c0f1SVlad Dogaru .read_event_config = &sx9500_read_event_config, 4634193c0f1SVlad Dogaru .write_event_config = &sx9500_write_event_config, 4644193c0f1SVlad Dogaru .update_scan_mode = &sx9500_update_scan_mode, 4654193c0f1SVlad Dogaru }; 4664193c0f1SVlad Dogaru 4674193c0f1SVlad Dogaru static int sx9500_set_trigger_state(struct iio_trigger *trig, 4684193c0f1SVlad Dogaru bool state) 4694193c0f1SVlad Dogaru { 4704193c0f1SVlad Dogaru struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 4714193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 4724193c0f1SVlad Dogaru int ret; 4734193c0f1SVlad Dogaru 4744193c0f1SVlad Dogaru mutex_lock(&data->mutex); 4754193c0f1SVlad Dogaru 4764193c0f1SVlad Dogaru ret = regmap_update_bits(data->regmap, SX9500_REG_IRQ_MSK, 4774193c0f1SVlad Dogaru SX9500_CONVDONE_IRQ, 4784193c0f1SVlad Dogaru state ? SX9500_CONVDONE_IRQ : 0); 4794193c0f1SVlad Dogaru if (ret == 0) 4804193c0f1SVlad Dogaru data->trigger_enabled = state; 4814193c0f1SVlad Dogaru 4824193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 4834193c0f1SVlad Dogaru 4844193c0f1SVlad Dogaru return ret; 4854193c0f1SVlad Dogaru } 4864193c0f1SVlad Dogaru 4874193c0f1SVlad Dogaru static const struct iio_trigger_ops sx9500_trigger_ops = { 4884193c0f1SVlad Dogaru .set_trigger_state = sx9500_set_trigger_state, 4894193c0f1SVlad Dogaru .owner = THIS_MODULE, 4904193c0f1SVlad Dogaru }; 4914193c0f1SVlad Dogaru 4924193c0f1SVlad Dogaru static irqreturn_t sx9500_trigger_handler(int irq, void *private) 4934193c0f1SVlad Dogaru { 4944193c0f1SVlad Dogaru struct iio_poll_func *pf = private; 4954193c0f1SVlad Dogaru struct iio_dev *indio_dev = pf->indio_dev; 4964193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 4974193c0f1SVlad Dogaru int val, bit, ret, i = 0; 4984193c0f1SVlad Dogaru 4994193c0f1SVlad Dogaru mutex_lock(&data->mutex); 5004193c0f1SVlad Dogaru 50170dddeeeSOctavian Purdila for_each_set_bit(bit, indio_dev->active_scan_mask, 5024193c0f1SVlad Dogaru indio_dev->masklength) { 5034193c0f1SVlad Dogaru ret = sx9500_read_proximity(data, &indio_dev->channels[bit], 5044193c0f1SVlad Dogaru &val); 5054193c0f1SVlad Dogaru if (ret < 0) 5064193c0f1SVlad Dogaru goto out; 5074193c0f1SVlad Dogaru 5084193c0f1SVlad Dogaru data->buffer[i++] = val; 5094193c0f1SVlad Dogaru } 5104193c0f1SVlad Dogaru 5114193c0f1SVlad Dogaru iio_push_to_buffers_with_timestamp(indio_dev, data->buffer, 5124193c0f1SVlad Dogaru iio_get_time_ns()); 5134193c0f1SVlad Dogaru 5144193c0f1SVlad Dogaru out: 5154193c0f1SVlad Dogaru mutex_unlock(&data->mutex); 5164193c0f1SVlad Dogaru 5174193c0f1SVlad Dogaru iio_trigger_notify_done(indio_dev->trig); 5184193c0f1SVlad Dogaru 5194193c0f1SVlad Dogaru return IRQ_HANDLED; 5204193c0f1SVlad Dogaru } 5214193c0f1SVlad Dogaru 5224193c0f1SVlad Dogaru struct sx9500_reg_default { 5234193c0f1SVlad Dogaru u8 reg; 5244193c0f1SVlad Dogaru u8 def; 5254193c0f1SVlad Dogaru }; 5264193c0f1SVlad Dogaru 5274193c0f1SVlad Dogaru static const struct sx9500_reg_default sx9500_default_regs[] = { 5284193c0f1SVlad Dogaru { 5294193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL1, 5304193c0f1SVlad Dogaru /* Shield enabled, small range. */ 5314193c0f1SVlad Dogaru .def = 0x43, 5324193c0f1SVlad Dogaru }, 5334193c0f1SVlad Dogaru { 5344193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL2, 5354193c0f1SVlad Dogaru /* x8 gain, 167kHz frequency, finest resolution. */ 5364193c0f1SVlad Dogaru .def = 0x77, 5374193c0f1SVlad Dogaru }, 5384193c0f1SVlad Dogaru { 5394193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL3, 5404193c0f1SVlad Dogaru /* Doze enabled, 2x scan period doze, no raw filter. */ 5414193c0f1SVlad Dogaru .def = 0x40, 5424193c0f1SVlad Dogaru }, 5434193c0f1SVlad Dogaru { 5444193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL4, 5454193c0f1SVlad Dogaru /* Average threshold. */ 5464193c0f1SVlad Dogaru .def = 0x30, 5474193c0f1SVlad Dogaru }, 5484193c0f1SVlad Dogaru { 5494193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL5, 5504193c0f1SVlad Dogaru /* 5514193c0f1SVlad Dogaru * Debouncer off, lowest average negative filter, 5524193c0f1SVlad Dogaru * highest average postive filter. 5534193c0f1SVlad Dogaru */ 5544193c0f1SVlad Dogaru .def = 0x0f, 5554193c0f1SVlad Dogaru }, 5564193c0f1SVlad Dogaru { 5574193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL6, 5584193c0f1SVlad Dogaru /* Proximity detection threshold: 280 */ 5594193c0f1SVlad Dogaru .def = 0x0e, 5604193c0f1SVlad Dogaru }, 5614193c0f1SVlad Dogaru { 5624193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL7, 5634193c0f1SVlad Dogaru /* 5644193c0f1SVlad Dogaru * No automatic compensation, compensate each pin 5654193c0f1SVlad Dogaru * independently, proximity hysteresis: 32, close 5664193c0f1SVlad Dogaru * debouncer off, far debouncer off. 5674193c0f1SVlad Dogaru */ 5684193c0f1SVlad Dogaru .def = 0x00, 5694193c0f1SVlad Dogaru }, 5704193c0f1SVlad Dogaru { 5714193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL8, 5724193c0f1SVlad Dogaru /* No stuck timeout, no periodic compensation. */ 5734193c0f1SVlad Dogaru .def = 0x00, 5744193c0f1SVlad Dogaru }, 5754193c0f1SVlad Dogaru { 5764193c0f1SVlad Dogaru .reg = SX9500_REG_PROX_CTRL0, 5774193c0f1SVlad Dogaru /* Scan period: 30ms, all sensors enabled. */ 5784193c0f1SVlad Dogaru .def = 0x0f, 5794193c0f1SVlad Dogaru }, 5804193c0f1SVlad Dogaru }; 5814193c0f1SVlad Dogaru 5824193c0f1SVlad Dogaru static int sx9500_init_device(struct iio_dev *indio_dev) 5834193c0f1SVlad Dogaru { 5844193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 5854193c0f1SVlad Dogaru int ret, i; 5864193c0f1SVlad Dogaru unsigned int val; 5874193c0f1SVlad Dogaru 5884193c0f1SVlad Dogaru ret = regmap_write(data->regmap, SX9500_REG_IRQ_MSK, 0); 5894193c0f1SVlad Dogaru if (ret < 0) 5904193c0f1SVlad Dogaru return ret; 5914193c0f1SVlad Dogaru 5924193c0f1SVlad Dogaru ret = regmap_write(data->regmap, SX9500_REG_RESET, 5934193c0f1SVlad Dogaru SX9500_SOFT_RESET); 5944193c0f1SVlad Dogaru if (ret < 0) 5954193c0f1SVlad Dogaru return ret; 5964193c0f1SVlad Dogaru 5974193c0f1SVlad Dogaru ret = regmap_read(data->regmap, SX9500_REG_IRQ_SRC, &val); 5984193c0f1SVlad Dogaru if (ret < 0) 5994193c0f1SVlad Dogaru return ret; 6004193c0f1SVlad Dogaru 6014193c0f1SVlad Dogaru for (i = 0; i < ARRAY_SIZE(sx9500_default_regs); i++) { 6024193c0f1SVlad Dogaru ret = regmap_write(data->regmap, 6034193c0f1SVlad Dogaru sx9500_default_regs[i].reg, 6044193c0f1SVlad Dogaru sx9500_default_regs[i].def); 6054193c0f1SVlad Dogaru if (ret < 0) 6064193c0f1SVlad Dogaru return ret; 6074193c0f1SVlad Dogaru } 6084193c0f1SVlad Dogaru 6094193c0f1SVlad Dogaru return 0; 6104193c0f1SVlad Dogaru } 6114193c0f1SVlad Dogaru 6124193c0f1SVlad Dogaru static int sx9500_gpio_probe(struct i2c_client *client, 6134193c0f1SVlad Dogaru struct sx9500_data *data) 6144193c0f1SVlad Dogaru { 6154193c0f1SVlad Dogaru struct device *dev; 6164193c0f1SVlad Dogaru struct gpio_desc *gpio; 6174193c0f1SVlad Dogaru int ret; 6184193c0f1SVlad Dogaru 6194193c0f1SVlad Dogaru if (!client) 6204193c0f1SVlad Dogaru return -EINVAL; 6214193c0f1SVlad Dogaru 6224193c0f1SVlad Dogaru dev = &client->dev; 6234193c0f1SVlad Dogaru 6244193c0f1SVlad Dogaru /* data ready gpio interrupt pin */ 625b457f53aSUwe Kleine-König gpio = devm_gpiod_get_index(dev, SX9500_GPIO_NAME, 0, GPIOD_IN); 6264193c0f1SVlad Dogaru if (IS_ERR(gpio)) { 6274193c0f1SVlad Dogaru dev_err(dev, "acpi gpio get index failed\n"); 6284193c0f1SVlad Dogaru return PTR_ERR(gpio); 6294193c0f1SVlad Dogaru } 6304193c0f1SVlad Dogaru 6314193c0f1SVlad Dogaru ret = gpiod_to_irq(gpio); 6324193c0f1SVlad Dogaru 6334193c0f1SVlad Dogaru dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret); 6344193c0f1SVlad Dogaru 6354193c0f1SVlad Dogaru return ret; 6364193c0f1SVlad Dogaru } 6374193c0f1SVlad Dogaru 6384193c0f1SVlad Dogaru static int sx9500_probe(struct i2c_client *client, 6394193c0f1SVlad Dogaru const struct i2c_device_id *id) 6404193c0f1SVlad Dogaru { 6414193c0f1SVlad Dogaru int ret; 6424193c0f1SVlad Dogaru struct iio_dev *indio_dev; 6434193c0f1SVlad Dogaru struct sx9500_data *data; 6444193c0f1SVlad Dogaru 6454193c0f1SVlad Dogaru indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 6464193c0f1SVlad Dogaru if (indio_dev == NULL) 6474193c0f1SVlad Dogaru return -ENOMEM; 6484193c0f1SVlad Dogaru 6494193c0f1SVlad Dogaru data = iio_priv(indio_dev); 6504193c0f1SVlad Dogaru data->client = client; 6514193c0f1SVlad Dogaru mutex_init(&data->mutex); 6524193c0f1SVlad Dogaru data->trigger_enabled = false; 6534193c0f1SVlad Dogaru 6544193c0f1SVlad Dogaru data->regmap = devm_regmap_init_i2c(client, &sx9500_regmap_config); 6554193c0f1SVlad Dogaru if (IS_ERR(data->regmap)) 6564193c0f1SVlad Dogaru return PTR_ERR(data->regmap); 6574193c0f1SVlad Dogaru 6584193c0f1SVlad Dogaru sx9500_init_device(indio_dev); 6594193c0f1SVlad Dogaru 6604193c0f1SVlad Dogaru indio_dev->dev.parent = &client->dev; 6614193c0f1SVlad Dogaru indio_dev->name = SX9500_DRIVER_NAME; 6624193c0f1SVlad Dogaru indio_dev->channels = sx9500_channels; 6634193c0f1SVlad Dogaru indio_dev->num_channels = ARRAY_SIZE(sx9500_channels); 6644193c0f1SVlad Dogaru indio_dev->info = &sx9500_info; 6654193c0f1SVlad Dogaru indio_dev->modes = INDIO_DIRECT_MODE; 6664193c0f1SVlad Dogaru i2c_set_clientdata(client, indio_dev); 6674193c0f1SVlad Dogaru 6684193c0f1SVlad Dogaru if (client->irq <= 0) 6694193c0f1SVlad Dogaru client->irq = sx9500_gpio_probe(client, data); 6704193c0f1SVlad Dogaru 6714193c0f1SVlad Dogaru if (client->irq > 0) { 6724193c0f1SVlad Dogaru ret = devm_request_threaded_irq(&client->dev, client->irq, 6734193c0f1SVlad Dogaru sx9500_irq_handler, sx9500_irq_thread_handler, 6744193c0f1SVlad Dogaru IRQF_TRIGGER_FALLING | IRQF_ONESHOT, 6754193c0f1SVlad Dogaru SX9500_IRQ_NAME, indio_dev); 6764193c0f1SVlad Dogaru if (ret < 0) 6774193c0f1SVlad Dogaru return ret; 6784193c0f1SVlad Dogaru 6794193c0f1SVlad Dogaru data->trig = devm_iio_trigger_alloc(&client->dev, 6804193c0f1SVlad Dogaru "%s-dev%d", indio_dev->name, indio_dev->id); 6814193c0f1SVlad Dogaru if (!data->trig) 6824193c0f1SVlad Dogaru return -ENOMEM; 6834193c0f1SVlad Dogaru 6844193c0f1SVlad Dogaru data->trig->dev.parent = &client->dev; 6854193c0f1SVlad Dogaru data->trig->ops = &sx9500_trigger_ops; 6864193c0f1SVlad Dogaru iio_trigger_set_drvdata(data->trig, indio_dev); 6874193c0f1SVlad Dogaru 6884193c0f1SVlad Dogaru ret = iio_trigger_register(data->trig); 6894193c0f1SVlad Dogaru if (ret) 6904193c0f1SVlad Dogaru return ret; 6914193c0f1SVlad Dogaru } 6924193c0f1SVlad Dogaru 6934193c0f1SVlad Dogaru ret = iio_triggered_buffer_setup(indio_dev, NULL, 6944193c0f1SVlad Dogaru sx9500_trigger_handler, NULL); 6954193c0f1SVlad Dogaru if (ret < 0) 6964193c0f1SVlad Dogaru goto out_trigger_unregister; 6974193c0f1SVlad Dogaru 6984193c0f1SVlad Dogaru ret = iio_device_register(indio_dev); 6994193c0f1SVlad Dogaru if (ret < 0) 7004193c0f1SVlad Dogaru goto out_buffer_cleanup; 7014193c0f1SVlad Dogaru 7024193c0f1SVlad Dogaru return 0; 7034193c0f1SVlad Dogaru 7044193c0f1SVlad Dogaru out_buffer_cleanup: 7054193c0f1SVlad Dogaru iio_triggered_buffer_cleanup(indio_dev); 7064193c0f1SVlad Dogaru out_trigger_unregister: 7074193c0f1SVlad Dogaru if (client->irq > 0) 7084193c0f1SVlad Dogaru iio_trigger_unregister(data->trig); 7094193c0f1SVlad Dogaru 7104193c0f1SVlad Dogaru return ret; 7114193c0f1SVlad Dogaru } 7124193c0f1SVlad Dogaru 7134193c0f1SVlad Dogaru static int sx9500_remove(struct i2c_client *client) 7144193c0f1SVlad Dogaru { 7154193c0f1SVlad Dogaru struct iio_dev *indio_dev = i2c_get_clientdata(client); 7164193c0f1SVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 7174193c0f1SVlad Dogaru 7184193c0f1SVlad Dogaru iio_device_unregister(indio_dev); 7194193c0f1SVlad Dogaru iio_triggered_buffer_cleanup(indio_dev); 7204193c0f1SVlad Dogaru if (client->irq > 0) 7214193c0f1SVlad Dogaru iio_trigger_unregister(data->trig); 7224193c0f1SVlad Dogaru kfree(data->buffer); 7234193c0f1SVlad Dogaru 7244193c0f1SVlad Dogaru return 0; 7254193c0f1SVlad Dogaru } 7264193c0f1SVlad Dogaru 7277840ffeeSVlad Dogaru #ifdef CONFIG_PM_SLEEP 7287840ffeeSVlad Dogaru static int sx9500_suspend(struct device *dev) 7297840ffeeSVlad Dogaru { 7307840ffeeSVlad Dogaru struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 7317840ffeeSVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 7327840ffeeSVlad Dogaru int ret; 7337840ffeeSVlad Dogaru 7347840ffeeSVlad Dogaru mutex_lock(&data->mutex); 7357840ffeeSVlad Dogaru ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0, 7367840ffeeSVlad Dogaru &data->suspend_ctrl0); 7377840ffeeSVlad Dogaru if (ret < 0) 7387840ffeeSVlad Dogaru goto out; 7397840ffeeSVlad Dogaru 7407840ffeeSVlad Dogaru /* 7417840ffeeSVlad Dogaru * Scan period doesn't matter because when all the sensors are 7427840ffeeSVlad Dogaru * deactivated the device is in sleep mode. 7437840ffeeSVlad Dogaru */ 7447840ffeeSVlad Dogaru ret = regmap_write(data->regmap, SX9500_REG_PROX_CTRL0, 0); 7457840ffeeSVlad Dogaru 7467840ffeeSVlad Dogaru out: 7477840ffeeSVlad Dogaru mutex_unlock(&data->mutex); 7487840ffeeSVlad Dogaru return ret; 7497840ffeeSVlad Dogaru } 7507840ffeeSVlad Dogaru 7517840ffeeSVlad Dogaru static int sx9500_resume(struct device *dev) 7527840ffeeSVlad Dogaru { 7537840ffeeSVlad Dogaru struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 7547840ffeeSVlad Dogaru struct sx9500_data *data = iio_priv(indio_dev); 7557840ffeeSVlad Dogaru int ret; 7567840ffeeSVlad Dogaru 7577840ffeeSVlad Dogaru mutex_lock(&data->mutex); 7587840ffeeSVlad Dogaru ret = regmap_write(data->regmap, SX9500_REG_PROX_CTRL0, 7597840ffeeSVlad Dogaru data->suspend_ctrl0); 7607840ffeeSVlad Dogaru mutex_unlock(&data->mutex); 7617840ffeeSVlad Dogaru 7627840ffeeSVlad Dogaru return ret; 7637840ffeeSVlad Dogaru } 7647840ffeeSVlad Dogaru #endif /* CONFIG_PM_SLEEP */ 7657840ffeeSVlad Dogaru 7667840ffeeSVlad Dogaru static const struct dev_pm_ops sx9500_pm_ops = { 7677840ffeeSVlad Dogaru SET_SYSTEM_SLEEP_PM_OPS(sx9500_suspend, sx9500_resume) 7687840ffeeSVlad Dogaru }; 7697840ffeeSVlad Dogaru 7704193c0f1SVlad Dogaru static const struct acpi_device_id sx9500_acpi_match[] = { 7714193c0f1SVlad Dogaru {"SSX9500", 0}, 7724193c0f1SVlad Dogaru { }, 7734193c0f1SVlad Dogaru }; 7744193c0f1SVlad Dogaru MODULE_DEVICE_TABLE(acpi, sx9500_acpi_match); 7754193c0f1SVlad Dogaru 7764193c0f1SVlad Dogaru static const struct i2c_device_id sx9500_id[] = { 7774193c0f1SVlad Dogaru {"sx9500", 0}, 7784193c0f1SVlad Dogaru {} 7794193c0f1SVlad Dogaru }; 7804193c0f1SVlad Dogaru MODULE_DEVICE_TABLE(i2c, sx9500_id); 7814193c0f1SVlad Dogaru 7824193c0f1SVlad Dogaru static struct i2c_driver sx9500_driver = { 7834193c0f1SVlad Dogaru .driver = { 7844193c0f1SVlad Dogaru .name = SX9500_DRIVER_NAME, 7854193c0f1SVlad Dogaru .acpi_match_table = ACPI_PTR(sx9500_acpi_match), 7867840ffeeSVlad Dogaru .pm = &sx9500_pm_ops, 7874193c0f1SVlad Dogaru }, 7884193c0f1SVlad Dogaru .probe = sx9500_probe, 7894193c0f1SVlad Dogaru .remove = sx9500_remove, 7904193c0f1SVlad Dogaru .id_table = sx9500_id, 7914193c0f1SVlad Dogaru }; 7924193c0f1SVlad Dogaru module_i2c_driver(sx9500_driver); 7934193c0f1SVlad Dogaru 7944193c0f1SVlad Dogaru MODULE_AUTHOR("Vlad Dogaru <vlad.dogaru@intel.com>"); 7954193c0f1SVlad Dogaru MODULE_DESCRIPTION("Driver for Semtech SX9500 proximity sensor"); 7964193c0f1SVlad Dogaru MODULE_LICENSE("GPL v2"); 797