1 // SPDX-License-Identifier: GPL-2.0-only
3 * STMicroelectronics uvis25 sensor driver
5 * Copyright 2017 STMicroelectronics Inc.
7 * Lorenzo Bianconi <lorenzo.bianconi83@gmail.com>
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/device.h>
13 #include <linux/iio/sysfs.h>
14 #include <linux/delay.h>
16 #include <linux/interrupt.h>
17 #include <linux/irqreturn.h>
18 #include <linux/iio/trigger.h>
19 #include <linux/iio/trigger_consumer.h>
20 #include <linux/iio/triggered_buffer.h>
21 #include <linux/iio/buffer.h>
22 #include <linux/regmap.h>
24 #include "st_uvis25.h"
26 #define ST_UVIS25_REG_WHOAMI_ADDR 0x0f
27 #define ST_UVIS25_REG_WHOAMI_VAL 0xca
28 #define ST_UVIS25_REG_CTRL1_ADDR 0x20
29 #define ST_UVIS25_REG_ODR_MASK BIT(0)
30 #define ST_UVIS25_REG_BDU_MASK BIT(1)
31 #define ST_UVIS25_REG_CTRL2_ADDR 0x21
32 #define ST_UVIS25_REG_BOOT_MASK BIT(7)
33 #define ST_UVIS25_REG_CTRL3_ADDR 0x22
34 #define ST_UVIS25_REG_HL_MASK BIT(7)
35 #define ST_UVIS25_REG_STATUS_ADDR 0x27
36 #define ST_UVIS25_REG_UV_DA_MASK BIT(0)
37 #define ST_UVIS25_REG_OUT_ADDR 0x28
39 static const struct iio_chan_spec st_uvis25_channels
[] = {
42 .address
= ST_UVIS25_REG_OUT_ADDR
,
43 .info_mask_separate
= BIT(IIO_CHAN_INFO_PROCESSED
),
51 IIO_CHAN_SOFT_TIMESTAMP(1),
54 static int st_uvis25_check_whoami(struct st_uvis25_hw
*hw
)
58 err
= regmap_read(hw
->regmap
, ST_UVIS25_REG_WHOAMI_ADDR
, &data
);
60 dev_err(regmap_get_device(hw
->regmap
),
61 "failed to read whoami register\n");
65 if (data
!= ST_UVIS25_REG_WHOAMI_VAL
) {
66 dev_err(regmap_get_device(hw
->regmap
),
67 "wrong whoami {%02x vs %02x}\n",
68 data
, ST_UVIS25_REG_WHOAMI_VAL
);
75 static int st_uvis25_set_enable(struct st_uvis25_hw
*hw
, bool enable
)
79 err
= regmap_update_bits(hw
->regmap
, ST_UVIS25_REG_CTRL1_ADDR
,
80 ST_UVIS25_REG_ODR_MASK
, enable
);
89 static int st_uvis25_read_oneshot(struct st_uvis25_hw
*hw
, u8 addr
, int *val
)
93 err
= st_uvis25_set_enable(hw
, true);
100 * in order to avoid possible race conditions with interrupt
101 * generation, disable the sensor first and then poll output
102 * register. That sequence guarantees the interrupt will be reset
103 * when irq line is unmasked
105 err
= st_uvis25_set_enable(hw
, false);
109 err
= regmap_read(hw
->regmap
, addr
, val
);
111 return err
< 0 ? err
: IIO_VAL_INT
;
114 static int st_uvis25_read_raw(struct iio_dev
*iio_dev
,
115 struct iio_chan_spec
const *ch
,
116 int *val
, int *val2
, long mask
)
120 ret
= iio_device_claim_direct_mode(iio_dev
);
125 case IIO_CHAN_INFO_PROCESSED
: {
126 struct st_uvis25_hw
*hw
= iio_priv(iio_dev
);
129 * mask irq line during oneshot read since the sensor
130 * does not export the capability to disable data-ready line
131 * in the register map and it is enabled by default.
132 * If the line is unmasked during read_raw() it will be set
133 * active and never reset since the trigger is disabled
136 disable_irq(hw
->irq
);
137 ret
= st_uvis25_read_oneshot(hw
, ch
->address
, val
);
147 iio_device_release_direct_mode(iio_dev
);
152 static irqreturn_t
st_uvis25_trigger_handler_thread(int irq
, void *private)
154 struct st_uvis25_hw
*hw
= private;
157 err
= regmap_read(hw
->regmap
, ST_UVIS25_REG_STATUS_ADDR
, &status
);
161 if (!(status
& ST_UVIS25_REG_UV_DA_MASK
))
164 iio_trigger_poll_chained(hw
->trig
);
169 static int st_uvis25_allocate_trigger(struct iio_dev
*iio_dev
)
171 struct st_uvis25_hw
*hw
= iio_priv(iio_dev
);
172 struct device
*dev
= regmap_get_device(hw
->regmap
);
173 bool irq_active_low
= false;
174 unsigned long irq_type
;
177 irq_type
= irqd_get_trigger_type(irq_get_irq_data(hw
->irq
));
180 case IRQF_TRIGGER_HIGH
:
181 case IRQF_TRIGGER_RISING
:
183 case IRQF_TRIGGER_LOW
:
184 case IRQF_TRIGGER_FALLING
:
185 irq_active_low
= true;
188 dev_info(dev
, "mode %lx unsupported\n", irq_type
);
192 err
= regmap_update_bits(hw
->regmap
, ST_UVIS25_REG_CTRL3_ADDR
,
193 ST_UVIS25_REG_HL_MASK
, irq_active_low
);
197 err
= devm_request_threaded_irq(dev
, hw
->irq
, NULL
,
198 st_uvis25_trigger_handler_thread
,
199 irq_type
| IRQF_ONESHOT
,
202 dev_err(dev
, "failed to request trigger irq %d\n",
207 hw
->trig
= devm_iio_trigger_alloc(dev
, "%s-trigger",
212 iio_trigger_set_drvdata(hw
->trig
, iio_dev
);
213 hw
->trig
->dev
.parent
= dev
;
215 return devm_iio_trigger_register(dev
, hw
->trig
);
218 static int st_uvis25_buffer_preenable(struct iio_dev
*iio_dev
)
220 return st_uvis25_set_enable(iio_priv(iio_dev
), true);
223 static int st_uvis25_buffer_postdisable(struct iio_dev
*iio_dev
)
225 return st_uvis25_set_enable(iio_priv(iio_dev
), false);
228 static const struct iio_buffer_setup_ops st_uvis25_buffer_ops
= {
229 .preenable
= st_uvis25_buffer_preenable
,
230 .postdisable
= st_uvis25_buffer_postdisable
,
233 static irqreturn_t
st_uvis25_buffer_handler_thread(int irq
, void *p
)
235 struct iio_poll_func
*pf
= p
;
236 struct iio_dev
*iio_dev
= pf
->indio_dev
;
237 struct st_uvis25_hw
*hw
= iio_priv(iio_dev
);
241 err
= regmap_read(hw
->regmap
, ST_UVIS25_REG_OUT_ADDR
, &val
);
247 iio_push_to_buffers_with_timestamp(iio_dev
, &hw
->scan
,
248 iio_get_time_ns(iio_dev
));
251 iio_trigger_notify_done(hw
->trig
);
256 static int st_uvis25_allocate_buffer(struct iio_dev
*iio_dev
)
258 struct st_uvis25_hw
*hw
= iio_priv(iio_dev
);
260 return devm_iio_triggered_buffer_setup(regmap_get_device(hw
->regmap
),
262 st_uvis25_buffer_handler_thread
,
263 &st_uvis25_buffer_ops
);
266 static const struct iio_info st_uvis25_info
= {
267 .read_raw
= st_uvis25_read_raw
,
270 static int st_uvis25_init_sensor(struct st_uvis25_hw
*hw
)
274 err
= regmap_update_bits(hw
->regmap
, ST_UVIS25_REG_CTRL2_ADDR
,
275 ST_UVIS25_REG_BOOT_MASK
, 1);
281 return regmap_update_bits(hw
->regmap
, ST_UVIS25_REG_CTRL1_ADDR
,
282 ST_UVIS25_REG_BDU_MASK
, 1);
285 int st_uvis25_probe(struct device
*dev
, int irq
, struct regmap
*regmap
)
287 struct st_uvis25_hw
*hw
;
288 struct iio_dev
*iio_dev
;
291 iio_dev
= devm_iio_device_alloc(dev
, sizeof(*hw
));
295 dev_set_drvdata(dev
, (void *)iio_dev
);
297 hw
= iio_priv(iio_dev
);
301 err
= st_uvis25_check_whoami(hw
);
305 iio_dev
->modes
= INDIO_DIRECT_MODE
;
306 iio_dev
->channels
= st_uvis25_channels
;
307 iio_dev
->num_channels
= ARRAY_SIZE(st_uvis25_channels
);
308 iio_dev
->name
= ST_UVIS25_DEV_NAME
;
309 iio_dev
->info
= &st_uvis25_info
;
311 err
= st_uvis25_init_sensor(hw
);
316 err
= st_uvis25_allocate_buffer(iio_dev
);
320 err
= st_uvis25_allocate_trigger(iio_dev
);
325 return devm_iio_device_register(dev
, iio_dev
);
327 EXPORT_SYMBOL(st_uvis25_probe
);
329 static int __maybe_unused
st_uvis25_suspend(struct device
*dev
)
331 struct iio_dev
*iio_dev
= dev_get_drvdata(dev
);
332 struct st_uvis25_hw
*hw
= iio_priv(iio_dev
);
334 return regmap_update_bits(hw
->regmap
, ST_UVIS25_REG_CTRL1_ADDR
,
335 ST_UVIS25_REG_ODR_MASK
, 0);
338 static int __maybe_unused
st_uvis25_resume(struct device
*dev
)
340 struct iio_dev
*iio_dev
= dev_get_drvdata(dev
);
341 struct st_uvis25_hw
*hw
= iio_priv(iio_dev
);
344 return regmap_update_bits(hw
->regmap
, ST_UVIS25_REG_CTRL1_ADDR
,
345 ST_UVIS25_REG_ODR_MASK
, 1);
350 const struct dev_pm_ops st_uvis25_pm_ops
= {
351 SET_SYSTEM_SLEEP_PM_OPS(st_uvis25_suspend
, st_uvis25_resume
)
353 EXPORT_SYMBOL(st_uvis25_pm_ops
);
355 MODULE_AUTHOR("Lorenzo Bianconi <lorenzo.bianconi83@gmail.com>");
356 MODULE_DESCRIPTION("STMicroelectronics uvis25 sensor driver");
357 MODULE_LICENSE("GPL v2");