162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (c) 2014 Intel Corporation 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Driver for Semtech's SX9500 capacitive proximity/button solution. 662306a36Sopenharmony_ci * Datasheet available at 762306a36Sopenharmony_ci * <http://www.semtech.com/images/datasheet/sx9500.pdf>. 862306a36Sopenharmony_ci */ 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ci#include <linux/kernel.h> 1162306a36Sopenharmony_ci#include <linux/slab.h> 1262306a36Sopenharmony_ci#include <linux/module.h> 1362306a36Sopenharmony_ci#include <linux/i2c.h> 1462306a36Sopenharmony_ci#include <linux/irq.h> 1562306a36Sopenharmony_ci#include <linux/acpi.h> 1662306a36Sopenharmony_ci#include <linux/gpio/consumer.h> 1762306a36Sopenharmony_ci#include <linux/regmap.h> 1862306a36Sopenharmony_ci#include <linux/pm.h> 1962306a36Sopenharmony_ci#include <linux/delay.h> 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci#include <linux/iio/iio.h> 2262306a36Sopenharmony_ci#include <linux/iio/buffer.h> 2362306a36Sopenharmony_ci#include <linux/iio/sysfs.h> 2462306a36Sopenharmony_ci#include <linux/iio/events.h> 2562306a36Sopenharmony_ci#include <linux/iio/trigger.h> 2662306a36Sopenharmony_ci#include <linux/iio/triggered_buffer.h> 2762306a36Sopenharmony_ci#include <linux/iio/trigger_consumer.h> 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci#define SX9500_DRIVER_NAME "sx9500" 3062306a36Sopenharmony_ci#define SX9500_IRQ_NAME "sx9500_event" 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci/* Register definitions. */ 3362306a36Sopenharmony_ci#define SX9500_REG_IRQ_SRC 0x00 3462306a36Sopenharmony_ci#define SX9500_REG_STAT 0x01 3562306a36Sopenharmony_ci#define SX9500_REG_IRQ_MSK 0x03 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL0 0x06 3862306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL1 0x07 3962306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL2 0x08 4062306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL3 0x09 4162306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL4 0x0a 4262306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL5 0x0b 4362306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL6 0x0c 4462306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL7 0x0d 4562306a36Sopenharmony_ci#define SX9500_REG_PROX_CTRL8 0x0e 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci#define SX9500_REG_SENSOR_SEL 0x20 4862306a36Sopenharmony_ci#define SX9500_REG_USE_MSB 0x21 4962306a36Sopenharmony_ci#define SX9500_REG_USE_LSB 0x22 5062306a36Sopenharmony_ci#define SX9500_REG_AVG_MSB 0x23 5162306a36Sopenharmony_ci#define SX9500_REG_AVG_LSB 0x24 5262306a36Sopenharmony_ci#define SX9500_REG_DIFF_MSB 0x25 5362306a36Sopenharmony_ci#define SX9500_REG_DIFF_LSB 0x26 5462306a36Sopenharmony_ci#define SX9500_REG_OFFSET_MSB 0x27 5562306a36Sopenharmony_ci#define SX9500_REG_OFFSET_LSB 0x28 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci#define SX9500_REG_RESET 0x7f 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_ci/* Write this to REG_RESET to do a soft reset. */ 6062306a36Sopenharmony_ci#define SX9500_SOFT_RESET 0xde 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci#define SX9500_SCAN_PERIOD_MASK GENMASK(6, 4) 6362306a36Sopenharmony_ci#define SX9500_SCAN_PERIOD_SHIFT 4 6462306a36Sopenharmony_ci 6562306a36Sopenharmony_ci/* 6662306a36Sopenharmony_ci * These serve for identifying IRQ source in the IRQ_SRC register, and 6762306a36Sopenharmony_ci * also for masking the IRQs in the IRQ_MSK register. 6862306a36Sopenharmony_ci */ 6962306a36Sopenharmony_ci#define SX9500_CLOSE_IRQ BIT(6) 7062306a36Sopenharmony_ci#define SX9500_FAR_IRQ BIT(5) 7162306a36Sopenharmony_ci#define SX9500_CONVDONE_IRQ BIT(3) 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ci#define SX9500_PROXSTAT_SHIFT 4 7462306a36Sopenharmony_ci#define SX9500_COMPSTAT_MASK GENMASK(3, 0) 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci#define SX9500_NUM_CHANNELS 4 7762306a36Sopenharmony_ci#define SX9500_CHAN_MASK GENMASK(SX9500_NUM_CHANNELS - 1, 0) 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_cistruct sx9500_data { 8062306a36Sopenharmony_ci struct mutex mutex; 8162306a36Sopenharmony_ci struct i2c_client *client; 8262306a36Sopenharmony_ci struct iio_trigger *trig; 8362306a36Sopenharmony_ci struct regmap *regmap; 8462306a36Sopenharmony_ci struct gpio_desc *gpiod_rst; 8562306a36Sopenharmony_ci /* 8662306a36Sopenharmony_ci * Last reading of the proximity status for each channel. We 8762306a36Sopenharmony_ci * only send an event to user space when this changes. 8862306a36Sopenharmony_ci */ 8962306a36Sopenharmony_ci bool prox_stat[SX9500_NUM_CHANNELS]; 9062306a36Sopenharmony_ci bool event_enabled[SX9500_NUM_CHANNELS]; 9162306a36Sopenharmony_ci bool trigger_enabled; 9262306a36Sopenharmony_ci u16 *buffer; 9362306a36Sopenharmony_ci /* Remember enabled channels and sample rate during suspend. */ 9462306a36Sopenharmony_ci unsigned int suspend_ctrl0; 9562306a36Sopenharmony_ci struct completion completion; 9662306a36Sopenharmony_ci int data_rdy_users, close_far_users; 9762306a36Sopenharmony_ci int channel_users[SX9500_NUM_CHANNELS]; 9862306a36Sopenharmony_ci}; 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_cistatic const struct iio_event_spec sx9500_events[] = { 10162306a36Sopenharmony_ci { 10262306a36Sopenharmony_ci .type = IIO_EV_TYPE_THRESH, 10362306a36Sopenharmony_ci .dir = IIO_EV_DIR_EITHER, 10462306a36Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_ENABLE), 10562306a36Sopenharmony_ci }, 10662306a36Sopenharmony_ci}; 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci#define SX9500_CHANNEL(idx) \ 10962306a36Sopenharmony_ci { \ 11062306a36Sopenharmony_ci .type = IIO_PROXIMITY, \ 11162306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 11262306a36Sopenharmony_ci .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \ 11362306a36Sopenharmony_ci .indexed = 1, \ 11462306a36Sopenharmony_ci .channel = idx, \ 11562306a36Sopenharmony_ci .event_spec = sx9500_events, \ 11662306a36Sopenharmony_ci .num_event_specs = ARRAY_SIZE(sx9500_events), \ 11762306a36Sopenharmony_ci .scan_index = idx, \ 11862306a36Sopenharmony_ci .scan_type = { \ 11962306a36Sopenharmony_ci .sign = 'u', \ 12062306a36Sopenharmony_ci .realbits = 16, \ 12162306a36Sopenharmony_ci .storagebits = 16, \ 12262306a36Sopenharmony_ci .shift = 0, \ 12362306a36Sopenharmony_ci }, \ 12462306a36Sopenharmony_ci } 12562306a36Sopenharmony_ci 12662306a36Sopenharmony_cistatic const struct iio_chan_spec sx9500_channels[] = { 12762306a36Sopenharmony_ci SX9500_CHANNEL(0), 12862306a36Sopenharmony_ci SX9500_CHANNEL(1), 12962306a36Sopenharmony_ci SX9500_CHANNEL(2), 13062306a36Sopenharmony_ci SX9500_CHANNEL(3), 13162306a36Sopenharmony_ci IIO_CHAN_SOFT_TIMESTAMP(4), 13262306a36Sopenharmony_ci}; 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_cistatic const struct { 13562306a36Sopenharmony_ci int val; 13662306a36Sopenharmony_ci int val2; 13762306a36Sopenharmony_ci} sx9500_samp_freq_table[] = { 13862306a36Sopenharmony_ci {33, 333333}, 13962306a36Sopenharmony_ci {16, 666666}, 14062306a36Sopenharmony_ci {11, 111111}, 14162306a36Sopenharmony_ci {8, 333333}, 14262306a36Sopenharmony_ci {6, 666666}, 14362306a36Sopenharmony_ci {5, 0}, 14462306a36Sopenharmony_ci {3, 333333}, 14562306a36Sopenharmony_ci {2, 500000}, 14662306a36Sopenharmony_ci}; 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_cistatic const unsigned int sx9500_scan_period_table[] = { 14962306a36Sopenharmony_ci 30, 60, 90, 120, 150, 200, 300, 400, 15062306a36Sopenharmony_ci}; 15162306a36Sopenharmony_ci 15262306a36Sopenharmony_cistatic const struct regmap_range sx9500_writable_reg_ranges[] = { 15362306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_IRQ_MSK, SX9500_REG_IRQ_MSK), 15462306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_PROX_CTRL0, SX9500_REG_PROX_CTRL8), 15562306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_SENSOR_SEL, SX9500_REG_SENSOR_SEL), 15662306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_OFFSET_MSB, SX9500_REG_OFFSET_LSB), 15762306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_RESET, SX9500_REG_RESET), 15862306a36Sopenharmony_ci}; 15962306a36Sopenharmony_ci 16062306a36Sopenharmony_cistatic const struct regmap_access_table sx9500_writeable_regs = { 16162306a36Sopenharmony_ci .yes_ranges = sx9500_writable_reg_ranges, 16262306a36Sopenharmony_ci .n_yes_ranges = ARRAY_SIZE(sx9500_writable_reg_ranges), 16362306a36Sopenharmony_ci}; 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci/* 16662306a36Sopenharmony_ci * All allocated registers are readable, so we just list unallocated 16762306a36Sopenharmony_ci * ones. 16862306a36Sopenharmony_ci */ 16962306a36Sopenharmony_cistatic const struct regmap_range sx9500_non_readable_reg_ranges[] = { 17062306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_STAT + 1, SX9500_REG_STAT + 1), 17162306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_IRQ_MSK + 1, SX9500_REG_PROX_CTRL0 - 1), 17262306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_PROX_CTRL8 + 1, SX9500_REG_SENSOR_SEL - 1), 17362306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_OFFSET_LSB + 1, SX9500_REG_RESET - 1), 17462306a36Sopenharmony_ci}; 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_cistatic const struct regmap_access_table sx9500_readable_regs = { 17762306a36Sopenharmony_ci .no_ranges = sx9500_non_readable_reg_ranges, 17862306a36Sopenharmony_ci .n_no_ranges = ARRAY_SIZE(sx9500_non_readable_reg_ranges), 17962306a36Sopenharmony_ci}; 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_cistatic const struct regmap_range sx9500_volatile_reg_ranges[] = { 18262306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_IRQ_SRC, SX9500_REG_STAT), 18362306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_USE_MSB, SX9500_REG_OFFSET_LSB), 18462306a36Sopenharmony_ci regmap_reg_range(SX9500_REG_RESET, SX9500_REG_RESET), 18562306a36Sopenharmony_ci}; 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_cistatic const struct regmap_access_table sx9500_volatile_regs = { 18862306a36Sopenharmony_ci .yes_ranges = sx9500_volatile_reg_ranges, 18962306a36Sopenharmony_ci .n_yes_ranges = ARRAY_SIZE(sx9500_volatile_reg_ranges), 19062306a36Sopenharmony_ci}; 19162306a36Sopenharmony_ci 19262306a36Sopenharmony_cistatic const struct regmap_config sx9500_regmap_config = { 19362306a36Sopenharmony_ci .reg_bits = 8, 19462306a36Sopenharmony_ci .val_bits = 8, 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci .max_register = SX9500_REG_RESET, 19762306a36Sopenharmony_ci .cache_type = REGCACHE_RBTREE, 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_ci .wr_table = &sx9500_writeable_regs, 20062306a36Sopenharmony_ci .rd_table = &sx9500_readable_regs, 20162306a36Sopenharmony_ci .volatile_table = &sx9500_volatile_regs, 20262306a36Sopenharmony_ci}; 20362306a36Sopenharmony_ci 20462306a36Sopenharmony_cistatic int sx9500_inc_users(struct sx9500_data *data, int *counter, 20562306a36Sopenharmony_ci unsigned int reg, unsigned int bitmask) 20662306a36Sopenharmony_ci{ 20762306a36Sopenharmony_ci (*counter)++; 20862306a36Sopenharmony_ci if (*counter != 1) 20962306a36Sopenharmony_ci /* Bit is already active, nothing to do. */ 21062306a36Sopenharmony_ci return 0; 21162306a36Sopenharmony_ci 21262306a36Sopenharmony_ci return regmap_update_bits(data->regmap, reg, bitmask, bitmask); 21362306a36Sopenharmony_ci} 21462306a36Sopenharmony_ci 21562306a36Sopenharmony_cistatic int sx9500_dec_users(struct sx9500_data *data, int *counter, 21662306a36Sopenharmony_ci unsigned int reg, unsigned int bitmask) 21762306a36Sopenharmony_ci{ 21862306a36Sopenharmony_ci (*counter)--; 21962306a36Sopenharmony_ci if (*counter != 0) 22062306a36Sopenharmony_ci /* There are more users, do not deactivate. */ 22162306a36Sopenharmony_ci return 0; 22262306a36Sopenharmony_ci 22362306a36Sopenharmony_ci return regmap_update_bits(data->regmap, reg, bitmask, 0); 22462306a36Sopenharmony_ci} 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_cistatic int sx9500_inc_chan_users(struct sx9500_data *data, int chan) 22762306a36Sopenharmony_ci{ 22862306a36Sopenharmony_ci return sx9500_inc_users(data, &data->channel_users[chan], 22962306a36Sopenharmony_ci SX9500_REG_PROX_CTRL0, BIT(chan)); 23062306a36Sopenharmony_ci} 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_cistatic int sx9500_dec_chan_users(struct sx9500_data *data, int chan) 23362306a36Sopenharmony_ci{ 23462306a36Sopenharmony_ci return sx9500_dec_users(data, &data->channel_users[chan], 23562306a36Sopenharmony_ci SX9500_REG_PROX_CTRL0, BIT(chan)); 23662306a36Sopenharmony_ci} 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_cistatic int sx9500_inc_data_rdy_users(struct sx9500_data *data) 23962306a36Sopenharmony_ci{ 24062306a36Sopenharmony_ci return sx9500_inc_users(data, &data->data_rdy_users, 24162306a36Sopenharmony_ci SX9500_REG_IRQ_MSK, SX9500_CONVDONE_IRQ); 24262306a36Sopenharmony_ci} 24362306a36Sopenharmony_ci 24462306a36Sopenharmony_cistatic int sx9500_dec_data_rdy_users(struct sx9500_data *data) 24562306a36Sopenharmony_ci{ 24662306a36Sopenharmony_ci return sx9500_dec_users(data, &data->data_rdy_users, 24762306a36Sopenharmony_ci SX9500_REG_IRQ_MSK, SX9500_CONVDONE_IRQ); 24862306a36Sopenharmony_ci} 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_cistatic int sx9500_inc_close_far_users(struct sx9500_data *data) 25162306a36Sopenharmony_ci{ 25262306a36Sopenharmony_ci return sx9500_inc_users(data, &data->close_far_users, 25362306a36Sopenharmony_ci SX9500_REG_IRQ_MSK, 25462306a36Sopenharmony_ci SX9500_CLOSE_IRQ | SX9500_FAR_IRQ); 25562306a36Sopenharmony_ci} 25662306a36Sopenharmony_ci 25762306a36Sopenharmony_cistatic int sx9500_dec_close_far_users(struct sx9500_data *data) 25862306a36Sopenharmony_ci{ 25962306a36Sopenharmony_ci return sx9500_dec_users(data, &data->close_far_users, 26062306a36Sopenharmony_ci SX9500_REG_IRQ_MSK, 26162306a36Sopenharmony_ci SX9500_CLOSE_IRQ | SX9500_FAR_IRQ); 26262306a36Sopenharmony_ci} 26362306a36Sopenharmony_ci 26462306a36Sopenharmony_cistatic int sx9500_read_prox_data(struct sx9500_data *data, 26562306a36Sopenharmony_ci const struct iio_chan_spec *chan, 26662306a36Sopenharmony_ci int *val) 26762306a36Sopenharmony_ci{ 26862306a36Sopenharmony_ci int ret; 26962306a36Sopenharmony_ci __be16 regval; 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci ret = regmap_write(data->regmap, SX9500_REG_SENSOR_SEL, chan->channel); 27262306a36Sopenharmony_ci if (ret < 0) 27362306a36Sopenharmony_ci return ret; 27462306a36Sopenharmony_ci 27562306a36Sopenharmony_ci ret = regmap_bulk_read(data->regmap, SX9500_REG_USE_MSB, ®val, 2); 27662306a36Sopenharmony_ci if (ret < 0) 27762306a36Sopenharmony_ci return ret; 27862306a36Sopenharmony_ci 27962306a36Sopenharmony_ci *val = be16_to_cpu(regval); 28062306a36Sopenharmony_ci 28162306a36Sopenharmony_ci return IIO_VAL_INT; 28262306a36Sopenharmony_ci} 28362306a36Sopenharmony_ci 28462306a36Sopenharmony_ci/* 28562306a36Sopenharmony_ci * If we have no interrupt support, we have to wait for a scan period 28662306a36Sopenharmony_ci * after enabling a channel to get a result. 28762306a36Sopenharmony_ci */ 28862306a36Sopenharmony_cistatic int sx9500_wait_for_sample(struct sx9500_data *data) 28962306a36Sopenharmony_ci{ 29062306a36Sopenharmony_ci int ret; 29162306a36Sopenharmony_ci unsigned int val; 29262306a36Sopenharmony_ci 29362306a36Sopenharmony_ci ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0, &val); 29462306a36Sopenharmony_ci if (ret < 0) 29562306a36Sopenharmony_ci return ret; 29662306a36Sopenharmony_ci 29762306a36Sopenharmony_ci val = (val & SX9500_SCAN_PERIOD_MASK) >> SX9500_SCAN_PERIOD_SHIFT; 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci msleep(sx9500_scan_period_table[val]); 30062306a36Sopenharmony_ci 30162306a36Sopenharmony_ci return 0; 30262306a36Sopenharmony_ci} 30362306a36Sopenharmony_ci 30462306a36Sopenharmony_cistatic int sx9500_read_proximity(struct sx9500_data *data, 30562306a36Sopenharmony_ci const struct iio_chan_spec *chan, 30662306a36Sopenharmony_ci int *val) 30762306a36Sopenharmony_ci{ 30862306a36Sopenharmony_ci int ret; 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_ci mutex_lock(&data->mutex); 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_ci ret = sx9500_inc_chan_users(data, chan->channel); 31362306a36Sopenharmony_ci if (ret < 0) 31462306a36Sopenharmony_ci goto out; 31562306a36Sopenharmony_ci 31662306a36Sopenharmony_ci ret = sx9500_inc_data_rdy_users(data); 31762306a36Sopenharmony_ci if (ret < 0) 31862306a36Sopenharmony_ci goto out_dec_chan; 31962306a36Sopenharmony_ci 32062306a36Sopenharmony_ci mutex_unlock(&data->mutex); 32162306a36Sopenharmony_ci 32262306a36Sopenharmony_ci if (data->client->irq > 0) 32362306a36Sopenharmony_ci ret = wait_for_completion_interruptible(&data->completion); 32462306a36Sopenharmony_ci else 32562306a36Sopenharmony_ci ret = sx9500_wait_for_sample(data); 32662306a36Sopenharmony_ci 32762306a36Sopenharmony_ci mutex_lock(&data->mutex); 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_ci if (ret < 0) 33062306a36Sopenharmony_ci goto out_dec_data_rdy; 33162306a36Sopenharmony_ci 33262306a36Sopenharmony_ci ret = sx9500_read_prox_data(data, chan, val); 33362306a36Sopenharmony_ci if (ret < 0) 33462306a36Sopenharmony_ci goto out_dec_data_rdy; 33562306a36Sopenharmony_ci 33662306a36Sopenharmony_ci ret = sx9500_dec_data_rdy_users(data); 33762306a36Sopenharmony_ci if (ret < 0) 33862306a36Sopenharmony_ci goto out_dec_chan; 33962306a36Sopenharmony_ci 34062306a36Sopenharmony_ci ret = sx9500_dec_chan_users(data, chan->channel); 34162306a36Sopenharmony_ci if (ret < 0) 34262306a36Sopenharmony_ci goto out; 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_ci ret = IIO_VAL_INT; 34562306a36Sopenharmony_ci 34662306a36Sopenharmony_ci goto out; 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ciout_dec_data_rdy: 34962306a36Sopenharmony_ci sx9500_dec_data_rdy_users(data); 35062306a36Sopenharmony_ciout_dec_chan: 35162306a36Sopenharmony_ci sx9500_dec_chan_users(data, chan->channel); 35262306a36Sopenharmony_ciout: 35362306a36Sopenharmony_ci mutex_unlock(&data->mutex); 35462306a36Sopenharmony_ci reinit_completion(&data->completion); 35562306a36Sopenharmony_ci 35662306a36Sopenharmony_ci return ret; 35762306a36Sopenharmony_ci} 35862306a36Sopenharmony_ci 35962306a36Sopenharmony_cistatic int sx9500_read_samp_freq(struct sx9500_data *data, 36062306a36Sopenharmony_ci int *val, int *val2) 36162306a36Sopenharmony_ci{ 36262306a36Sopenharmony_ci int ret; 36362306a36Sopenharmony_ci unsigned int regval; 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci mutex_lock(&data->mutex); 36662306a36Sopenharmony_ci ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0, ®val); 36762306a36Sopenharmony_ci mutex_unlock(&data->mutex); 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci if (ret < 0) 37062306a36Sopenharmony_ci return ret; 37162306a36Sopenharmony_ci 37262306a36Sopenharmony_ci regval = (regval & SX9500_SCAN_PERIOD_MASK) >> SX9500_SCAN_PERIOD_SHIFT; 37362306a36Sopenharmony_ci *val = sx9500_samp_freq_table[regval].val; 37462306a36Sopenharmony_ci *val2 = sx9500_samp_freq_table[regval].val2; 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_ci return IIO_VAL_INT_PLUS_MICRO; 37762306a36Sopenharmony_ci} 37862306a36Sopenharmony_ci 37962306a36Sopenharmony_cistatic int sx9500_read_raw(struct iio_dev *indio_dev, 38062306a36Sopenharmony_ci const struct iio_chan_spec *chan, 38162306a36Sopenharmony_ci int *val, int *val2, long mask) 38262306a36Sopenharmony_ci{ 38362306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 38462306a36Sopenharmony_ci int ret; 38562306a36Sopenharmony_ci 38662306a36Sopenharmony_ci switch (chan->type) { 38762306a36Sopenharmony_ci case IIO_PROXIMITY: 38862306a36Sopenharmony_ci switch (mask) { 38962306a36Sopenharmony_ci case IIO_CHAN_INFO_RAW: 39062306a36Sopenharmony_ci ret = iio_device_claim_direct_mode(indio_dev); 39162306a36Sopenharmony_ci if (ret) 39262306a36Sopenharmony_ci return ret; 39362306a36Sopenharmony_ci ret = sx9500_read_proximity(data, chan, val); 39462306a36Sopenharmony_ci iio_device_release_direct_mode(indio_dev); 39562306a36Sopenharmony_ci return ret; 39662306a36Sopenharmony_ci case IIO_CHAN_INFO_SAMP_FREQ: 39762306a36Sopenharmony_ci return sx9500_read_samp_freq(data, val, val2); 39862306a36Sopenharmony_ci default: 39962306a36Sopenharmony_ci return -EINVAL; 40062306a36Sopenharmony_ci } 40162306a36Sopenharmony_ci default: 40262306a36Sopenharmony_ci return -EINVAL; 40362306a36Sopenharmony_ci } 40462306a36Sopenharmony_ci} 40562306a36Sopenharmony_ci 40662306a36Sopenharmony_cistatic int sx9500_set_samp_freq(struct sx9500_data *data, 40762306a36Sopenharmony_ci int val, int val2) 40862306a36Sopenharmony_ci{ 40962306a36Sopenharmony_ci int i, ret; 41062306a36Sopenharmony_ci 41162306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(sx9500_samp_freq_table); i++) 41262306a36Sopenharmony_ci if (val == sx9500_samp_freq_table[i].val && 41362306a36Sopenharmony_ci val2 == sx9500_samp_freq_table[i].val2) 41462306a36Sopenharmony_ci break; 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_ci if (i == ARRAY_SIZE(sx9500_samp_freq_table)) 41762306a36Sopenharmony_ci return -EINVAL; 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci mutex_lock(&data->mutex); 42062306a36Sopenharmony_ci 42162306a36Sopenharmony_ci ret = regmap_update_bits(data->regmap, SX9500_REG_PROX_CTRL0, 42262306a36Sopenharmony_ci SX9500_SCAN_PERIOD_MASK, 42362306a36Sopenharmony_ci i << SX9500_SCAN_PERIOD_SHIFT); 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_ci mutex_unlock(&data->mutex); 42662306a36Sopenharmony_ci 42762306a36Sopenharmony_ci return ret; 42862306a36Sopenharmony_ci} 42962306a36Sopenharmony_ci 43062306a36Sopenharmony_cistatic int sx9500_write_raw(struct iio_dev *indio_dev, 43162306a36Sopenharmony_ci const struct iio_chan_spec *chan, 43262306a36Sopenharmony_ci int val, int val2, long mask) 43362306a36Sopenharmony_ci{ 43462306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 43562306a36Sopenharmony_ci 43662306a36Sopenharmony_ci switch (chan->type) { 43762306a36Sopenharmony_ci case IIO_PROXIMITY: 43862306a36Sopenharmony_ci switch (mask) { 43962306a36Sopenharmony_ci case IIO_CHAN_INFO_SAMP_FREQ: 44062306a36Sopenharmony_ci return sx9500_set_samp_freq(data, val, val2); 44162306a36Sopenharmony_ci default: 44262306a36Sopenharmony_ci return -EINVAL; 44362306a36Sopenharmony_ci } 44462306a36Sopenharmony_ci default: 44562306a36Sopenharmony_ci return -EINVAL; 44662306a36Sopenharmony_ci } 44762306a36Sopenharmony_ci} 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_cistatic irqreturn_t sx9500_irq_handler(int irq, void *private) 45062306a36Sopenharmony_ci{ 45162306a36Sopenharmony_ci struct iio_dev *indio_dev = private; 45262306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 45362306a36Sopenharmony_ci 45462306a36Sopenharmony_ci if (data->trigger_enabled) 45562306a36Sopenharmony_ci iio_trigger_poll(data->trig); 45662306a36Sopenharmony_ci 45762306a36Sopenharmony_ci /* 45862306a36Sopenharmony_ci * Even if no event is enabled, we need to wake the thread to 45962306a36Sopenharmony_ci * clear the interrupt state by reading SX9500_REG_IRQ_SRC. It 46062306a36Sopenharmony_ci * is not possible to do that here because regmap_read takes a 46162306a36Sopenharmony_ci * mutex. 46262306a36Sopenharmony_ci */ 46362306a36Sopenharmony_ci return IRQ_WAKE_THREAD; 46462306a36Sopenharmony_ci} 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_cistatic void sx9500_push_events(struct iio_dev *indio_dev) 46762306a36Sopenharmony_ci{ 46862306a36Sopenharmony_ci int ret; 46962306a36Sopenharmony_ci unsigned int val, chan; 47062306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 47162306a36Sopenharmony_ci 47262306a36Sopenharmony_ci ret = regmap_read(data->regmap, SX9500_REG_STAT, &val); 47362306a36Sopenharmony_ci if (ret < 0) { 47462306a36Sopenharmony_ci dev_err(&data->client->dev, "i2c transfer error in irq\n"); 47562306a36Sopenharmony_ci return; 47662306a36Sopenharmony_ci } 47762306a36Sopenharmony_ci 47862306a36Sopenharmony_ci val >>= SX9500_PROXSTAT_SHIFT; 47962306a36Sopenharmony_ci for (chan = 0; chan < SX9500_NUM_CHANNELS; chan++) { 48062306a36Sopenharmony_ci int dir; 48162306a36Sopenharmony_ci u64 ev; 48262306a36Sopenharmony_ci bool new_prox = val & BIT(chan); 48362306a36Sopenharmony_ci 48462306a36Sopenharmony_ci if (!data->event_enabled[chan]) 48562306a36Sopenharmony_ci continue; 48662306a36Sopenharmony_ci if (new_prox == data->prox_stat[chan]) 48762306a36Sopenharmony_ci /* No change on this channel. */ 48862306a36Sopenharmony_ci continue; 48962306a36Sopenharmony_ci 49062306a36Sopenharmony_ci dir = new_prox ? IIO_EV_DIR_FALLING : IIO_EV_DIR_RISING; 49162306a36Sopenharmony_ci ev = IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, chan, 49262306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, dir); 49362306a36Sopenharmony_ci iio_push_event(indio_dev, ev, iio_get_time_ns(indio_dev)); 49462306a36Sopenharmony_ci data->prox_stat[chan] = new_prox; 49562306a36Sopenharmony_ci } 49662306a36Sopenharmony_ci} 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_cistatic irqreturn_t sx9500_irq_thread_handler(int irq, void *private) 49962306a36Sopenharmony_ci{ 50062306a36Sopenharmony_ci struct iio_dev *indio_dev = private; 50162306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 50262306a36Sopenharmony_ci int ret; 50362306a36Sopenharmony_ci unsigned int val; 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_ci mutex_lock(&data->mutex); 50662306a36Sopenharmony_ci 50762306a36Sopenharmony_ci ret = regmap_read(data->regmap, SX9500_REG_IRQ_SRC, &val); 50862306a36Sopenharmony_ci if (ret < 0) { 50962306a36Sopenharmony_ci dev_err(&data->client->dev, "i2c transfer error in irq\n"); 51062306a36Sopenharmony_ci goto out; 51162306a36Sopenharmony_ci } 51262306a36Sopenharmony_ci 51362306a36Sopenharmony_ci if (val & (SX9500_CLOSE_IRQ | SX9500_FAR_IRQ)) 51462306a36Sopenharmony_ci sx9500_push_events(indio_dev); 51562306a36Sopenharmony_ci 51662306a36Sopenharmony_ci if (val & SX9500_CONVDONE_IRQ) 51762306a36Sopenharmony_ci complete(&data->completion); 51862306a36Sopenharmony_ci 51962306a36Sopenharmony_ciout: 52062306a36Sopenharmony_ci mutex_unlock(&data->mutex); 52162306a36Sopenharmony_ci 52262306a36Sopenharmony_ci return IRQ_HANDLED; 52362306a36Sopenharmony_ci} 52462306a36Sopenharmony_ci 52562306a36Sopenharmony_cistatic int sx9500_read_event_config(struct iio_dev *indio_dev, 52662306a36Sopenharmony_ci const struct iio_chan_spec *chan, 52762306a36Sopenharmony_ci enum iio_event_type type, 52862306a36Sopenharmony_ci enum iio_event_direction dir) 52962306a36Sopenharmony_ci{ 53062306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 53162306a36Sopenharmony_ci 53262306a36Sopenharmony_ci if (chan->type != IIO_PROXIMITY || type != IIO_EV_TYPE_THRESH || 53362306a36Sopenharmony_ci dir != IIO_EV_DIR_EITHER) 53462306a36Sopenharmony_ci return -EINVAL; 53562306a36Sopenharmony_ci 53662306a36Sopenharmony_ci return data->event_enabled[chan->channel]; 53762306a36Sopenharmony_ci} 53862306a36Sopenharmony_ci 53962306a36Sopenharmony_cistatic int sx9500_write_event_config(struct iio_dev *indio_dev, 54062306a36Sopenharmony_ci const struct iio_chan_spec *chan, 54162306a36Sopenharmony_ci enum iio_event_type type, 54262306a36Sopenharmony_ci enum iio_event_direction dir, 54362306a36Sopenharmony_ci int state) 54462306a36Sopenharmony_ci{ 54562306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 54662306a36Sopenharmony_ci int ret; 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci if (chan->type != IIO_PROXIMITY || type != IIO_EV_TYPE_THRESH || 54962306a36Sopenharmony_ci dir != IIO_EV_DIR_EITHER) 55062306a36Sopenharmony_ci return -EINVAL; 55162306a36Sopenharmony_ci 55262306a36Sopenharmony_ci mutex_lock(&data->mutex); 55362306a36Sopenharmony_ci 55462306a36Sopenharmony_ci if (state == 1) { 55562306a36Sopenharmony_ci ret = sx9500_inc_chan_users(data, chan->channel); 55662306a36Sopenharmony_ci if (ret < 0) 55762306a36Sopenharmony_ci goto out_unlock; 55862306a36Sopenharmony_ci ret = sx9500_inc_close_far_users(data); 55962306a36Sopenharmony_ci if (ret < 0) 56062306a36Sopenharmony_ci goto out_undo_chan; 56162306a36Sopenharmony_ci } else { 56262306a36Sopenharmony_ci ret = sx9500_dec_chan_users(data, chan->channel); 56362306a36Sopenharmony_ci if (ret < 0) 56462306a36Sopenharmony_ci goto out_unlock; 56562306a36Sopenharmony_ci ret = sx9500_dec_close_far_users(data); 56662306a36Sopenharmony_ci if (ret < 0) 56762306a36Sopenharmony_ci goto out_undo_chan; 56862306a36Sopenharmony_ci } 56962306a36Sopenharmony_ci 57062306a36Sopenharmony_ci data->event_enabled[chan->channel] = state; 57162306a36Sopenharmony_ci goto out_unlock; 57262306a36Sopenharmony_ci 57362306a36Sopenharmony_ciout_undo_chan: 57462306a36Sopenharmony_ci if (state == 1) 57562306a36Sopenharmony_ci sx9500_dec_chan_users(data, chan->channel); 57662306a36Sopenharmony_ci else 57762306a36Sopenharmony_ci sx9500_inc_chan_users(data, chan->channel); 57862306a36Sopenharmony_ciout_unlock: 57962306a36Sopenharmony_ci mutex_unlock(&data->mutex); 58062306a36Sopenharmony_ci return ret; 58162306a36Sopenharmony_ci} 58262306a36Sopenharmony_ci 58362306a36Sopenharmony_cistatic int sx9500_update_scan_mode(struct iio_dev *indio_dev, 58462306a36Sopenharmony_ci const unsigned long *scan_mask) 58562306a36Sopenharmony_ci{ 58662306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 58762306a36Sopenharmony_ci 58862306a36Sopenharmony_ci mutex_lock(&data->mutex); 58962306a36Sopenharmony_ci kfree(data->buffer); 59062306a36Sopenharmony_ci data->buffer = kzalloc(indio_dev->scan_bytes, GFP_KERNEL); 59162306a36Sopenharmony_ci mutex_unlock(&data->mutex); 59262306a36Sopenharmony_ci 59362306a36Sopenharmony_ci if (data->buffer == NULL) 59462306a36Sopenharmony_ci return -ENOMEM; 59562306a36Sopenharmony_ci 59662306a36Sopenharmony_ci return 0; 59762306a36Sopenharmony_ci} 59862306a36Sopenharmony_ci 59962306a36Sopenharmony_cistatic IIO_CONST_ATTR_SAMP_FREQ_AVAIL( 60062306a36Sopenharmony_ci "2.500000 3.333333 5 6.666666 8.333333 11.111111 16.666666 33.333333"); 60162306a36Sopenharmony_ci 60262306a36Sopenharmony_cistatic struct attribute *sx9500_attributes[] = { 60362306a36Sopenharmony_ci &iio_const_attr_sampling_frequency_available.dev_attr.attr, 60462306a36Sopenharmony_ci NULL, 60562306a36Sopenharmony_ci}; 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_cistatic const struct attribute_group sx9500_attribute_group = { 60862306a36Sopenharmony_ci .attrs = sx9500_attributes, 60962306a36Sopenharmony_ci}; 61062306a36Sopenharmony_ci 61162306a36Sopenharmony_cistatic const struct iio_info sx9500_info = { 61262306a36Sopenharmony_ci .attrs = &sx9500_attribute_group, 61362306a36Sopenharmony_ci .read_raw = &sx9500_read_raw, 61462306a36Sopenharmony_ci .write_raw = &sx9500_write_raw, 61562306a36Sopenharmony_ci .read_event_config = &sx9500_read_event_config, 61662306a36Sopenharmony_ci .write_event_config = &sx9500_write_event_config, 61762306a36Sopenharmony_ci .update_scan_mode = &sx9500_update_scan_mode, 61862306a36Sopenharmony_ci}; 61962306a36Sopenharmony_ci 62062306a36Sopenharmony_cistatic int sx9500_set_trigger_state(struct iio_trigger *trig, 62162306a36Sopenharmony_ci bool state) 62262306a36Sopenharmony_ci{ 62362306a36Sopenharmony_ci struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 62462306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 62562306a36Sopenharmony_ci int ret; 62662306a36Sopenharmony_ci 62762306a36Sopenharmony_ci mutex_lock(&data->mutex); 62862306a36Sopenharmony_ci 62962306a36Sopenharmony_ci if (state) 63062306a36Sopenharmony_ci ret = sx9500_inc_data_rdy_users(data); 63162306a36Sopenharmony_ci else 63262306a36Sopenharmony_ci ret = sx9500_dec_data_rdy_users(data); 63362306a36Sopenharmony_ci if (ret < 0) 63462306a36Sopenharmony_ci goto out; 63562306a36Sopenharmony_ci 63662306a36Sopenharmony_ci data->trigger_enabled = state; 63762306a36Sopenharmony_ci 63862306a36Sopenharmony_ciout: 63962306a36Sopenharmony_ci mutex_unlock(&data->mutex); 64062306a36Sopenharmony_ci 64162306a36Sopenharmony_ci return ret; 64262306a36Sopenharmony_ci} 64362306a36Sopenharmony_ci 64462306a36Sopenharmony_cistatic const struct iio_trigger_ops sx9500_trigger_ops = { 64562306a36Sopenharmony_ci .set_trigger_state = sx9500_set_trigger_state, 64662306a36Sopenharmony_ci}; 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_cistatic irqreturn_t sx9500_trigger_handler(int irq, void *private) 64962306a36Sopenharmony_ci{ 65062306a36Sopenharmony_ci struct iio_poll_func *pf = private; 65162306a36Sopenharmony_ci struct iio_dev *indio_dev = pf->indio_dev; 65262306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 65362306a36Sopenharmony_ci int val, bit, ret, i = 0; 65462306a36Sopenharmony_ci 65562306a36Sopenharmony_ci mutex_lock(&data->mutex); 65662306a36Sopenharmony_ci 65762306a36Sopenharmony_ci for_each_set_bit(bit, indio_dev->active_scan_mask, 65862306a36Sopenharmony_ci indio_dev->masklength) { 65962306a36Sopenharmony_ci ret = sx9500_read_prox_data(data, &indio_dev->channels[bit], 66062306a36Sopenharmony_ci &val); 66162306a36Sopenharmony_ci if (ret < 0) 66262306a36Sopenharmony_ci goto out; 66362306a36Sopenharmony_ci 66462306a36Sopenharmony_ci data->buffer[i++] = val; 66562306a36Sopenharmony_ci } 66662306a36Sopenharmony_ci 66762306a36Sopenharmony_ci iio_push_to_buffers_with_timestamp(indio_dev, data->buffer, 66862306a36Sopenharmony_ci iio_get_time_ns(indio_dev)); 66962306a36Sopenharmony_ci 67062306a36Sopenharmony_ciout: 67162306a36Sopenharmony_ci mutex_unlock(&data->mutex); 67262306a36Sopenharmony_ci 67362306a36Sopenharmony_ci iio_trigger_notify_done(indio_dev->trig); 67462306a36Sopenharmony_ci 67562306a36Sopenharmony_ci return IRQ_HANDLED; 67662306a36Sopenharmony_ci} 67762306a36Sopenharmony_ci 67862306a36Sopenharmony_cistatic int sx9500_buffer_postenable(struct iio_dev *indio_dev) 67962306a36Sopenharmony_ci{ 68062306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 68162306a36Sopenharmony_ci int ret = 0, i; 68262306a36Sopenharmony_ci 68362306a36Sopenharmony_ci mutex_lock(&data->mutex); 68462306a36Sopenharmony_ci 68562306a36Sopenharmony_ci for (i = 0; i < SX9500_NUM_CHANNELS; i++) 68662306a36Sopenharmony_ci if (test_bit(i, indio_dev->active_scan_mask)) { 68762306a36Sopenharmony_ci ret = sx9500_inc_chan_users(data, i); 68862306a36Sopenharmony_ci if (ret) 68962306a36Sopenharmony_ci break; 69062306a36Sopenharmony_ci } 69162306a36Sopenharmony_ci 69262306a36Sopenharmony_ci if (ret) 69362306a36Sopenharmony_ci for (i = i - 1; i >= 0; i--) 69462306a36Sopenharmony_ci if (test_bit(i, indio_dev->active_scan_mask)) 69562306a36Sopenharmony_ci sx9500_dec_chan_users(data, i); 69662306a36Sopenharmony_ci 69762306a36Sopenharmony_ci mutex_unlock(&data->mutex); 69862306a36Sopenharmony_ci 69962306a36Sopenharmony_ci return ret; 70062306a36Sopenharmony_ci} 70162306a36Sopenharmony_ci 70262306a36Sopenharmony_cistatic int sx9500_buffer_predisable(struct iio_dev *indio_dev) 70362306a36Sopenharmony_ci{ 70462306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 70562306a36Sopenharmony_ci int ret = 0, i; 70662306a36Sopenharmony_ci 70762306a36Sopenharmony_ci mutex_lock(&data->mutex); 70862306a36Sopenharmony_ci 70962306a36Sopenharmony_ci for (i = 0; i < SX9500_NUM_CHANNELS; i++) 71062306a36Sopenharmony_ci if (test_bit(i, indio_dev->active_scan_mask)) { 71162306a36Sopenharmony_ci ret = sx9500_dec_chan_users(data, i); 71262306a36Sopenharmony_ci if (ret) 71362306a36Sopenharmony_ci break; 71462306a36Sopenharmony_ci } 71562306a36Sopenharmony_ci 71662306a36Sopenharmony_ci if (ret) 71762306a36Sopenharmony_ci for (i = i - 1; i >= 0; i--) 71862306a36Sopenharmony_ci if (test_bit(i, indio_dev->active_scan_mask)) 71962306a36Sopenharmony_ci sx9500_inc_chan_users(data, i); 72062306a36Sopenharmony_ci 72162306a36Sopenharmony_ci mutex_unlock(&data->mutex); 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci return ret; 72462306a36Sopenharmony_ci} 72562306a36Sopenharmony_ci 72662306a36Sopenharmony_cistatic const struct iio_buffer_setup_ops sx9500_buffer_setup_ops = { 72762306a36Sopenharmony_ci .postenable = sx9500_buffer_postenable, 72862306a36Sopenharmony_ci .predisable = sx9500_buffer_predisable, 72962306a36Sopenharmony_ci}; 73062306a36Sopenharmony_ci 73162306a36Sopenharmony_cistruct sx9500_reg_default { 73262306a36Sopenharmony_ci u8 reg; 73362306a36Sopenharmony_ci u8 def; 73462306a36Sopenharmony_ci}; 73562306a36Sopenharmony_ci 73662306a36Sopenharmony_cistatic const struct sx9500_reg_default sx9500_default_regs[] = { 73762306a36Sopenharmony_ci { 73862306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL1, 73962306a36Sopenharmony_ci /* Shield enabled, small range. */ 74062306a36Sopenharmony_ci .def = 0x43, 74162306a36Sopenharmony_ci }, 74262306a36Sopenharmony_ci { 74362306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL2, 74462306a36Sopenharmony_ci /* x8 gain, 167kHz frequency, finest resolution. */ 74562306a36Sopenharmony_ci .def = 0x77, 74662306a36Sopenharmony_ci }, 74762306a36Sopenharmony_ci { 74862306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL3, 74962306a36Sopenharmony_ci /* Doze enabled, 2x scan period doze, no raw filter. */ 75062306a36Sopenharmony_ci .def = 0x40, 75162306a36Sopenharmony_ci }, 75262306a36Sopenharmony_ci { 75362306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL4, 75462306a36Sopenharmony_ci /* Average threshold. */ 75562306a36Sopenharmony_ci .def = 0x30, 75662306a36Sopenharmony_ci }, 75762306a36Sopenharmony_ci { 75862306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL5, 75962306a36Sopenharmony_ci /* 76062306a36Sopenharmony_ci * Debouncer off, lowest average negative filter, 76162306a36Sopenharmony_ci * highest average positive filter. 76262306a36Sopenharmony_ci */ 76362306a36Sopenharmony_ci .def = 0x0f, 76462306a36Sopenharmony_ci }, 76562306a36Sopenharmony_ci { 76662306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL6, 76762306a36Sopenharmony_ci /* Proximity detection threshold: 280 */ 76862306a36Sopenharmony_ci .def = 0x0e, 76962306a36Sopenharmony_ci }, 77062306a36Sopenharmony_ci { 77162306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL7, 77262306a36Sopenharmony_ci /* 77362306a36Sopenharmony_ci * No automatic compensation, compensate each pin 77462306a36Sopenharmony_ci * independently, proximity hysteresis: 32, close 77562306a36Sopenharmony_ci * debouncer off, far debouncer off. 77662306a36Sopenharmony_ci */ 77762306a36Sopenharmony_ci .def = 0x00, 77862306a36Sopenharmony_ci }, 77962306a36Sopenharmony_ci { 78062306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL8, 78162306a36Sopenharmony_ci /* No stuck timeout, no periodic compensation. */ 78262306a36Sopenharmony_ci .def = 0x00, 78362306a36Sopenharmony_ci }, 78462306a36Sopenharmony_ci { 78562306a36Sopenharmony_ci .reg = SX9500_REG_PROX_CTRL0, 78662306a36Sopenharmony_ci /* Scan period: 30ms, all sensors disabled. */ 78762306a36Sopenharmony_ci .def = 0x00, 78862306a36Sopenharmony_ci }, 78962306a36Sopenharmony_ci}; 79062306a36Sopenharmony_ci 79162306a36Sopenharmony_ci/* Activate all channels and perform an initial compensation. */ 79262306a36Sopenharmony_cistatic int sx9500_init_compensation(struct iio_dev *indio_dev) 79362306a36Sopenharmony_ci{ 79462306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 79562306a36Sopenharmony_ci int i, ret; 79662306a36Sopenharmony_ci unsigned int val; 79762306a36Sopenharmony_ci 79862306a36Sopenharmony_ci ret = regmap_update_bits(data->regmap, SX9500_REG_PROX_CTRL0, 79962306a36Sopenharmony_ci SX9500_CHAN_MASK, SX9500_CHAN_MASK); 80062306a36Sopenharmony_ci if (ret < 0) 80162306a36Sopenharmony_ci return ret; 80262306a36Sopenharmony_ci 80362306a36Sopenharmony_ci for (i = 10; i >= 0; i--) { 80462306a36Sopenharmony_ci usleep_range(10000, 20000); 80562306a36Sopenharmony_ci ret = regmap_read(data->regmap, SX9500_REG_STAT, &val); 80662306a36Sopenharmony_ci if (ret < 0) 80762306a36Sopenharmony_ci goto out; 80862306a36Sopenharmony_ci if (!(val & SX9500_COMPSTAT_MASK)) 80962306a36Sopenharmony_ci break; 81062306a36Sopenharmony_ci } 81162306a36Sopenharmony_ci 81262306a36Sopenharmony_ci if (i < 0) { 81362306a36Sopenharmony_ci dev_err(&data->client->dev, "initial compensation timed out"); 81462306a36Sopenharmony_ci ret = -ETIMEDOUT; 81562306a36Sopenharmony_ci } 81662306a36Sopenharmony_ci 81762306a36Sopenharmony_ciout: 81862306a36Sopenharmony_ci regmap_update_bits(data->regmap, SX9500_REG_PROX_CTRL0, 81962306a36Sopenharmony_ci SX9500_CHAN_MASK, 0); 82062306a36Sopenharmony_ci return ret; 82162306a36Sopenharmony_ci} 82262306a36Sopenharmony_ci 82362306a36Sopenharmony_cistatic int sx9500_init_device(struct iio_dev *indio_dev) 82462306a36Sopenharmony_ci{ 82562306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 82662306a36Sopenharmony_ci int ret, i; 82762306a36Sopenharmony_ci unsigned int val; 82862306a36Sopenharmony_ci 82962306a36Sopenharmony_ci if (data->gpiod_rst) { 83062306a36Sopenharmony_ci gpiod_set_value_cansleep(data->gpiod_rst, 0); 83162306a36Sopenharmony_ci usleep_range(1000, 2000); 83262306a36Sopenharmony_ci gpiod_set_value_cansleep(data->gpiod_rst, 1); 83362306a36Sopenharmony_ci usleep_range(1000, 2000); 83462306a36Sopenharmony_ci } 83562306a36Sopenharmony_ci 83662306a36Sopenharmony_ci ret = regmap_write(data->regmap, SX9500_REG_IRQ_MSK, 0); 83762306a36Sopenharmony_ci if (ret < 0) 83862306a36Sopenharmony_ci return ret; 83962306a36Sopenharmony_ci 84062306a36Sopenharmony_ci ret = regmap_write(data->regmap, SX9500_REG_RESET, 84162306a36Sopenharmony_ci SX9500_SOFT_RESET); 84262306a36Sopenharmony_ci if (ret < 0) 84362306a36Sopenharmony_ci return ret; 84462306a36Sopenharmony_ci 84562306a36Sopenharmony_ci ret = regmap_read(data->regmap, SX9500_REG_IRQ_SRC, &val); 84662306a36Sopenharmony_ci if (ret < 0) 84762306a36Sopenharmony_ci return ret; 84862306a36Sopenharmony_ci 84962306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(sx9500_default_regs); i++) { 85062306a36Sopenharmony_ci ret = regmap_write(data->regmap, 85162306a36Sopenharmony_ci sx9500_default_regs[i].reg, 85262306a36Sopenharmony_ci sx9500_default_regs[i].def); 85362306a36Sopenharmony_ci if (ret < 0) 85462306a36Sopenharmony_ci return ret; 85562306a36Sopenharmony_ci } 85662306a36Sopenharmony_ci 85762306a36Sopenharmony_ci return sx9500_init_compensation(indio_dev); 85862306a36Sopenharmony_ci} 85962306a36Sopenharmony_ci 86062306a36Sopenharmony_cistatic const struct acpi_gpio_params reset_gpios = { 0, 0, false }; 86162306a36Sopenharmony_cistatic const struct acpi_gpio_params interrupt_gpios = { 2, 0, false }; 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_cistatic const struct acpi_gpio_mapping acpi_sx9500_gpios[] = { 86462306a36Sopenharmony_ci { "reset-gpios", &reset_gpios, 1 }, 86562306a36Sopenharmony_ci /* 86662306a36Sopenharmony_ci * Some platforms have a bug in ACPI GPIO description making IRQ 86762306a36Sopenharmony_ci * GPIO to be output only. Ask the GPIO core to ignore this limit. 86862306a36Sopenharmony_ci */ 86962306a36Sopenharmony_ci { "interrupt-gpios", &interrupt_gpios, 1, ACPI_GPIO_QUIRK_NO_IO_RESTRICTION }, 87062306a36Sopenharmony_ci { }, 87162306a36Sopenharmony_ci}; 87262306a36Sopenharmony_ci 87362306a36Sopenharmony_cistatic void sx9500_gpio_probe(struct i2c_client *client, 87462306a36Sopenharmony_ci struct sx9500_data *data) 87562306a36Sopenharmony_ci{ 87662306a36Sopenharmony_ci struct gpio_desc *gpiod_int; 87762306a36Sopenharmony_ci struct device *dev; 87862306a36Sopenharmony_ci int ret; 87962306a36Sopenharmony_ci 88062306a36Sopenharmony_ci if (!client) 88162306a36Sopenharmony_ci return; 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_ci dev = &client->dev; 88462306a36Sopenharmony_ci 88562306a36Sopenharmony_ci ret = devm_acpi_dev_add_driver_gpios(dev, acpi_sx9500_gpios); 88662306a36Sopenharmony_ci if (ret) 88762306a36Sopenharmony_ci dev_dbg(dev, "Unable to add GPIO mapping table\n"); 88862306a36Sopenharmony_ci 88962306a36Sopenharmony_ci if (client->irq <= 0) { 89062306a36Sopenharmony_ci gpiod_int = devm_gpiod_get(dev, "interrupt", GPIOD_IN); 89162306a36Sopenharmony_ci if (IS_ERR(gpiod_int)) 89262306a36Sopenharmony_ci dev_err(dev, "gpio get irq failed\n"); 89362306a36Sopenharmony_ci else 89462306a36Sopenharmony_ci client->irq = gpiod_to_irq(gpiod_int); 89562306a36Sopenharmony_ci } 89662306a36Sopenharmony_ci 89762306a36Sopenharmony_ci data->gpiod_rst = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH); 89862306a36Sopenharmony_ci if (IS_ERR(data->gpiod_rst)) { 89962306a36Sopenharmony_ci dev_warn(dev, "gpio get reset pin failed\n"); 90062306a36Sopenharmony_ci data->gpiod_rst = NULL; 90162306a36Sopenharmony_ci } 90262306a36Sopenharmony_ci} 90362306a36Sopenharmony_ci 90462306a36Sopenharmony_cistatic int sx9500_probe(struct i2c_client *client) 90562306a36Sopenharmony_ci{ 90662306a36Sopenharmony_ci int ret; 90762306a36Sopenharmony_ci struct iio_dev *indio_dev; 90862306a36Sopenharmony_ci struct sx9500_data *data; 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 91162306a36Sopenharmony_ci if (indio_dev == NULL) 91262306a36Sopenharmony_ci return -ENOMEM; 91362306a36Sopenharmony_ci 91462306a36Sopenharmony_ci data = iio_priv(indio_dev); 91562306a36Sopenharmony_ci data->client = client; 91662306a36Sopenharmony_ci mutex_init(&data->mutex); 91762306a36Sopenharmony_ci init_completion(&data->completion); 91862306a36Sopenharmony_ci data->trigger_enabled = false; 91962306a36Sopenharmony_ci 92062306a36Sopenharmony_ci data->regmap = devm_regmap_init_i2c(client, &sx9500_regmap_config); 92162306a36Sopenharmony_ci if (IS_ERR(data->regmap)) 92262306a36Sopenharmony_ci return PTR_ERR(data->regmap); 92362306a36Sopenharmony_ci 92462306a36Sopenharmony_ci indio_dev->name = SX9500_DRIVER_NAME; 92562306a36Sopenharmony_ci indio_dev->channels = sx9500_channels; 92662306a36Sopenharmony_ci indio_dev->num_channels = ARRAY_SIZE(sx9500_channels); 92762306a36Sopenharmony_ci indio_dev->info = &sx9500_info; 92862306a36Sopenharmony_ci indio_dev->modes = INDIO_DIRECT_MODE; 92962306a36Sopenharmony_ci i2c_set_clientdata(client, indio_dev); 93062306a36Sopenharmony_ci 93162306a36Sopenharmony_ci sx9500_gpio_probe(client, data); 93262306a36Sopenharmony_ci 93362306a36Sopenharmony_ci ret = sx9500_init_device(indio_dev); 93462306a36Sopenharmony_ci if (ret < 0) 93562306a36Sopenharmony_ci return ret; 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_ci if (client->irq <= 0) 93862306a36Sopenharmony_ci dev_warn(&client->dev, "no valid irq found\n"); 93962306a36Sopenharmony_ci else { 94062306a36Sopenharmony_ci ret = devm_request_threaded_irq(&client->dev, client->irq, 94162306a36Sopenharmony_ci sx9500_irq_handler, sx9500_irq_thread_handler, 94262306a36Sopenharmony_ci IRQF_TRIGGER_FALLING | IRQF_ONESHOT, 94362306a36Sopenharmony_ci SX9500_IRQ_NAME, indio_dev); 94462306a36Sopenharmony_ci if (ret < 0) 94562306a36Sopenharmony_ci return ret; 94662306a36Sopenharmony_ci 94762306a36Sopenharmony_ci data->trig = devm_iio_trigger_alloc(&client->dev, 94862306a36Sopenharmony_ci "%s-dev%d", indio_dev->name, iio_device_id(indio_dev)); 94962306a36Sopenharmony_ci if (!data->trig) 95062306a36Sopenharmony_ci return -ENOMEM; 95162306a36Sopenharmony_ci 95262306a36Sopenharmony_ci data->trig->ops = &sx9500_trigger_ops; 95362306a36Sopenharmony_ci iio_trigger_set_drvdata(data->trig, indio_dev); 95462306a36Sopenharmony_ci 95562306a36Sopenharmony_ci ret = iio_trigger_register(data->trig); 95662306a36Sopenharmony_ci if (ret) 95762306a36Sopenharmony_ci return ret; 95862306a36Sopenharmony_ci } 95962306a36Sopenharmony_ci 96062306a36Sopenharmony_ci ret = iio_triggered_buffer_setup(indio_dev, NULL, 96162306a36Sopenharmony_ci sx9500_trigger_handler, 96262306a36Sopenharmony_ci &sx9500_buffer_setup_ops); 96362306a36Sopenharmony_ci if (ret < 0) 96462306a36Sopenharmony_ci goto out_trigger_unregister; 96562306a36Sopenharmony_ci 96662306a36Sopenharmony_ci ret = iio_device_register(indio_dev); 96762306a36Sopenharmony_ci if (ret < 0) 96862306a36Sopenharmony_ci goto out_buffer_cleanup; 96962306a36Sopenharmony_ci 97062306a36Sopenharmony_ci return 0; 97162306a36Sopenharmony_ci 97262306a36Sopenharmony_ciout_buffer_cleanup: 97362306a36Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 97462306a36Sopenharmony_ciout_trigger_unregister: 97562306a36Sopenharmony_ci if (client->irq > 0) 97662306a36Sopenharmony_ci iio_trigger_unregister(data->trig); 97762306a36Sopenharmony_ci 97862306a36Sopenharmony_ci return ret; 97962306a36Sopenharmony_ci} 98062306a36Sopenharmony_ci 98162306a36Sopenharmony_cistatic void sx9500_remove(struct i2c_client *client) 98262306a36Sopenharmony_ci{ 98362306a36Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(client); 98462306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 98562306a36Sopenharmony_ci 98662306a36Sopenharmony_ci iio_device_unregister(indio_dev); 98762306a36Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 98862306a36Sopenharmony_ci if (client->irq > 0) 98962306a36Sopenharmony_ci iio_trigger_unregister(data->trig); 99062306a36Sopenharmony_ci kfree(data->buffer); 99162306a36Sopenharmony_ci} 99262306a36Sopenharmony_ci 99362306a36Sopenharmony_cistatic int sx9500_suspend(struct device *dev) 99462306a36Sopenharmony_ci{ 99562306a36Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 99662306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 99762306a36Sopenharmony_ci int ret; 99862306a36Sopenharmony_ci 99962306a36Sopenharmony_ci mutex_lock(&data->mutex); 100062306a36Sopenharmony_ci ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0, 100162306a36Sopenharmony_ci &data->suspend_ctrl0); 100262306a36Sopenharmony_ci if (ret < 0) 100362306a36Sopenharmony_ci goto out; 100462306a36Sopenharmony_ci 100562306a36Sopenharmony_ci /* 100662306a36Sopenharmony_ci * Scan period doesn't matter because when all the sensors are 100762306a36Sopenharmony_ci * deactivated the device is in sleep mode. 100862306a36Sopenharmony_ci */ 100962306a36Sopenharmony_ci ret = regmap_write(data->regmap, SX9500_REG_PROX_CTRL0, 0); 101062306a36Sopenharmony_ci 101162306a36Sopenharmony_ciout: 101262306a36Sopenharmony_ci mutex_unlock(&data->mutex); 101362306a36Sopenharmony_ci return ret; 101462306a36Sopenharmony_ci} 101562306a36Sopenharmony_ci 101662306a36Sopenharmony_cistatic int sx9500_resume(struct device *dev) 101762306a36Sopenharmony_ci{ 101862306a36Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 101962306a36Sopenharmony_ci struct sx9500_data *data = iio_priv(indio_dev); 102062306a36Sopenharmony_ci int ret; 102162306a36Sopenharmony_ci 102262306a36Sopenharmony_ci mutex_lock(&data->mutex); 102362306a36Sopenharmony_ci ret = regmap_write(data->regmap, SX9500_REG_PROX_CTRL0, 102462306a36Sopenharmony_ci data->suspend_ctrl0); 102562306a36Sopenharmony_ci mutex_unlock(&data->mutex); 102662306a36Sopenharmony_ci 102762306a36Sopenharmony_ci return ret; 102862306a36Sopenharmony_ci} 102962306a36Sopenharmony_ci 103062306a36Sopenharmony_cistatic DEFINE_SIMPLE_DEV_PM_OPS(sx9500_pm_ops, sx9500_suspend, sx9500_resume); 103162306a36Sopenharmony_ci 103262306a36Sopenharmony_cistatic const struct acpi_device_id sx9500_acpi_match[] = { 103362306a36Sopenharmony_ci {"SSX9500", 0}, 103462306a36Sopenharmony_ci {"SASX9500", 0}, 103562306a36Sopenharmony_ci { }, 103662306a36Sopenharmony_ci}; 103762306a36Sopenharmony_ciMODULE_DEVICE_TABLE(acpi, sx9500_acpi_match); 103862306a36Sopenharmony_ci 103962306a36Sopenharmony_cistatic const struct of_device_id sx9500_of_match[] = { 104062306a36Sopenharmony_ci { .compatible = "semtech,sx9500", }, 104162306a36Sopenharmony_ci { } 104262306a36Sopenharmony_ci}; 104362306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, sx9500_of_match); 104462306a36Sopenharmony_ci 104562306a36Sopenharmony_cistatic const struct i2c_device_id sx9500_id[] = { 104662306a36Sopenharmony_ci {"sx9500", 0}, 104762306a36Sopenharmony_ci { }, 104862306a36Sopenharmony_ci}; 104962306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, sx9500_id); 105062306a36Sopenharmony_ci 105162306a36Sopenharmony_cistatic struct i2c_driver sx9500_driver = { 105262306a36Sopenharmony_ci .driver = { 105362306a36Sopenharmony_ci .name = SX9500_DRIVER_NAME, 105462306a36Sopenharmony_ci .acpi_match_table = sx9500_acpi_match, 105562306a36Sopenharmony_ci .of_match_table = sx9500_of_match, 105662306a36Sopenharmony_ci .pm = pm_sleep_ptr(&sx9500_pm_ops), 105762306a36Sopenharmony_ci }, 105862306a36Sopenharmony_ci .probe = sx9500_probe, 105962306a36Sopenharmony_ci .remove = sx9500_remove, 106062306a36Sopenharmony_ci .id_table = sx9500_id, 106162306a36Sopenharmony_ci}; 106262306a36Sopenharmony_cimodule_i2c_driver(sx9500_driver); 106362306a36Sopenharmony_ci 106462306a36Sopenharmony_ciMODULE_AUTHOR("Vlad Dogaru <vlad.dogaru@intel.com>"); 106562306a36Sopenharmony_ciMODULE_DESCRIPTION("Driver for Semtech SX9500 proximity sensor"); 106662306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 1067