drivers/iio/adc/men_z188_adc.c

   1 /*
   2  * MEN 16z188 Analog to Digial Converter
   3  *
   4  * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
   5  * Author: Johannes Thumshirn <[email protected]>
   6  *
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms of the GNU General Public License as published by the Free
   9  * Software Foundation; version 2 of the License.
  10  */
  11
  12 #include <linux/kernel.h>
  13 #include <linux/module.h>
  14 #include <linux/mcb.h>
  15 #include <linux/io.h>
  16 #include <linux/iio/iio.h>
  17
  18 #define Z188_ADC_MAX_CHAN       8
  19 #define Z188_ADC_GAIN           0x0700000
  20 #define Z188_MODE_VOLTAGE       BIT(27)
  21 #define Z188_CFG_AUTO           0x1
  22 #define Z188_CTRL_REG           0x40
  23
  24 #define ADC_DATA(x) (((x) >> 2) & 0x7ffffc)
  25 #define ADC_OVR(x) ((x) & 0x1)
  26
  27 struct z188_adc {
  28         struct resource *mem;
  29         void __iomem *base;
  30 };
  31
  32 #define Z188_ADC_CHANNEL(idx) {                                 \
  33                 .type = IIO_VOLTAGE,                            \
  34                 .indexed = 1,                                   \
  35                 .channel = (idx),                               \
  36                 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),   \
  37 }
  38
  39 static const struct iio_chan_spec z188_adc_iio_channels[] = {
  40         Z188_ADC_CHANNEL(0),
  41         Z188_ADC_CHANNEL(1),
  42         Z188_ADC_CHANNEL(2),
  43         Z188_ADC_CHANNEL(3),
  44         Z188_ADC_CHANNEL(4),
  45         Z188_ADC_CHANNEL(5),
  46         Z188_ADC_CHANNEL(6),
  47         Z188_ADC_CHANNEL(7),
  48 };
  49
  50 static int z188_iio_read_raw(struct iio_dev *iio_dev,
  51                         struct iio_chan_spec const *chan,
  52                         int *val,
  53                         int *val2,
  54                         long info)
  55 {
  56         struct z188_adc *adc = iio_priv(iio_dev);
  57         int ret;
  58         u16 tmp;
  59
  60         switch (info) {
  61         case IIO_CHAN_INFO_RAW:
  62                 tmp = readw(adc->base + chan->channel * 4);
  63
  64                 if (ADC_OVR(tmp)) {
  65                         dev_info(&iio_dev->dev,
  66                                 "Oversampling error on ADC channel %d\n",
  67                                 chan->channel);
  68                         return -EIO;
  69                 }
  70                 *val = ADC_DATA(tmp);
  71                 ret = IIO_VAL_INT;
  72                 break;
  73         default:
  74                 ret = -EINVAL;
  75                 break;
  76         }
  77
  78         return ret;
  79 }
  80
  81 static const struct iio_info z188_adc_info = {
  82         .read_raw = &z188_iio_read_raw,
  83 };
  84
  85 static void men_z188_config_channels(void __iomem *addr)
  86 {
  87         int i;
  88         u32 cfg;
  89         u32 ctl;
  90
  91         ctl = readl(addr + Z188_CTRL_REG);
  92         ctl |= Z188_CFG_AUTO;
  93         writel(ctl, addr + Z188_CTRL_REG);
  94
  95         for (i = 0; i < Z188_ADC_MAX_CHAN; i++) {
  96                 cfg = readl(addr + i);
  97                 cfg &= ~Z188_ADC_GAIN;
  98                 cfg |= Z188_MODE_VOLTAGE;
  99                 writel(cfg, addr + i);
 100         }
 101 }
 102
 103 static int men_z188_probe(struct mcb_device *dev,
 104                         const struct mcb_device_id *id)
 105 {
 106         struct z188_adc *adc;
 107         struct iio_dev *indio_dev;
 108         struct resource *mem;
 109
 110         indio_dev = devm_iio_device_alloc(&dev->dev, sizeof(struct z188_adc));
 111         if (!indio_dev)
 112                 return -ENOMEM;
 113
 114         adc = iio_priv(indio_dev);
 115         indio_dev->name = "z188-adc";
 116         indio_dev->dev.parent = &dev->dev;
 117         indio_dev->info = &z188_adc_info;
 118         indio_dev->modes = INDIO_DIRECT_MODE;
 119         indio_dev->channels = z188_adc_iio_channels;
 120         indio_dev->num_channels = ARRAY_SIZE(z188_adc_iio_channels);
 121
 122         mem = mcb_request_mem(dev, "z188-adc");
 123         if (IS_ERR(mem))
 124                 return PTR_ERR(mem);
 125
 126         adc->base = ioremap(mem->start, resource_size(mem));
 127         if (adc->base == NULL)
 128                 goto err;
 129
 130         men_z188_config_channels(adc->base);
 131
 132         adc->mem = mem;
 133         mcb_set_drvdata(dev, indio_dev);
 134
 135         return iio_device_register(indio_dev);
 136
 137 err:
 138         mcb_release_mem(mem);
 139         return -ENXIO;
 140 }
 141
 142 static void men_z188_remove(struct mcb_device *dev)
 143 {
 144         struct iio_dev *indio_dev  = mcb_get_drvdata(dev);
 145         struct z188_adc *adc = iio_priv(indio_dev);
 146
 147         iio_device_unregister(indio_dev);
 148         iounmap(adc->base);
 149         mcb_release_mem(adc->mem);
 150 }
 151
 152 static const struct mcb_device_id men_z188_ids[] = {
 153         { .device = 0xbc },
 154         { }
 155 };
 156 MODULE_DEVICE_TABLE(mcb, men_z188_ids);
 157
 158 static struct mcb_driver men_z188_driver = {
 159         .driver = {
 160                 .name = "z188-adc",
 161                 .owner = THIS_MODULE,
 162         },
 163         .probe = men_z188_probe,
 164         .remove = men_z188_remove,
 165         .id_table = men_z188_ids,
 166 };
 167 module_mcb_driver(men_z188_driver);
 168
 169 MODULE_AUTHOR("Johannes Thumshirn <[email protected]>");
 170 MODULE_LICENSE("GPL");
 171 MODULE_DESCRIPTION("IIO ADC driver for MEN 16z188 ADC Core");
 172 MODULE_ALIAS("mcb:16z188");