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