staging:iio:ad7606: Let the common probe function return int
[linux-2.6-block.git] / drivers / staging / iio / adc / ad7606_spi.c
1 /*
2  * AD7606 SPI ADC driver
3  *
4  * Copyright 2011 Analog Devices Inc.
5  *
6  * Licensed under the GPL-2.
7  */
8
9 #include <linux/module.h>
10 #include <linux/spi/spi.h>
11 #include <linux/types.h>
12 #include <linux/err.h>
13
14 #include <linux/iio/iio.h>
15 #include "ad7606.h"
16
17 #define MAX_SPI_FREQ_HZ         23500000        /* VDRIVE above 4.75 V */
18
19 static int ad7606_spi_read_block(struct device *dev,
20                                  int count, void *buf)
21 {
22         struct spi_device *spi = to_spi_device(dev);
23         int i, ret;
24         unsigned short *data = buf;
25         __be16 *bdata = buf;
26
27         ret = spi_read(spi, buf, count * 2);
28         if (ret < 0) {
29                 dev_err(&spi->dev, "SPI read error\n");
30                 return ret;
31         }
32
33         for (i = 0; i < count; i++)
34                 data[i] = be16_to_cpu(bdata[i]);
35
36         return 0;
37 }
38
39 static const struct ad7606_bus_ops ad7606_spi_bops = {
40         .read_block     = ad7606_spi_read_block,
41 };
42
43 static int ad7606_spi_probe(struct spi_device *spi)
44 {
45         const struct spi_device_id *id = spi_get_device_id(spi);
46
47         return ad7606_probe(&spi->dev, spi->irq, NULL,
48                             id->name, id->driver_data,
49                             &ad7606_spi_bops);
50 }
51
52 static int ad7606_spi_remove(struct spi_device *spi)
53 {
54         struct iio_dev *indio_dev = dev_get_drvdata(&spi->dev);
55
56         return ad7606_remove(indio_dev, spi->irq);
57 }
58
59 static const struct spi_device_id ad7606_id[] = {
60         {"ad7606-8", ID_AD7606_8},
61         {"ad7606-6", ID_AD7606_6},
62         {"ad7606-4", ID_AD7606_4},
63         {}
64 };
65 MODULE_DEVICE_TABLE(spi, ad7606_id);
66
67 static struct spi_driver ad7606_driver = {
68         .driver = {
69                 .name = "ad7606",
70                 .pm = AD7606_PM_OPS,
71         },
72         .probe = ad7606_spi_probe,
73         .remove = ad7606_spi_remove,
74         .id_table = ad7606_id,
75 };
76 module_spi_driver(ad7606_driver);
77
78 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
79 MODULE_DESCRIPTION("Analog Devices AD7606 ADC");
80 MODULE_LICENSE("GPL v2");