1*fda8d26eSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 24eb3ccf1SLars-Peter Clausen /* 34eb3ccf1SLars-Peter Clausen * AD7887 SPI ADC driver 44eb3ccf1SLars-Peter Clausen * 54eb3ccf1SLars-Peter Clausen * Copyright 2010-2011 Analog Devices Inc. 64eb3ccf1SLars-Peter Clausen */ 74eb3ccf1SLars-Peter Clausen 84eb3ccf1SLars-Peter Clausen #include <linux/device.h> 94eb3ccf1SLars-Peter Clausen #include <linux/kernel.h> 104eb3ccf1SLars-Peter Clausen #include <linux/slab.h> 114eb3ccf1SLars-Peter Clausen #include <linux/sysfs.h> 124eb3ccf1SLars-Peter Clausen #include <linux/spi/spi.h> 134eb3ccf1SLars-Peter Clausen #include <linux/regulator/consumer.h> 144eb3ccf1SLars-Peter Clausen #include <linux/err.h> 154eb3ccf1SLars-Peter Clausen #include <linux/module.h> 164eb3ccf1SLars-Peter Clausen #include <linux/interrupt.h> 1709a1737eSPeter Meerwald #include <linux/bitops.h> 184eb3ccf1SLars-Peter Clausen 194eb3ccf1SLars-Peter Clausen #include <linux/iio/iio.h> 204eb3ccf1SLars-Peter Clausen #include <linux/iio/sysfs.h> 214eb3ccf1SLars-Peter Clausen #include <linux/iio/buffer.h> 224eb3ccf1SLars-Peter Clausen 234eb3ccf1SLars-Peter Clausen #include <linux/iio/trigger_consumer.h> 244eb3ccf1SLars-Peter Clausen #include <linux/iio/triggered_buffer.h> 254eb3ccf1SLars-Peter Clausen 264eb3ccf1SLars-Peter Clausen #include <linux/platform_data/ad7887.h> 274eb3ccf1SLars-Peter Clausen 2809a1737eSPeter Meerwald #define AD7887_REF_DIS BIT(5) /* on-chip reference disable */ 2909a1737eSPeter Meerwald #define AD7887_DUAL BIT(4) /* dual-channel mode */ 3009a1737eSPeter Meerwald #define AD7887_CH_AIN1 BIT(3) /* convert on channel 1, DUAL=1 */ 3109a1737eSPeter Meerwald #define AD7887_CH_AIN0 0 /* convert on channel 0, DUAL=0,1 */ 3209a1737eSPeter Meerwald #define AD7887_PM_MODE1 0 /* CS based shutdown */ 3309a1737eSPeter Meerwald #define AD7887_PM_MODE2 1 /* full on */ 3409a1737eSPeter Meerwald #define AD7887_PM_MODE3 2 /* auto shutdown after conversion */ 3509a1737eSPeter Meerwald #define AD7887_PM_MODE4 3 /* standby mode */ 364eb3ccf1SLars-Peter Clausen 374eb3ccf1SLars-Peter Clausen enum ad7887_channels { 384eb3ccf1SLars-Peter Clausen AD7887_CH0, 394eb3ccf1SLars-Peter Clausen AD7887_CH0_CH1, 404eb3ccf1SLars-Peter Clausen AD7887_CH1, 414eb3ccf1SLars-Peter Clausen }; 424eb3ccf1SLars-Peter Clausen 434eb3ccf1SLars-Peter Clausen /** 444eb3ccf1SLars-Peter Clausen * struct ad7887_chip_info - chip specifc information 454eb3ccf1SLars-Peter Clausen * @int_vref_mv: the internal reference voltage 464eb3ccf1SLars-Peter Clausen * @channel: channel specification 474eb3ccf1SLars-Peter Clausen */ 484eb3ccf1SLars-Peter Clausen struct ad7887_chip_info { 494eb3ccf1SLars-Peter Clausen u16 int_vref_mv; 504eb3ccf1SLars-Peter Clausen struct iio_chan_spec channel[3]; 514eb3ccf1SLars-Peter Clausen }; 524eb3ccf1SLars-Peter Clausen 534eb3ccf1SLars-Peter Clausen struct ad7887_state { 544eb3ccf1SLars-Peter Clausen struct spi_device *spi; 554eb3ccf1SLars-Peter Clausen const struct ad7887_chip_info *chip_info; 564eb3ccf1SLars-Peter Clausen struct regulator *reg; 574eb3ccf1SLars-Peter Clausen struct spi_transfer xfer[4]; 584eb3ccf1SLars-Peter Clausen struct spi_message msg[3]; 594eb3ccf1SLars-Peter Clausen struct spi_message *ring_msg; 604eb3ccf1SLars-Peter Clausen unsigned char tx_cmd_buf[4]; 614eb3ccf1SLars-Peter Clausen 624eb3ccf1SLars-Peter Clausen /* 634eb3ccf1SLars-Peter Clausen * DMA (thus cache coherency maintenance) requires the 644eb3ccf1SLars-Peter Clausen * transfer buffers to live in their own cache lines. 654eb3ccf1SLars-Peter Clausen * Buffer needs to be large enough to hold two 16 bit samples and a 664eb3ccf1SLars-Peter Clausen * 64 bit aligned 64 bit timestamp. 674eb3ccf1SLars-Peter Clausen */ 684eb3ccf1SLars-Peter Clausen unsigned char data[ALIGN(4, sizeof(s64)) + sizeof(s64)] 694eb3ccf1SLars-Peter Clausen ____cacheline_aligned; 704eb3ccf1SLars-Peter Clausen }; 714eb3ccf1SLars-Peter Clausen 724eb3ccf1SLars-Peter Clausen enum ad7887_supported_device_ids { 734eb3ccf1SLars-Peter Clausen ID_AD7887 744eb3ccf1SLars-Peter Clausen }; 754eb3ccf1SLars-Peter Clausen 764eb3ccf1SLars-Peter Clausen static int ad7887_ring_preenable(struct iio_dev *indio_dev) 774eb3ccf1SLars-Peter Clausen { 784eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 794eb3ccf1SLars-Peter Clausen 804eb3ccf1SLars-Peter Clausen /* We know this is a single long so can 'cheat' */ 814eb3ccf1SLars-Peter Clausen switch (*indio_dev->active_scan_mask) { 824eb3ccf1SLars-Peter Clausen case (1 << 0): 834eb3ccf1SLars-Peter Clausen st->ring_msg = &st->msg[AD7887_CH0]; 844eb3ccf1SLars-Peter Clausen break; 854eb3ccf1SLars-Peter Clausen case (1 << 1): 864eb3ccf1SLars-Peter Clausen st->ring_msg = &st->msg[AD7887_CH1]; 874eb3ccf1SLars-Peter Clausen /* Dummy read: push CH1 setting down to hardware */ 884eb3ccf1SLars-Peter Clausen spi_sync(st->spi, st->ring_msg); 894eb3ccf1SLars-Peter Clausen break; 904eb3ccf1SLars-Peter Clausen case ((1 << 1) | (1 << 0)): 914eb3ccf1SLars-Peter Clausen st->ring_msg = &st->msg[AD7887_CH0_CH1]; 924eb3ccf1SLars-Peter Clausen break; 934eb3ccf1SLars-Peter Clausen } 944eb3ccf1SLars-Peter Clausen 954eb3ccf1SLars-Peter Clausen return 0; 964eb3ccf1SLars-Peter Clausen } 974eb3ccf1SLars-Peter Clausen 984eb3ccf1SLars-Peter Clausen static int ad7887_ring_postdisable(struct iio_dev *indio_dev) 994eb3ccf1SLars-Peter Clausen { 1004eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 1014eb3ccf1SLars-Peter Clausen 1024eb3ccf1SLars-Peter Clausen /* dummy read: restore default CH0 settin */ 1034eb3ccf1SLars-Peter Clausen return spi_sync(st->spi, &st->msg[AD7887_CH0]); 1044eb3ccf1SLars-Peter Clausen } 1054eb3ccf1SLars-Peter Clausen 1064eb3ccf1SLars-Peter Clausen /** 1074eb3ccf1SLars-Peter Clausen * ad7887_trigger_handler() bh of trigger launched polling to ring buffer 1084eb3ccf1SLars-Peter Clausen * 1094eb3ccf1SLars-Peter Clausen * Currently there is no option in this driver to disable the saving of 1104eb3ccf1SLars-Peter Clausen * timestamps within the ring. 1114eb3ccf1SLars-Peter Clausen **/ 1124eb3ccf1SLars-Peter Clausen static irqreturn_t ad7887_trigger_handler(int irq, void *p) 1134eb3ccf1SLars-Peter Clausen { 1144eb3ccf1SLars-Peter Clausen struct iio_poll_func *pf = p; 1154eb3ccf1SLars-Peter Clausen struct iio_dev *indio_dev = pf->indio_dev; 1164eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 1174eb3ccf1SLars-Peter Clausen int b_sent; 1184eb3ccf1SLars-Peter Clausen 1194eb3ccf1SLars-Peter Clausen b_sent = spi_sync(st->spi, st->ring_msg); 1204eb3ccf1SLars-Peter Clausen if (b_sent) 1214eb3ccf1SLars-Peter Clausen goto done; 1224eb3ccf1SLars-Peter Clausen 1235afd602bSLars-Peter Clausen iio_push_to_buffers_with_timestamp(indio_dev, st->data, 124bc2b7dabSGregor Boirie iio_get_time_ns(indio_dev)); 1254eb3ccf1SLars-Peter Clausen done: 1264eb3ccf1SLars-Peter Clausen iio_trigger_notify_done(indio_dev->trig); 1274eb3ccf1SLars-Peter Clausen 1284eb3ccf1SLars-Peter Clausen return IRQ_HANDLED; 1294eb3ccf1SLars-Peter Clausen } 1304eb3ccf1SLars-Peter Clausen 1314eb3ccf1SLars-Peter Clausen static const struct iio_buffer_setup_ops ad7887_ring_setup_ops = { 1324eb3ccf1SLars-Peter Clausen .preenable = &ad7887_ring_preenable, 1334eb3ccf1SLars-Peter Clausen .postenable = &iio_triggered_buffer_postenable, 1344eb3ccf1SLars-Peter Clausen .predisable = &iio_triggered_buffer_predisable, 1354eb3ccf1SLars-Peter Clausen .postdisable = &ad7887_ring_postdisable, 1364eb3ccf1SLars-Peter Clausen }; 1374eb3ccf1SLars-Peter Clausen 1384eb3ccf1SLars-Peter Clausen static int ad7887_scan_direct(struct ad7887_state *st, unsigned ch) 1394eb3ccf1SLars-Peter Clausen { 1404eb3ccf1SLars-Peter Clausen int ret = spi_sync(st->spi, &st->msg[ch]); 1414eb3ccf1SLars-Peter Clausen if (ret) 1424eb3ccf1SLars-Peter Clausen return ret; 1434eb3ccf1SLars-Peter Clausen 1444eb3ccf1SLars-Peter Clausen return (st->data[(ch * 2)] << 8) | st->data[(ch * 2) + 1]; 1454eb3ccf1SLars-Peter Clausen } 1464eb3ccf1SLars-Peter Clausen 1474eb3ccf1SLars-Peter Clausen static int ad7887_read_raw(struct iio_dev *indio_dev, 1484eb3ccf1SLars-Peter Clausen struct iio_chan_spec const *chan, 1494eb3ccf1SLars-Peter Clausen int *val, 1504eb3ccf1SLars-Peter Clausen int *val2, 1514eb3ccf1SLars-Peter Clausen long m) 1524eb3ccf1SLars-Peter Clausen { 1534eb3ccf1SLars-Peter Clausen int ret; 1544eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 1554eb3ccf1SLars-Peter Clausen 1564eb3ccf1SLars-Peter Clausen switch (m) { 1574eb3ccf1SLars-Peter Clausen case IIO_CHAN_INFO_RAW: 1586fea8a42SAlison Schofield ret = iio_device_claim_direct_mode(indio_dev); 1596fea8a42SAlison Schofield if (ret) 1606fea8a42SAlison Schofield return ret; 1614eb3ccf1SLars-Peter Clausen ret = ad7887_scan_direct(st, chan->address); 1626fea8a42SAlison Schofield iio_device_release_direct_mode(indio_dev); 1634eb3ccf1SLars-Peter Clausen 1644eb3ccf1SLars-Peter Clausen if (ret < 0) 1654eb3ccf1SLars-Peter Clausen return ret; 1664eb3ccf1SLars-Peter Clausen *val = ret >> chan->scan_type.shift; 16709a1737eSPeter Meerwald *val &= GENMASK(chan->scan_type.realbits - 1, 0); 1684eb3ccf1SLars-Peter Clausen return IIO_VAL_INT; 1694eb3ccf1SLars-Peter Clausen case IIO_CHAN_INFO_SCALE: 1704eb3ccf1SLars-Peter Clausen if (st->reg) { 1714eb3ccf1SLars-Peter Clausen *val = regulator_get_voltage(st->reg); 1724eb3ccf1SLars-Peter Clausen if (*val < 0) 1734eb3ccf1SLars-Peter Clausen return *val; 1744eb3ccf1SLars-Peter Clausen *val /= 1000; 1754eb3ccf1SLars-Peter Clausen } else { 1764eb3ccf1SLars-Peter Clausen *val = st->chip_info->int_vref_mv; 1774eb3ccf1SLars-Peter Clausen } 1784eb3ccf1SLars-Peter Clausen 1794eb3ccf1SLars-Peter Clausen *val2 = chan->scan_type.realbits; 1804eb3ccf1SLars-Peter Clausen 1814eb3ccf1SLars-Peter Clausen return IIO_VAL_FRACTIONAL_LOG2; 1824eb3ccf1SLars-Peter Clausen } 1834eb3ccf1SLars-Peter Clausen return -EINVAL; 1844eb3ccf1SLars-Peter Clausen } 1854eb3ccf1SLars-Peter Clausen 1864eb3ccf1SLars-Peter Clausen 1874eb3ccf1SLars-Peter Clausen static const struct ad7887_chip_info ad7887_chip_info_tbl[] = { 1884eb3ccf1SLars-Peter Clausen /* 1894eb3ccf1SLars-Peter Clausen * More devices added in future 1904eb3ccf1SLars-Peter Clausen */ 1914eb3ccf1SLars-Peter Clausen [ID_AD7887] = { 1924eb3ccf1SLars-Peter Clausen .channel[0] = { 1934eb3ccf1SLars-Peter Clausen .type = IIO_VOLTAGE, 1944eb3ccf1SLars-Peter Clausen .indexed = 1, 1954eb3ccf1SLars-Peter Clausen .channel = 1, 19616d186b1SJonathan Cameron .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 19716d186b1SJonathan Cameron .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), 1984eb3ccf1SLars-Peter Clausen .address = 1, 1994eb3ccf1SLars-Peter Clausen .scan_index = 1, 200e39d9905SJonathan Cameron .scan_type = { 201e39d9905SJonathan Cameron .sign = 'u', 202e39d9905SJonathan Cameron .realbits = 12, 203e39d9905SJonathan Cameron .storagebits = 16, 204e39d9905SJonathan Cameron .shift = 0, 205e39d9905SJonathan Cameron .endianness = IIO_BE, 206e39d9905SJonathan Cameron }, 2074eb3ccf1SLars-Peter Clausen }, 2084eb3ccf1SLars-Peter Clausen .channel[1] = { 2094eb3ccf1SLars-Peter Clausen .type = IIO_VOLTAGE, 2104eb3ccf1SLars-Peter Clausen .indexed = 1, 2114eb3ccf1SLars-Peter Clausen .channel = 0, 21216d186b1SJonathan Cameron .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 21316d186b1SJonathan Cameron .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), 2144eb3ccf1SLars-Peter Clausen .address = 0, 2154eb3ccf1SLars-Peter Clausen .scan_index = 0, 216e39d9905SJonathan Cameron .scan_type = { 217e39d9905SJonathan Cameron .sign = 'u', 218e39d9905SJonathan Cameron .realbits = 12, 219e39d9905SJonathan Cameron .storagebits = 16, 220e39d9905SJonathan Cameron .shift = 0, 221e39d9905SJonathan Cameron .endianness = IIO_BE, 222e39d9905SJonathan Cameron }, 2234eb3ccf1SLars-Peter Clausen }, 2244eb3ccf1SLars-Peter Clausen .channel[2] = IIO_CHAN_SOFT_TIMESTAMP(2), 2254eb3ccf1SLars-Peter Clausen .int_vref_mv = 2500, 2264eb3ccf1SLars-Peter Clausen }, 2274eb3ccf1SLars-Peter Clausen }; 2284eb3ccf1SLars-Peter Clausen 2294eb3ccf1SLars-Peter Clausen static const struct iio_info ad7887_info = { 2304eb3ccf1SLars-Peter Clausen .read_raw = &ad7887_read_raw, 2314eb3ccf1SLars-Peter Clausen }; 2324eb3ccf1SLars-Peter Clausen 233fc52692cSGreg Kroah-Hartman static int ad7887_probe(struct spi_device *spi) 2344eb3ccf1SLars-Peter Clausen { 2354eb3ccf1SLars-Peter Clausen struct ad7887_platform_data *pdata = spi->dev.platform_data; 2364eb3ccf1SLars-Peter Clausen struct ad7887_state *st; 23782429e0dSSachin Kamat struct iio_dev *indio_dev; 2384eb3ccf1SLars-Peter Clausen uint8_t mode; 2394eb3ccf1SLars-Peter Clausen int ret; 2404eb3ccf1SLars-Peter Clausen 24182429e0dSSachin Kamat indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); 2424eb3ccf1SLars-Peter Clausen if (indio_dev == NULL) 2434eb3ccf1SLars-Peter Clausen return -ENOMEM; 2444eb3ccf1SLars-Peter Clausen 2454eb3ccf1SLars-Peter Clausen st = iio_priv(indio_dev); 2464eb3ccf1SLars-Peter Clausen 2474eb3ccf1SLars-Peter Clausen if (!pdata || !pdata->use_onchip_ref) { 24882429e0dSSachin Kamat st->reg = devm_regulator_get(&spi->dev, "vref"); 24982429e0dSSachin Kamat if (IS_ERR(st->reg)) 25082429e0dSSachin Kamat return PTR_ERR(st->reg); 2514eb3ccf1SLars-Peter Clausen 2524eb3ccf1SLars-Peter Clausen ret = regulator_enable(st->reg); 2534eb3ccf1SLars-Peter Clausen if (ret) 25482429e0dSSachin Kamat return ret; 2554eb3ccf1SLars-Peter Clausen } 2564eb3ccf1SLars-Peter Clausen 2574eb3ccf1SLars-Peter Clausen st->chip_info = 2584eb3ccf1SLars-Peter Clausen &ad7887_chip_info_tbl[spi_get_device_id(spi)->driver_data]; 2594eb3ccf1SLars-Peter Clausen 2604eb3ccf1SLars-Peter Clausen spi_set_drvdata(spi, indio_dev); 2614eb3ccf1SLars-Peter Clausen st->spi = spi; 2624eb3ccf1SLars-Peter Clausen 2634eb3ccf1SLars-Peter Clausen /* Estabilish that the iio_dev is a child of the spi device */ 2644eb3ccf1SLars-Peter Clausen indio_dev->dev.parent = &spi->dev; 265b541eaffSMatt Ranostay indio_dev->dev.of_node = spi->dev.of_node; 2664eb3ccf1SLars-Peter Clausen indio_dev->name = spi_get_device_id(spi)->name; 2674eb3ccf1SLars-Peter Clausen indio_dev->info = &ad7887_info; 2684eb3ccf1SLars-Peter Clausen indio_dev->modes = INDIO_DIRECT_MODE; 2694eb3ccf1SLars-Peter Clausen 2704eb3ccf1SLars-Peter Clausen /* Setup default message */ 2714eb3ccf1SLars-Peter Clausen 2724eb3ccf1SLars-Peter Clausen mode = AD7887_PM_MODE4; 2734eb3ccf1SLars-Peter Clausen if (!pdata || !pdata->use_onchip_ref) 2744eb3ccf1SLars-Peter Clausen mode |= AD7887_REF_DIS; 2754eb3ccf1SLars-Peter Clausen if (pdata && pdata->en_dual) 2764eb3ccf1SLars-Peter Clausen mode |= AD7887_DUAL; 2774eb3ccf1SLars-Peter Clausen 2784eb3ccf1SLars-Peter Clausen st->tx_cmd_buf[0] = AD7887_CH_AIN0 | mode; 2794eb3ccf1SLars-Peter Clausen 2804eb3ccf1SLars-Peter Clausen st->xfer[0].rx_buf = &st->data[0]; 2814eb3ccf1SLars-Peter Clausen st->xfer[0].tx_buf = &st->tx_cmd_buf[0]; 2824eb3ccf1SLars-Peter Clausen st->xfer[0].len = 2; 2834eb3ccf1SLars-Peter Clausen 2844eb3ccf1SLars-Peter Clausen spi_message_init(&st->msg[AD7887_CH0]); 2854eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[0], &st->msg[AD7887_CH0]); 2864eb3ccf1SLars-Peter Clausen 2874eb3ccf1SLars-Peter Clausen if (pdata && pdata->en_dual) { 2884eb3ccf1SLars-Peter Clausen st->tx_cmd_buf[2] = AD7887_CH_AIN1 | mode; 2894eb3ccf1SLars-Peter Clausen 2904eb3ccf1SLars-Peter Clausen st->xfer[1].rx_buf = &st->data[0]; 2914eb3ccf1SLars-Peter Clausen st->xfer[1].tx_buf = &st->tx_cmd_buf[2]; 2924eb3ccf1SLars-Peter Clausen st->xfer[1].len = 2; 2934eb3ccf1SLars-Peter Clausen 2944eb3ccf1SLars-Peter Clausen st->xfer[2].rx_buf = &st->data[2]; 2954eb3ccf1SLars-Peter Clausen st->xfer[2].tx_buf = &st->tx_cmd_buf[0]; 2964eb3ccf1SLars-Peter Clausen st->xfer[2].len = 2; 2974eb3ccf1SLars-Peter Clausen 2984eb3ccf1SLars-Peter Clausen spi_message_init(&st->msg[AD7887_CH0_CH1]); 2994eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[1], &st->msg[AD7887_CH0_CH1]); 3004eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[2], &st->msg[AD7887_CH0_CH1]); 3014eb3ccf1SLars-Peter Clausen 3024eb3ccf1SLars-Peter Clausen st->xfer[3].rx_buf = &st->data[2]; 3034eb3ccf1SLars-Peter Clausen st->xfer[3].tx_buf = &st->tx_cmd_buf[2]; 3044eb3ccf1SLars-Peter Clausen st->xfer[3].len = 2; 3054eb3ccf1SLars-Peter Clausen 3064eb3ccf1SLars-Peter Clausen spi_message_init(&st->msg[AD7887_CH1]); 3074eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[3], &st->msg[AD7887_CH1]); 3084eb3ccf1SLars-Peter Clausen 3094eb3ccf1SLars-Peter Clausen indio_dev->channels = st->chip_info->channel; 3104eb3ccf1SLars-Peter Clausen indio_dev->num_channels = 3; 3114eb3ccf1SLars-Peter Clausen } else { 3124eb3ccf1SLars-Peter Clausen indio_dev->channels = &st->chip_info->channel[1]; 3134eb3ccf1SLars-Peter Clausen indio_dev->num_channels = 2; 3144eb3ccf1SLars-Peter Clausen } 3154eb3ccf1SLars-Peter Clausen 3164eb3ccf1SLars-Peter Clausen ret = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time, 3174eb3ccf1SLars-Peter Clausen &ad7887_trigger_handler, &ad7887_ring_setup_ops); 3184eb3ccf1SLars-Peter Clausen if (ret) 3194eb3ccf1SLars-Peter Clausen goto error_disable_reg; 3204eb3ccf1SLars-Peter Clausen 3214eb3ccf1SLars-Peter Clausen ret = iio_device_register(indio_dev); 3224eb3ccf1SLars-Peter Clausen if (ret) 3234eb3ccf1SLars-Peter Clausen goto error_unregister_ring; 3244eb3ccf1SLars-Peter Clausen 3254eb3ccf1SLars-Peter Clausen return 0; 3264eb3ccf1SLars-Peter Clausen error_unregister_ring: 3274eb3ccf1SLars-Peter Clausen iio_triggered_buffer_cleanup(indio_dev); 3284eb3ccf1SLars-Peter Clausen error_disable_reg: 3294eb3ccf1SLars-Peter Clausen if (st->reg) 3304eb3ccf1SLars-Peter Clausen regulator_disable(st->reg); 3314eb3ccf1SLars-Peter Clausen 3324eb3ccf1SLars-Peter Clausen return ret; 3334eb3ccf1SLars-Peter Clausen } 3344eb3ccf1SLars-Peter Clausen 335fc52692cSGreg Kroah-Hartman static int ad7887_remove(struct spi_device *spi) 3364eb3ccf1SLars-Peter Clausen { 3374eb3ccf1SLars-Peter Clausen struct iio_dev *indio_dev = spi_get_drvdata(spi); 3384eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 3394eb3ccf1SLars-Peter Clausen 3404eb3ccf1SLars-Peter Clausen iio_device_unregister(indio_dev); 3414eb3ccf1SLars-Peter Clausen iio_triggered_buffer_cleanup(indio_dev); 34282429e0dSSachin Kamat if (st->reg) 3434eb3ccf1SLars-Peter Clausen regulator_disable(st->reg); 3444eb3ccf1SLars-Peter Clausen 3454eb3ccf1SLars-Peter Clausen return 0; 3464eb3ccf1SLars-Peter Clausen } 3474eb3ccf1SLars-Peter Clausen 3484eb3ccf1SLars-Peter Clausen static const struct spi_device_id ad7887_id[] = { 3494eb3ccf1SLars-Peter Clausen {"ad7887", ID_AD7887}, 3504eb3ccf1SLars-Peter Clausen {} 3514eb3ccf1SLars-Peter Clausen }; 3524eb3ccf1SLars-Peter Clausen MODULE_DEVICE_TABLE(spi, ad7887_id); 3534eb3ccf1SLars-Peter Clausen 3544eb3ccf1SLars-Peter Clausen static struct spi_driver ad7887_driver = { 3554eb3ccf1SLars-Peter Clausen .driver = { 3564eb3ccf1SLars-Peter Clausen .name = "ad7887", 3574eb3ccf1SLars-Peter Clausen }, 3584eb3ccf1SLars-Peter Clausen .probe = ad7887_probe, 359fc52692cSGreg Kroah-Hartman .remove = ad7887_remove, 3604eb3ccf1SLars-Peter Clausen .id_table = ad7887_id, 3614eb3ccf1SLars-Peter Clausen }; 3624eb3ccf1SLars-Peter Clausen module_spi_driver(ad7887_driver); 3634eb3ccf1SLars-Peter Clausen 3649920ed25SMichael Hennerich MODULE_AUTHOR("Michael Hennerich <michael.hennerich@analog.com>"); 3654eb3ccf1SLars-Peter Clausen MODULE_DESCRIPTION("Analog Devices AD7887 ADC"); 3664eb3ccf1SLars-Peter Clausen MODULE_LICENSE("GPL v2"); 367