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, &regval, 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, &regval);
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