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> 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 284eb3ccf1SLars-Peter Clausen #define AD7887_REF_DIS (1 << 5) /* on-chip reference disable */ 294eb3ccf1SLars-Peter Clausen #define AD7887_DUAL (1 << 4) /* dual-channel mode */ 304eb3ccf1SLars-Peter Clausen #define AD7887_CH_AIN1 (1 << 3) /* convert on channel 1, DUAL=1 */ 314eb3ccf1SLars-Peter Clausen #define AD7887_CH_AIN0 (0 << 3) /* convert on channel 0, DUAL=0,1 */ 324eb3ccf1SLars-Peter Clausen #define AD7887_PM_MODE1 (0) /* CS based shutdown */ 334eb3ccf1SLars-Peter Clausen #define AD7887_PM_MODE2 (1) /* full on */ 344eb3ccf1SLars-Peter Clausen #define AD7887_PM_MODE3 (2) /* auto shutdown after conversion */ 354eb3ccf1SLars-Peter Clausen #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 #define RES_MASK(bits) ((1 << (bits)) - 1) 444eb3ccf1SLars-Peter Clausen 454eb3ccf1SLars-Peter Clausen /** 464eb3ccf1SLars-Peter Clausen * struct ad7887_chip_info - chip specifc information 474eb3ccf1SLars-Peter Clausen * @int_vref_mv: the internal reference voltage 484eb3ccf1SLars-Peter Clausen * @channel: channel specification 494eb3ccf1SLars-Peter Clausen */ 504eb3ccf1SLars-Peter Clausen struct ad7887_chip_info { 514eb3ccf1SLars-Peter Clausen u16 int_vref_mv; 524eb3ccf1SLars-Peter Clausen struct iio_chan_spec channel[3]; 534eb3ccf1SLars-Peter Clausen }; 544eb3ccf1SLars-Peter Clausen 554eb3ccf1SLars-Peter Clausen struct ad7887_state { 564eb3ccf1SLars-Peter Clausen struct spi_device *spi; 574eb3ccf1SLars-Peter Clausen const struct ad7887_chip_info *chip_info; 584eb3ccf1SLars-Peter Clausen struct regulator *reg; 594eb3ccf1SLars-Peter Clausen struct spi_transfer xfer[4]; 604eb3ccf1SLars-Peter Clausen struct spi_message msg[3]; 614eb3ccf1SLars-Peter Clausen struct spi_message *ring_msg; 624eb3ccf1SLars-Peter Clausen unsigned char tx_cmd_buf[4]; 634eb3ccf1SLars-Peter Clausen 644eb3ccf1SLars-Peter Clausen /* 654eb3ccf1SLars-Peter Clausen * DMA (thus cache coherency maintenance) requires the 664eb3ccf1SLars-Peter Clausen * transfer buffers to live in their own cache lines. 674eb3ccf1SLars-Peter Clausen * Buffer needs to be large enough to hold two 16 bit samples and a 684eb3ccf1SLars-Peter Clausen * 64 bit aligned 64 bit timestamp. 694eb3ccf1SLars-Peter Clausen */ 704eb3ccf1SLars-Peter Clausen unsigned char data[ALIGN(4, sizeof(s64)) + sizeof(s64)] 714eb3ccf1SLars-Peter Clausen ____cacheline_aligned; 724eb3ccf1SLars-Peter Clausen }; 734eb3ccf1SLars-Peter Clausen 744eb3ccf1SLars-Peter Clausen enum ad7887_supported_device_ids { 754eb3ccf1SLars-Peter Clausen ID_AD7887 764eb3ccf1SLars-Peter Clausen }; 774eb3ccf1SLars-Peter Clausen 784eb3ccf1SLars-Peter Clausen static int ad7887_ring_preenable(struct iio_dev *indio_dev) 794eb3ccf1SLars-Peter Clausen { 804eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 814eb3ccf1SLars-Peter Clausen int ret; 824eb3ccf1SLars-Peter Clausen 834eb3ccf1SLars-Peter Clausen ret = iio_sw_buffer_preenable(indio_dev); 844eb3ccf1SLars-Peter Clausen if (ret < 0) 854eb3ccf1SLars-Peter Clausen return ret; 864eb3ccf1SLars-Peter Clausen 874eb3ccf1SLars-Peter Clausen /* We know this is a single long so can 'cheat' */ 884eb3ccf1SLars-Peter Clausen switch (*indio_dev->active_scan_mask) { 894eb3ccf1SLars-Peter Clausen case (1 << 0): 904eb3ccf1SLars-Peter Clausen st->ring_msg = &st->msg[AD7887_CH0]; 914eb3ccf1SLars-Peter Clausen break; 924eb3ccf1SLars-Peter Clausen case (1 << 1): 934eb3ccf1SLars-Peter Clausen st->ring_msg = &st->msg[AD7887_CH1]; 944eb3ccf1SLars-Peter Clausen /* Dummy read: push CH1 setting down to hardware */ 954eb3ccf1SLars-Peter Clausen spi_sync(st->spi, st->ring_msg); 964eb3ccf1SLars-Peter Clausen break; 974eb3ccf1SLars-Peter Clausen case ((1 << 1) | (1 << 0)): 984eb3ccf1SLars-Peter Clausen st->ring_msg = &st->msg[AD7887_CH0_CH1]; 994eb3ccf1SLars-Peter Clausen break; 1004eb3ccf1SLars-Peter Clausen } 1014eb3ccf1SLars-Peter Clausen 1024eb3ccf1SLars-Peter Clausen return 0; 1034eb3ccf1SLars-Peter Clausen } 1044eb3ccf1SLars-Peter Clausen 1054eb3ccf1SLars-Peter Clausen static int ad7887_ring_postdisable(struct iio_dev *indio_dev) 1064eb3ccf1SLars-Peter Clausen { 1074eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 1084eb3ccf1SLars-Peter Clausen 1094eb3ccf1SLars-Peter Clausen /* dummy read: restore default CH0 settin */ 1104eb3ccf1SLars-Peter Clausen return spi_sync(st->spi, &st->msg[AD7887_CH0]); 1114eb3ccf1SLars-Peter Clausen } 1124eb3ccf1SLars-Peter Clausen 1134eb3ccf1SLars-Peter Clausen /** 1144eb3ccf1SLars-Peter Clausen * ad7887_trigger_handler() bh of trigger launched polling to ring buffer 1154eb3ccf1SLars-Peter Clausen * 1164eb3ccf1SLars-Peter Clausen * Currently there is no option in this driver to disable the saving of 1174eb3ccf1SLars-Peter Clausen * timestamps within the ring. 1184eb3ccf1SLars-Peter Clausen **/ 1194eb3ccf1SLars-Peter Clausen static irqreturn_t ad7887_trigger_handler(int irq, void *p) 1204eb3ccf1SLars-Peter Clausen { 1214eb3ccf1SLars-Peter Clausen struct iio_poll_func *pf = p; 1224eb3ccf1SLars-Peter Clausen struct iio_dev *indio_dev = pf->indio_dev; 1234eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 1244eb3ccf1SLars-Peter Clausen s64 time_ns; 1254eb3ccf1SLars-Peter Clausen int b_sent; 1264eb3ccf1SLars-Peter Clausen 1274eb3ccf1SLars-Peter Clausen b_sent = spi_sync(st->spi, st->ring_msg); 1284eb3ccf1SLars-Peter Clausen if (b_sent) 1294eb3ccf1SLars-Peter Clausen goto done; 1304eb3ccf1SLars-Peter Clausen 1314eb3ccf1SLars-Peter Clausen time_ns = iio_get_time_ns(); 1324eb3ccf1SLars-Peter Clausen 1334eb3ccf1SLars-Peter Clausen if (indio_dev->scan_timestamp) 1344eb3ccf1SLars-Peter Clausen memcpy(st->data + indio_dev->scan_bytes - sizeof(s64), 1354eb3ccf1SLars-Peter Clausen &time_ns, sizeof(time_ns)); 1364eb3ccf1SLars-Peter Clausen 13784b36ce5SJonathan Cameron iio_push_to_buffers(indio_dev, st->data); 1384eb3ccf1SLars-Peter Clausen done: 1394eb3ccf1SLars-Peter Clausen iio_trigger_notify_done(indio_dev->trig); 1404eb3ccf1SLars-Peter Clausen 1414eb3ccf1SLars-Peter Clausen return IRQ_HANDLED; 1424eb3ccf1SLars-Peter Clausen } 1434eb3ccf1SLars-Peter Clausen 1444eb3ccf1SLars-Peter Clausen static const struct iio_buffer_setup_ops ad7887_ring_setup_ops = { 1454eb3ccf1SLars-Peter Clausen .preenable = &ad7887_ring_preenable, 1464eb3ccf1SLars-Peter Clausen .postenable = &iio_triggered_buffer_postenable, 1474eb3ccf1SLars-Peter Clausen .predisable = &iio_triggered_buffer_predisable, 1484eb3ccf1SLars-Peter Clausen .postdisable = &ad7887_ring_postdisable, 1494eb3ccf1SLars-Peter Clausen }; 1504eb3ccf1SLars-Peter Clausen 1514eb3ccf1SLars-Peter Clausen static int ad7887_scan_direct(struct ad7887_state *st, unsigned ch) 1524eb3ccf1SLars-Peter Clausen { 1534eb3ccf1SLars-Peter Clausen int ret = spi_sync(st->spi, &st->msg[ch]); 1544eb3ccf1SLars-Peter Clausen if (ret) 1554eb3ccf1SLars-Peter Clausen return ret; 1564eb3ccf1SLars-Peter Clausen 1574eb3ccf1SLars-Peter Clausen return (st->data[(ch * 2)] << 8) | st->data[(ch * 2) + 1]; 1584eb3ccf1SLars-Peter Clausen } 1594eb3ccf1SLars-Peter Clausen 1604eb3ccf1SLars-Peter Clausen static int ad7887_read_raw(struct iio_dev *indio_dev, 1614eb3ccf1SLars-Peter Clausen struct iio_chan_spec const *chan, 1624eb3ccf1SLars-Peter Clausen int *val, 1634eb3ccf1SLars-Peter Clausen int *val2, 1644eb3ccf1SLars-Peter Clausen long m) 1654eb3ccf1SLars-Peter Clausen { 1664eb3ccf1SLars-Peter Clausen int ret; 1674eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 1684eb3ccf1SLars-Peter Clausen 1694eb3ccf1SLars-Peter Clausen switch (m) { 1704eb3ccf1SLars-Peter Clausen case IIO_CHAN_INFO_RAW: 1714eb3ccf1SLars-Peter Clausen mutex_lock(&indio_dev->mlock); 1724eb3ccf1SLars-Peter Clausen if (iio_buffer_enabled(indio_dev)) 1734eb3ccf1SLars-Peter Clausen ret = -EBUSY; 1744eb3ccf1SLars-Peter Clausen else 1754eb3ccf1SLars-Peter Clausen ret = ad7887_scan_direct(st, chan->address); 1764eb3ccf1SLars-Peter Clausen mutex_unlock(&indio_dev->mlock); 1774eb3ccf1SLars-Peter Clausen 1784eb3ccf1SLars-Peter Clausen if (ret < 0) 1794eb3ccf1SLars-Peter Clausen return ret; 1804eb3ccf1SLars-Peter Clausen *val = ret >> chan->scan_type.shift; 1814eb3ccf1SLars-Peter Clausen *val &= RES_MASK(chan->scan_type.realbits); 1824eb3ccf1SLars-Peter Clausen return IIO_VAL_INT; 1834eb3ccf1SLars-Peter Clausen case IIO_CHAN_INFO_SCALE: 1844eb3ccf1SLars-Peter Clausen if (st->reg) { 1854eb3ccf1SLars-Peter Clausen *val = regulator_get_voltage(st->reg); 1864eb3ccf1SLars-Peter Clausen if (*val < 0) 1874eb3ccf1SLars-Peter Clausen return *val; 1884eb3ccf1SLars-Peter Clausen *val /= 1000; 1894eb3ccf1SLars-Peter Clausen } else { 1904eb3ccf1SLars-Peter Clausen *val = st->chip_info->int_vref_mv; 1914eb3ccf1SLars-Peter Clausen } 1924eb3ccf1SLars-Peter Clausen 1934eb3ccf1SLars-Peter Clausen *val2 = chan->scan_type.realbits; 1944eb3ccf1SLars-Peter Clausen 1954eb3ccf1SLars-Peter Clausen return IIO_VAL_FRACTIONAL_LOG2; 1964eb3ccf1SLars-Peter Clausen } 1974eb3ccf1SLars-Peter Clausen return -EINVAL; 1984eb3ccf1SLars-Peter Clausen } 1994eb3ccf1SLars-Peter Clausen 2004eb3ccf1SLars-Peter Clausen 2014eb3ccf1SLars-Peter Clausen static const struct ad7887_chip_info ad7887_chip_info_tbl[] = { 2024eb3ccf1SLars-Peter Clausen /* 2034eb3ccf1SLars-Peter Clausen * More devices added in future 2044eb3ccf1SLars-Peter Clausen */ 2054eb3ccf1SLars-Peter Clausen [ID_AD7887] = { 2064eb3ccf1SLars-Peter Clausen .channel[0] = { 2074eb3ccf1SLars-Peter Clausen .type = IIO_VOLTAGE, 2084eb3ccf1SLars-Peter Clausen .indexed = 1, 2094eb3ccf1SLars-Peter Clausen .channel = 1, 21016d186b1SJonathan Cameron .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 21116d186b1SJonathan Cameron .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), 2124eb3ccf1SLars-Peter Clausen .address = 1, 2134eb3ccf1SLars-Peter Clausen .scan_index = 1, 2144eb3ccf1SLars-Peter Clausen .scan_type = IIO_ST('u', 12, 16, 0), 2154eb3ccf1SLars-Peter Clausen }, 2164eb3ccf1SLars-Peter Clausen .channel[1] = { 2174eb3ccf1SLars-Peter Clausen .type = IIO_VOLTAGE, 2184eb3ccf1SLars-Peter Clausen .indexed = 1, 2194eb3ccf1SLars-Peter Clausen .channel = 0, 22016d186b1SJonathan Cameron .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 22116d186b1SJonathan Cameron .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), 2224eb3ccf1SLars-Peter Clausen .address = 0, 2234eb3ccf1SLars-Peter Clausen .scan_index = 0, 2244eb3ccf1SLars-Peter Clausen .scan_type = IIO_ST('u', 12, 16, 0), 2254eb3ccf1SLars-Peter Clausen }, 2264eb3ccf1SLars-Peter Clausen .channel[2] = IIO_CHAN_SOFT_TIMESTAMP(2), 2274eb3ccf1SLars-Peter Clausen .int_vref_mv = 2500, 2284eb3ccf1SLars-Peter Clausen }, 2294eb3ccf1SLars-Peter Clausen }; 2304eb3ccf1SLars-Peter Clausen 2314eb3ccf1SLars-Peter Clausen static const struct iio_info ad7887_info = { 2324eb3ccf1SLars-Peter Clausen .read_raw = &ad7887_read_raw, 2334eb3ccf1SLars-Peter Clausen .driver_module = THIS_MODULE, 2344eb3ccf1SLars-Peter Clausen }; 2354eb3ccf1SLars-Peter Clausen 236fc52692cSGreg Kroah-Hartman static int ad7887_probe(struct spi_device *spi) 2374eb3ccf1SLars-Peter Clausen { 2384eb3ccf1SLars-Peter Clausen struct ad7887_platform_data *pdata = spi->dev.platform_data; 2394eb3ccf1SLars-Peter Clausen struct ad7887_state *st; 240*82429e0dSSachin Kamat struct iio_dev *indio_dev; 2414eb3ccf1SLars-Peter Clausen uint8_t mode; 2424eb3ccf1SLars-Peter Clausen int ret; 2434eb3ccf1SLars-Peter Clausen 244*82429e0dSSachin Kamat indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); 2454eb3ccf1SLars-Peter Clausen if (indio_dev == NULL) 2464eb3ccf1SLars-Peter Clausen return -ENOMEM; 2474eb3ccf1SLars-Peter Clausen 2484eb3ccf1SLars-Peter Clausen st = iio_priv(indio_dev); 2494eb3ccf1SLars-Peter Clausen 2504eb3ccf1SLars-Peter Clausen if (!pdata || !pdata->use_onchip_ref) { 251*82429e0dSSachin Kamat st->reg = devm_regulator_get(&spi->dev, "vref"); 252*82429e0dSSachin Kamat if (IS_ERR(st->reg)) 253*82429e0dSSachin Kamat return PTR_ERR(st->reg); 2544eb3ccf1SLars-Peter Clausen 2554eb3ccf1SLars-Peter Clausen ret = regulator_enable(st->reg); 2564eb3ccf1SLars-Peter Clausen if (ret) 257*82429e0dSSachin Kamat return ret; 2584eb3ccf1SLars-Peter Clausen } 2594eb3ccf1SLars-Peter Clausen 2604eb3ccf1SLars-Peter Clausen st->chip_info = 2614eb3ccf1SLars-Peter Clausen &ad7887_chip_info_tbl[spi_get_device_id(spi)->driver_data]; 2624eb3ccf1SLars-Peter Clausen 2634eb3ccf1SLars-Peter Clausen spi_set_drvdata(spi, indio_dev); 2644eb3ccf1SLars-Peter Clausen st->spi = spi; 2654eb3ccf1SLars-Peter Clausen 2664eb3ccf1SLars-Peter Clausen /* Estabilish that the iio_dev is a child of the spi device */ 2674eb3ccf1SLars-Peter Clausen indio_dev->dev.parent = &spi->dev; 2684eb3ccf1SLars-Peter Clausen indio_dev->name = spi_get_device_id(spi)->name; 2694eb3ccf1SLars-Peter Clausen indio_dev->info = &ad7887_info; 2704eb3ccf1SLars-Peter Clausen indio_dev->modes = INDIO_DIRECT_MODE; 2714eb3ccf1SLars-Peter Clausen 2724eb3ccf1SLars-Peter Clausen /* Setup default message */ 2734eb3ccf1SLars-Peter Clausen 2744eb3ccf1SLars-Peter Clausen mode = AD7887_PM_MODE4; 2754eb3ccf1SLars-Peter Clausen if (!pdata || !pdata->use_onchip_ref) 2764eb3ccf1SLars-Peter Clausen mode |= AD7887_REF_DIS; 2774eb3ccf1SLars-Peter Clausen if (pdata && pdata->en_dual) 2784eb3ccf1SLars-Peter Clausen mode |= AD7887_DUAL; 2794eb3ccf1SLars-Peter Clausen 2804eb3ccf1SLars-Peter Clausen st->tx_cmd_buf[0] = AD7887_CH_AIN0 | mode; 2814eb3ccf1SLars-Peter Clausen 2824eb3ccf1SLars-Peter Clausen st->xfer[0].rx_buf = &st->data[0]; 2834eb3ccf1SLars-Peter Clausen st->xfer[0].tx_buf = &st->tx_cmd_buf[0]; 2844eb3ccf1SLars-Peter Clausen st->xfer[0].len = 2; 2854eb3ccf1SLars-Peter Clausen 2864eb3ccf1SLars-Peter Clausen spi_message_init(&st->msg[AD7887_CH0]); 2874eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[0], &st->msg[AD7887_CH0]); 2884eb3ccf1SLars-Peter Clausen 2894eb3ccf1SLars-Peter Clausen if (pdata && pdata->en_dual) { 2904eb3ccf1SLars-Peter Clausen st->tx_cmd_buf[2] = AD7887_CH_AIN1 | mode; 2914eb3ccf1SLars-Peter Clausen 2924eb3ccf1SLars-Peter Clausen st->xfer[1].rx_buf = &st->data[0]; 2934eb3ccf1SLars-Peter Clausen st->xfer[1].tx_buf = &st->tx_cmd_buf[2]; 2944eb3ccf1SLars-Peter Clausen st->xfer[1].len = 2; 2954eb3ccf1SLars-Peter Clausen 2964eb3ccf1SLars-Peter Clausen st->xfer[2].rx_buf = &st->data[2]; 2974eb3ccf1SLars-Peter Clausen st->xfer[2].tx_buf = &st->tx_cmd_buf[0]; 2984eb3ccf1SLars-Peter Clausen st->xfer[2].len = 2; 2994eb3ccf1SLars-Peter Clausen 3004eb3ccf1SLars-Peter Clausen spi_message_init(&st->msg[AD7887_CH0_CH1]); 3014eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[1], &st->msg[AD7887_CH0_CH1]); 3024eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[2], &st->msg[AD7887_CH0_CH1]); 3034eb3ccf1SLars-Peter Clausen 3044eb3ccf1SLars-Peter Clausen st->xfer[3].rx_buf = &st->data[2]; 3054eb3ccf1SLars-Peter Clausen st->xfer[3].tx_buf = &st->tx_cmd_buf[2]; 3064eb3ccf1SLars-Peter Clausen st->xfer[3].len = 2; 3074eb3ccf1SLars-Peter Clausen 3084eb3ccf1SLars-Peter Clausen spi_message_init(&st->msg[AD7887_CH1]); 3094eb3ccf1SLars-Peter Clausen spi_message_add_tail(&st->xfer[3], &st->msg[AD7887_CH1]); 3104eb3ccf1SLars-Peter Clausen 3114eb3ccf1SLars-Peter Clausen indio_dev->channels = st->chip_info->channel; 3124eb3ccf1SLars-Peter Clausen indio_dev->num_channels = 3; 3134eb3ccf1SLars-Peter Clausen } else { 3144eb3ccf1SLars-Peter Clausen indio_dev->channels = &st->chip_info->channel[1]; 3154eb3ccf1SLars-Peter Clausen indio_dev->num_channels = 2; 3164eb3ccf1SLars-Peter Clausen } 3174eb3ccf1SLars-Peter Clausen 3184eb3ccf1SLars-Peter Clausen ret = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time, 3194eb3ccf1SLars-Peter Clausen &ad7887_trigger_handler, &ad7887_ring_setup_ops); 3204eb3ccf1SLars-Peter Clausen if (ret) 3214eb3ccf1SLars-Peter Clausen goto error_disable_reg; 3224eb3ccf1SLars-Peter Clausen 3234eb3ccf1SLars-Peter Clausen ret = iio_device_register(indio_dev); 3244eb3ccf1SLars-Peter Clausen if (ret) 3254eb3ccf1SLars-Peter Clausen goto error_unregister_ring; 3264eb3ccf1SLars-Peter Clausen 3274eb3ccf1SLars-Peter Clausen return 0; 3284eb3ccf1SLars-Peter Clausen error_unregister_ring: 3294eb3ccf1SLars-Peter Clausen iio_triggered_buffer_cleanup(indio_dev); 3304eb3ccf1SLars-Peter Clausen error_disable_reg: 3314eb3ccf1SLars-Peter Clausen if (st->reg) 3324eb3ccf1SLars-Peter Clausen regulator_disable(st->reg); 3334eb3ccf1SLars-Peter Clausen 3344eb3ccf1SLars-Peter Clausen return ret; 3354eb3ccf1SLars-Peter Clausen } 3364eb3ccf1SLars-Peter Clausen 337fc52692cSGreg Kroah-Hartman static int ad7887_remove(struct spi_device *spi) 3384eb3ccf1SLars-Peter Clausen { 3394eb3ccf1SLars-Peter Clausen struct iio_dev *indio_dev = spi_get_drvdata(spi); 3404eb3ccf1SLars-Peter Clausen struct ad7887_state *st = iio_priv(indio_dev); 3414eb3ccf1SLars-Peter Clausen 3424eb3ccf1SLars-Peter Clausen iio_device_unregister(indio_dev); 3434eb3ccf1SLars-Peter Clausen iio_triggered_buffer_cleanup(indio_dev); 344*82429e0dSSachin Kamat if (st->reg) 3454eb3ccf1SLars-Peter Clausen regulator_disable(st->reg); 3464eb3ccf1SLars-Peter Clausen 3474eb3ccf1SLars-Peter Clausen return 0; 3484eb3ccf1SLars-Peter Clausen } 3494eb3ccf1SLars-Peter Clausen 3504eb3ccf1SLars-Peter Clausen static const struct spi_device_id ad7887_id[] = { 3514eb3ccf1SLars-Peter Clausen {"ad7887", ID_AD7887}, 3524eb3ccf1SLars-Peter Clausen {} 3534eb3ccf1SLars-Peter Clausen }; 3544eb3ccf1SLars-Peter Clausen MODULE_DEVICE_TABLE(spi, ad7887_id); 3554eb3ccf1SLars-Peter Clausen 3564eb3ccf1SLars-Peter Clausen static struct spi_driver ad7887_driver = { 3574eb3ccf1SLars-Peter Clausen .driver = { 3584eb3ccf1SLars-Peter Clausen .name = "ad7887", 3594eb3ccf1SLars-Peter Clausen .owner = THIS_MODULE, 3604eb3ccf1SLars-Peter Clausen }, 3614eb3ccf1SLars-Peter Clausen .probe = ad7887_probe, 362fc52692cSGreg Kroah-Hartman .remove = ad7887_remove, 3634eb3ccf1SLars-Peter Clausen .id_table = ad7887_id, 3644eb3ccf1SLars-Peter Clausen }; 3654eb3ccf1SLars-Peter Clausen module_spi_driver(ad7887_driver); 3664eb3ccf1SLars-Peter Clausen 3674eb3ccf1SLars-Peter Clausen MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); 3684eb3ccf1SLars-Peter Clausen MODULE_DESCRIPTION("Analog Devices AD7887 ADC"); 3694eb3ccf1SLars-Peter Clausen MODULE_LICENSE("GPL v2"); 370