11 #include <linux/device.h>
12 #include <linux/kernel.h>
14 #include <linux/slab.h>
16 #include <linux/module.h>
24 #define DRIVER_NAME "adis16203"
32 static int adis16203_spi_write_reg_8(
struct iio_dev *indio_dev,
43 ret = spi_write(st->
us, st->tx, 2);
56 static int adis16203_spi_write_reg_16(
struct iio_dev *indio_dev,
78 st->tx[1] = value & 0xFF;
80 st->tx[3] = (value >> 8) & 0xFF;
82 spi_message_init(&
msg);
83 spi_message_add_tail(&xfers[0], &
msg);
84 spi_message_add_tail(&xfers[1], &
msg);
98 static int adis16203_spi_read_reg_16(
struct iio_dev *indio_dev,
124 spi_message_init(&
msg);
125 spi_message_add_tail(&xfers[0], &
msg);
126 spi_message_add_tail(&xfers[1], &
msg);
129 dev_err(&st->
us->dev,
"problem when reading 16 bit register 0x%02X",
133 *val = (st->
rx[0] << 8) | st->
rx[1];
140 static int adis16203_check_status(
struct iio_dev *indio_dev)
145 ret = adis16203_spi_read_reg_16(indio_dev,
149 dev_err(&indio_dev->
dev,
"Reading status failed\n");
155 dev_err(&indio_dev->
dev,
"Self test failure\n");
159 dev_err(&indio_dev->
dev,
"Flash update failed\n");
161 dev_err(&indio_dev->
dev,
"Power supply above 3.625V\n");
163 dev_err(&indio_dev->
dev,
"Power supply below 3.15V\n");
169 static int adis16203_reset(
struct iio_dev *indio_dev)
172 ret = adis16203_spi_write_reg_8(indio_dev,
176 dev_err(&indio_dev->
dev,
"problem resetting device");
203 static int adis16203_self_test(
struct iio_dev *indio_dev)
206 ret = adis16203_spi_write_reg_16(indio_dev,
210 dev_err(&indio_dev->
dev,
"problem starting self test");
214 adis16203_check_status(indio_dev);
220 static int adis16203_initial_setup(
struct iio_dev *indio_dev)
227 dev_err(&indio_dev->
dev,
"disable irq failed");
232 ret = adis16203_self_test(indio_dev);
234 dev_err(&indio_dev->
dev,
"self test failure");
239 ret = adis16203_check_status(indio_dev);
241 adis16203_reset(indio_dev);
242 dev_err(&indio_dev->
dev,
"device not playing ball -> reset");
244 ret = adis16203_check_status(indio_dev);
263 static u8 adis16203_addresses[5][2] = {
271 static int adis16203_write_raw(
struct iio_dev *indio_dev,
279 return adis16203_spi_write_reg_16(indio_dev, addr, val & 0x3FFF);
282 static int adis16203_read_raw(
struct iio_dev *indio_dev,
294 addr = adis16203_addresses[chan->
address][0];
295 ret = adis16203_spi_read_reg_16(indio_dev, addr, &val16);
302 ret = adis16203_check_status(indio_dev);
308 val16 = val16 & ((1 << chan->
scan_type.realbits) - 1);
310 val16 = (
s16)(val16 <<
317 switch (chan->
type) {
339 *val = 25000 / -470 - 1278;
344 addr = adis16203_addresses[chan->
address][1];
345 ret = adis16203_spi_read_reg_16(indio_dev, addr, &val16);
350 val16 &= (1 <<
bits) - 1;
351 val16 = (
s16)(val16 << (16 - bits)) >> (16 - bits);
365 .extend_name =
"supply",
433 static const struct iio_info adis16203_info = {
434 .read_raw = &adis16203_read_raw,
435 .write_raw = &adis16203_write_raw,
447 if (indio_dev ==
NULL) {
451 st = iio_priv(indio_dev);
453 spi_set_drvdata(spi, indio_dev);
457 indio_dev->
name = spi->
dev.driver->name;
458 indio_dev->
dev.parent = &spi->
dev;
459 indio_dev->
channels = adis16203_channels;
461 indio_dev->
info = &adis16203_info;
473 goto error_unreg_ring_funcs;
479 goto error_uninitialize_ring;
483 ret = adis16203_initial_setup(indio_dev);
485 goto error_remove_trigger;
489 goto error_remove_trigger;
493 error_remove_trigger:
495 error_uninitialize_ring:
497 error_unreg_ring_funcs:
507 struct iio_dev *indio_dev = spi_get_drvdata(spi);
523 .probe = adis16203_probe,
529 MODULE_DESCRIPTION(
"Analog Devices ADIS16203 Programmable Digital Vibration Sensor driver");